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].
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].