Testing of new Arm Spark Motor Code

[keenanbuckley]

• Test manually with Joystick and find the range of encoder values
• Use the range of arm encoder values to fix soft limits, functions using setPositionSM/PID, and other code using arm encoder values
• Test PID control
• Roughly Tune PID control
• Test SM control
• Fine Tune SM Control