Source code for WPM2 Robot http://www.6-robot.com - View it on GitHub