Initial Commit.

 Not all functionality is here. Still need to do some things such as implement ultrasonic, finish up limit switches, etc