Simplified SCARA_ang_move()