Added Yaw Damping
Added Speed control for Hold control
Added Tuning mode to check for PID parameters