Trajectory planning Calculates jacobian and does trajectory planning for the following commands: PTP - LIN - PTP – PTP
