Update motor mapping
Add script to manual control robot
Update motor mapping
Implement return home functionality