Use quaternion to represent the orientation of a TrajectoryPoint
Currently, a complex number is used to represent the heading of a trajectory point.
However, a z
field was recently added to the TrajectoryPoint
message, allowing to represent trajectories in 3D.
It is thus now necessary to use a quaternion to represent the orientation of trajectory points in 3D.