Added wait for start to 3 main programs
Update Tele-op- change joystick dump button values
Update AUTO- added prep for tele-op
Update AUTO- motor wiring, initialize , prep

motor shoulder and elbow were incorrect in pragma, added an initialze
robot function with light, gyro, and servos, and fixed robot tele-op
prep. For both AUTO programs.