Made it easier to change the amount of servos

Cleaned up some old code, as well.

Now the servos are programatically set up to make it easier to change servo values without adding extra code.  Still need to test with a joystick but I don't have one on me right now.