| 51,7 → 51,7 |
|---|
| // + ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| // + POSSIBILITY OF SUCH DAMAGE. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Aenderungen von Peter Muehlenbrock ("Salvo") Stand 9.11.2008 |
| // Aenderungen von Peter Muehlenbrock ("Salvo") Stand 29.12.2008 |
| /* |
| Driftkompensation fuer Gyros verbessert |
| Linearsensor optional mit fixem Neutralwert |
| 1101,6 → 1101,7 |
|---|
| ZaehlMessungen = 0; |
| } |
| //DebugOut.Analog[31] = StickRoll / (26*IntegralFaktor); |
| |
| // Salvo Ersatzkompass und Giergyrokompensation 15.12.2007 ********************** |
| if ((Kompass_Neuer_Wert > 0)) //nur wenn Kompass einen neuen Wert geliefert hat |
| { |
| 1111,7 → 1112,6 |
|---|
| { |
| if ((abs(KompassValue - Kompass_Value_Old)) <= 5) // Aufeinanderfolgende Werte duerfen nur minimal abweichen |
| { |
| |
| if ((abs(StickGier) < 20)) //Giergyroabgleich mit Kompass |
| { |
| if (cnt_stickgier_zero < 255) cnt_stickgier_zero += 1; |
| 1166,7 → 1166,7 |
|---|
| GyroKomp_Int = (GyroKomp_Int%360L) * (long)GIER_GRAD_FAKTOR; // An Magnetkompasswert annaehern |
| } |
| } |
| else //Kompassfehler |
| else //Kompass wegen grosser Neigung ungueltig |
| { |
| magkompass_ok = 0; |
| GyroGier_Comp = 0; |
| 1173,13 → 1173,12 |
|---|
| } |
| Kompass_Value_Old = KompassValue; |
| } |
| else magkompass_ok = 0; |
| |
| // Salvo End ************************* |
| |
| |
| // Salvo 6.10.2007 |
| // GPS Home aktivieren wenn Knueppel in Ruhelage und Hoehenschalter aktiviert ist |
| //GPS Hold Aktiveren wenn Knueppel in Ruhelage sind |
| //GPS Hold Aktivieren wenn Knueppel in Ruhelage sind |
| if ((abs(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]]) < Parameter_NaviStickThreshold) |
| && (abs(PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]) < Parameter_NaviStickThreshold) && (gps_alive_cnt > 0)) |
| { |
| 1233,8 → 1232,6 |
|---|
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| // Kompass |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //DebugOut.Analog[29] = (MaxStickNick + MaxStickRoll); |
| |
| // Salvo 29.12.2008 |
| if (NeueKompassRichtungMerken) |
| { |
| 1243,10 → 1240,10 |
|---|
| } |
| // Salvo 13.9.2007 |
| w=0; |
| // w = (w * Parameter_KompassWirkung) / 64; // auf die Wirkung normieren |
| // Salvo End |
| w = (w * Parameter_KompassWirkung) / 64; // auf die Wirkung normieren |
| w = Parameter_KompassWirkung - w; // Wirkung ggf drosseln |
| if(w >= 0) |
| if(w > 0) |
| { |
| // Salvo Kompasssteuerung ********************** |
| if (magkompass_ok > 0) Mess_Integral_Gier += (KompassRichtung * w) / 32; // nach Kompass ausrichten wenn dieser ok ist |
| 1253,7 → 1250,6 |
|---|
| // Salvo End |
| } |
| |
| |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| |
| // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |