fixed test_math_double the wrap check needs to be wrap_PI() as otherwise rounding of 2*PI if just over 6.28 will give a large error ensure double tests are double test_vector2
AP_Math: correct some tests AP_Math: more vector2 tests AP_Math: make test_vector2 complete AP_Math: add initial unittest for vector3