Fixed error due to lack of wrap to pi in miabot waypoint controller.