Working ATM, going to remove disable arm limit stuff
Removed it, and changed servo move speed
Final commit before bagging (everything is working except for running
the rollers backwards, but that is probably a hardware issue)