Fix compile errors in DefaultFlightPathGenerator
Added some Vector2D tests