Some code based on a friend's robot
Porting the code the somobot