(Selfexplanatory)

WIP

 

**Aruino code is just the motor control functions as of yet, more coming soon