RGB LEDs will only be written on color change (due to stop interrupt)
Teensy specific pwm is replaced by servo lib
AUX1 mode switch support
AUX2 support
drift stabilisation (gyro)
acc stabilisation (does not work!!)