Code used on Jaws robot, for RoboCup Nationals Australia, 2012 (Canberra)