Fixed AStarPRM intermediate to not have weird edge conditions
Waypoints can now choose whether to display dubins lines or straight lines
UAVOrientation::average can do weighted average now
Waypoint uses distance-weighted average for angles now