Organized and Created Arm Control Code

Arm control is very similar to wheel control