From motion planning to trajectory control with bounded jerk for service manipulator robots