Drive and Arm update

Updated code and implemented arm (not yet fully functional).