building throw trajectory with utils and gripper
added zero positions at waypoint function
implemented zeroing positions at waypoint
implemented zeroing positions at waypoint