YAW drift in PilotCommandProcessor (RATE_MODE) fixed
some defines addes
some YAW experimens (ATTITUDE_MODE)
ACC trim adapted to SUMD (non interrupt)
Split PilotCommandProcessor to smaler functions, add InitGyro to PilotCommand