574,8 → 574,8 |
amplfy_speed_north = DIFF_Y_F_MAX; |
amplfy_speed_east *= (Parameter_NaviGpsD/GPS_USR_PAR_FKT); |
amplfy_speed_north *= (Parameter_NaviGpsD/GPS_USR_PAR_FKT); |
speed_east = (speed_east * (long)amplfy_speed_east*gps_gain) /500; |
speed_north = (speed_north * (long)amplfy_speed_north*gps_gain)/500; |
speed_east = (speed_east * (long)amplfy_speed_east*gps_gain) /400; |
speed_north = (speed_north * (long)amplfy_speed_north*gps_gain)/400; |
// D Werte begrenzen |
#define D_F_MAX (GPS_NICKROLL_MAX * limit_gain*7)/10 // auf 70 Prozent des Maximalen Nick/Rollwert begrenzen |
if (speed_east > D_F_MAX) speed_east = D_F_MAX; |