Moved code for robot into new file, removed unneeded functions, added ba...

...sic motor control structure