Working Arduino Code

Functionality:
Speed Output
Turn Output
Battery Feedback
PID input tuning