Compined angle and gyro speed as reading for PID controler
Added option to scale gyro input to PID
Added smothing for the acceleratometer and gyro (simple average of last
3 readings)
Added failsafe start mode, it will not arm motors until the gears switch
is low after start.