Robot driving is functional

Robot is now driving