Removed duplicate reprogramming
Working setMotor function!
Created a rudimentary working bluetooth connection
More software to follow (possibly C++)