Motion planner for the Kuka arm