Bug sl_drivepose.slx

[fafux]

Good morning, I am using the sl_drivepose.slx to drive a bicycle model to a desired pose starting from an initial pose. I found out that if I define the initial pose with PI as yaw angle the algorithm diverges. Attached there is an example with initial pose x0 = [0, 0, 3.1416] and desired final pose xg = [-2, 0, 3.1416].

[petercorke]

run rvccheck. Likely you have MathWorks robotics toolbox installed, it clashes some of my functions, in particular angdiff which causes this