working on bringing all the robot constraints together