Add convenience methods to robot.map.Coordinate
Add encoder dead reckoning code