added arduino motor control
filled out motion functions
merged sketches
added basic state control