Fix a bug in converting 0-360 headings into -Pi to Pi radians. Bind in the rest of the waypoint controller.