Phase 1

Initial code scavenged from my other robotics projects