Removed crap

Removed crap and edited to first compile without error
Beeper working

Got the beeper working and setup H type drive system (uncalibrated)