RRPR manipulator (SCARA) trajectory planning