Added code for the servomotors
Added On/Off switch, increase cable holes, removed diode