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