IMPORTANT change...

when the WP_MODE is set, it now disables the MCU control of the ESC and servo. this will ensure that the car stays stationary when setting waypoints. it has been tested and debugged and works great!

Signed-off-by: rkburnside <richard@burnsides.org>