Improved gearbox and keyboard control
fixed incorrect wiring of capacitor and breadboard
sensors wired
Various code improvements

Implemented pin config for motors, added debug var, test does dance