Fixed bug in sampling task reward function
Update from Dubins
Added == and != comparison operators to UAVPose
Added some handy things to Wayset
Change in debug printing during planning
Fixed bug in Wayset::distToPoseIndex
Updated flight tasks and simulated flier so that flight scoring is MUCH faster