Main Arduino Code

The main code to upload to the arduino.
*Note - all the safety stuff is commented out because I was testing.