Cody and Dylan's changes

Changed dropit to be more efficient

have GoToPos working properly

moving the dynamixel is now efficient

return to pos is now redundant

set motor torques needs to be run every time it gets plugged in again