Enables switching between trajectory execution and real-time servo control to track a moving target. Target tracking is enabled by a custom PID controller.
point1 and point2 move at different speeds and are at different 3D locations.
moveit_servo
KDL engine (LMA IK solver)
pilz_industrial_motion (global planners work too)