add separate double and float implementations for wrap_PI and wrap_2PI

[peterbarker]

avoids double promotion when the argument is not double

[peterbarker]

Board                    AP_Periph  antennatracker  blimp  bootloader  copter  heli  iofirmware  plane  rover  sub
CubeOrange-periph-heavy  *                                 *                                                   
Durandal                            -8              -56    *           -440    -576              -424   -240   -360
Hitec-Airspeed           *                                 *                                                   
KakuteH7-bdshot                     -8              -56    *           -432    -568              -416   -232   -352
MatekF405                           *               *      *           *       *                 *      *      *
Pixhawk1-1M-bdshot                  *               *                  *       *                 *      *      *
SITL_x86_64_linux_gnu               56              48                 -4048   56                48     56     56
f103-QiotekPeriph        *                                 *                                                   
f303-MatekGPS            *                                 *                                                   
f303-Universal           *                                 *                                                   
iomcu                                                                                *                         
mindpx-v2                           *               *      *           *       *                 *      *      *
revo-mini                           *               *      *           *       *                 *      *      *
skyviper-v2450                                                         *                                       
speedybeef4                         *               *      *           *       *                 *      *      *

[tridge]

it doesn't make sense to use this define in AP_Math.cpp, its not a project level define, its per cpp file

[peterbarker]

Board                    AP_Periph  antennatracker  blimp  bootloader  copter  heli  iofirmware  plane  rover  sub
CubeOrange-periph-heavy  *                                 *
Durandal                            -8              -48    *           -432    -568              -416   -240   -352
Hitec-Airspeed           *                                 *
KakuteH7-bdshot                     0               -48    *           -432    -568              -416   -232   -352
MatekF405                           *               *      *           *       *                 *      *      *
Pixhawk1-1M-bdshot                  *               *                  *       *                 *      *      *
SITL_x86_64_linux_gnu               48              56                 48      48                -4048  48     48
f103-QiotekPeriph        *                                 *
f303-MatekGPS            *                                 *
f303-Universal           *                                 *
iomcu                                                                                *
mindpx-v2                           *               *      *           *       *                 *      *      *
revo-mini                           *               *      *           *       *                 *      *      *
skyviper-v2450                                                         *
speedybeef4                         *               *      *           *       *                 *      *      *

After removing defines....