Fixed bug in yaw control signal calculation
Fix-point improved. PID parameter scaling fixed