added debug constant, changed waypoint drawing

waypoints are drawn differently depending if debug is on or not. added
null reference check to the Equals method of the Direction class