Created separate program for arm control

Duplicated wheel control, made a couple of changes for two motors versus
six