added basic motor and sonar code