WebSVN - FlightCtrl - Diff - Rev 935 and 936 - /branches/V0.70d Code Redesign killagreg/eeprom.c

 #include <avr/eeprom.h>
 #include <string.h>
 #include "eeprom.h"
+#include "printf_P.h"
-#include "printf_P.h"
+#include "led.h"
  ParamSet.ChannelAssignment[CH_YAW]  = 4;
  ParamSet.ChannelAssignment[CH_POTI1] = 5;
  ParamSet.ChannelAssignment[CH_POTI2] = 6;
  ParamSet.ChannelAssignment[CH_POTI3] = 7;
  ParamSet.ChannelAssignment[CH_POTI4] = 8;
- ParamSet.GlobalConfig = CFG_AXIS_COUPLING_ACTIVE | CFG_COMPASS_ACTIVE | CFG_GPS_ACTIVE;//CFG_HEIGHT_CONTROL | CFG_HEIGHT_SWITCH | CFG_COMPASS_FIX;//0x01;
+ ParamSet.GlobalConfig = CFG_AXIS_COUPLING_ACTIVE | CFG_COMPASS_ACTIVE | CFG_GPS_ACTIVE;//CFG_HEIGHT_CONTROL | CFG_HEIGHT_SWITCH | CFG_COMPASS_FIX;
  ParamSet.Height_MinGas = 30;
  ParamSet.MaxHeight     = 251;      // Wert : 0-250   251 -> Poti1
  ParamSet.Height_P      = 10;       // Wert : 0-32
  ParamSet.Height_D  = 30;       // Wert : 0-250
  ParamSet.Height_ACC_Effect = 30;  // Wert : 0-250
  ParamSet.LowVoltageWarning = 94;       // Wert : 0-250
  ParamSet.EmergencyGas = 35;                // Wert : 0-250     // Gaswert bei Empangsverlust
  ParamSet.EmergencyGasDuration = 30;            // Wert : 0-250     // Zeit bis auf EmergencyGas geschaltet wird, wg. Rx-Problemen
  ParamSet.UfoArrangement = 0;         // X oder + Formation
  ParamSet.I_Factor = 32;
- ParamSet.UserParam1 = 253;             //zur freien Verwendung
+ ParamSet.UserParam1 = 0;             //zur freien Verwendung
- ParamSet.UserParam2 = 100;             //zur freien Verwendung
+ ParamSet.UserParam2 = 0;             //zur freien Verwendung
- ParamSet.UserParam3 = 90;             //zur freien Verwendung
+ ParamSet.UserParam3 = 0;             //zur freien Verwendung
- ParamSet.UserParam4 = 90;             //zur freien Verwendung
+ ParamSet.UserParam4 = 0;             //zur freien Verwendung
- ParamSet.UserParam5 = 90;             // zur freien Verwendung
+ ParamSet.UserParam5 = 0;             // zur freien Verwendung
- ParamSet.UserParam6 = 90;             // zur freien Verwendung
+ ParamSet.UserParam6 = 0;             // zur freien Verwendung
  ParamSet.UserParam7 = 0;             // zur freien Verwendung
  ParamSet.UserParam8 = 0;             // zur freien Verwendung
  ParamSet.ServoNickControl = 100;     // Wert : 0-250     // Stellung des Servos
  ParamSet.ServoNickComp = 40;         // Wert : 0-250     // Einfluss Gyro/Servo
  ParamSet.ServoNickCompInvert = 0;    // Wert : 0-250     // Richtung Einfluss Gyro/Servo
  ParamSet.LoopThreshold = 90;         // Wert: 0-250  Schwelle für Stickausschlag
  ParamSet.LoopHysteresis = 50;
  ParamSet.LoopConfig = 0;             // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts / wird getrennt behandelt
  ParamSet.Yaw_PosFeedback = 90;
  ParamSet.Yaw_NegFeedback = 5;
- ParamSet.AngleTurnOverNick = 100;
+ ParamSet.AngleTurnOverNick = 85;
- ParamSet.AngleTurnOverRoll = 100;
+ ParamSet.AngleTurnOverRoll = 85;
  ParamSet.GyroAccTrim = 16;        // 1/k
  ParamSet.DriftComp = 4;
  ParamSet.DynamicStability = 100;
+ ParamSet.J16Bitmask = 95;
+ ParamSet.J17Bitmask = 243;
+ ParamSet.J16Timing = 15;
+ ParamSet.J17Timing = 15;
+ ParamSet.NaviGpsModeControl = 253;
+ ParamSet.NaviGpsGain = 100;
+ ParamSet.NaviGpsP = 90;
+ ParamSet.NaviGpsI = 90;
+ ParamSet.NaviGpsD = 90;
+ ParamSet.NaviGpsACC = 0;
+ ParamSet.NaviGpsMinSat = 6;
+ ParamSet.NaviStickThreshold = 8;
  memcpy(ParamSet.Name, "Sport\0",6);
+}
  ParamSet.ChannelAssignment[CH_YAW]  = 4;
  ParamSet.ChannelAssignment[CH_POTI1] = 5;
  ParamSet.ChannelAssignment[CH_POTI2] = 6;
  ParamSet.ChannelAssignment[CH_POTI3] = 7;
  ParamSet.ChannelAssignment[CH_POTI4] = 8;
- ParamSet.GlobalConfig = CFG_AXIS_COUPLING_ACTIVE | CFG_COMPASS_ACTIVE | CFG_GPS_ACTIVE;//CFG_HEIGHT_CONTROL | CFG_HEIGHT_SWITCH | CFG_COMPASS_FIX;//0x01;
+ ParamSet.GlobalConfig = CFG_AXIS_COUPLING_ACTIVE | CFG_COMPASS_ACTIVE | CFG_GPS_ACTIVE;//CFG_HEIGHT_CONTROL | CFG_HEIGHT_SWITCH | CFG_COMPASS_FIX;
  ParamSet.Height_MinGas = 30;
  ParamSet.MaxHeight     = 251;         // Wert : 0-250   251 -> Poti1
  ParamSet.Height_P      = 10;          // Wert : 0-32
  ParamSet.Height_D  = 30;          // Wert : 0-250
  ParamSet.Height_ACC_Effect = 30;     // Wert : 0-250
  ParamSet.LowVoltageWarning = 94; // Wert : 0-250
  ParamSet.EmergencyGas = 35;                // Wert : 0-250     // Gaswert bei Empangsverlust
  ParamSet.EmergencyGasDuration = 30;            // Wert : 0-250     // Zeit bis auf EmergencyGas geschaltet wird, wg. Rx-Problemen
  ParamSet.UfoArrangement = 0;         // X oder + Formation
  ParamSet.I_Factor = 32;
- ParamSet.UserParam1 = 253;             // zur freien Verwendung
+ ParamSet.UserParam1 = 0;             // zur freien Verwendung
- ParamSet.UserParam2 = 100;             // zur freien Verwendung
+ ParamSet.UserParam2 = 0;             // zur freien Verwendung
- ParamSet.UserParam3 = 90;             // zur freien Verwendung
+ ParamSet.UserParam3 = 0;             // zur freien Verwendung
- ParamSet.UserParam4 = 90;             // zur freien Verwendung
+ ParamSet.UserParam4 = 0;             // zur freien Verwendung
- ParamSet.UserParam5 = 90;             // zur freien Verwendung
+ ParamSet.UserParam5 = 0;             // zur freien Verwendung
- ParamSet.UserParam6 = 90;             // zur freien Verwendung
+ ParamSet.UserParam6 = 0;             // zur freien Verwendung
  ParamSet.UserParam7 = 0;             // zur freien Verwendung
  ParamSet.UserParam8 = 0;             // zur freien Verwendung
  ParamSet.ServoNickControl = 100;     // Wert : 0-250     // Stellung des Servos
  ParamSet.ServoNickComp = 40;         // Wert : 0-250     // Einfluss Gyro/Servo
  ParamSet.ServoNickCompInvert = 0;    // Wert : 0-250     // Richtung Einfluss Gyro/Servo
  ParamSet.LoopThreshold = 90;         // Wert: 0-250  Schwelle für Stickausschlag
  ParamSet.LoopHysteresis = 50;
  ParamSet.LoopConfig = 0;             // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts
  ParamSet.Yaw_PosFeedback = 90;        // Faktor, mit dem Yaw die Achsen Roll und Nick verkoppelt
  ParamSet.Yaw_NegFeedback = 5;
- ParamSet.AngleTurnOverNick = 100;
+ ParamSet.AngleTurnOverNick = 85;
- ParamSet.AngleTurnOverRoll = 100;
+ ParamSet.AngleTurnOverRoll = 85;
  ParamSet.GyroAccTrim = 32;        // 1/k
  ParamSet.DriftComp = 4;
  ParamSet.DynamicStability = 75;
+ ParamSet.J16Bitmask = 95;
+ ParamSet.J17Bitmask = 243;
+ ParamSet.J16Timing = 20;
+ ParamSet.J17Timing = 20;
+ ParamSet.NaviGpsModeControl = 253;
+ ParamSet.NaviGpsGain = 100;
+ ParamSet.NaviGpsP = 90;
+ ParamSet.NaviGpsI = 90;
+ ParamSet.NaviGpsD = 90;
+ ParamSet.NaviGpsACC = 0;
+ ParamSet.NaviGpsMinSat = 6;
+ ParamSet.NaviStickThreshold = 8;
  memcpy(ParamSet.Name, "Normal\0", 7);
+}
  ParamSet.ChannelAssignment[CH_YAW]  = 4;
  ParamSet.ChannelAssignment[CH_POTI1] = 5;
  ParamSet.ChannelAssignment[CH_POTI2] = 6;
  ParamSet.ChannelAssignment[CH_POTI3] = 7;
  ParamSet.ChannelAssignment[CH_POTI4] = 8;
- ParamSet.GlobalConfig = CFG_ROTARY_RATE_LIMITER | CFG_AXIS_COUPLING_ACTIVE | CFG_COMPASS_ACTIVE | CFG_GPS_ACTIVE;//CFG_HEIGHT_CONTROL | CFG_HEIGHT_SWITCH | CFG_COMPASS_FIX;//0x01;
+ ParamSet.GlobalConfig = CFG_ROTARY_RATE_LIMITER | CFG_AXIS_COUPLING_ACTIVE | CFG_COMPASS_ACTIVE | CFG_GPS_ACTIVE;//CFG_HEIGHT_CONTROL | CFG_HEIGHT_SWITCH | CFG_COMPASS_FIX;
  ParamSet.Height_MinGas = 30;
  ParamSet.MaxHeight     = 251;         // Wert : 0-250   251 -> Poti1
  ParamSet.Height_P      = 10;          // Wert : 0-32
  ParamSet.Height_D  = 30;              // Wert : 0-250
  ParamSet.Height_ACC_Effect = 30;     // Wert : 0-250
  ParamSet.LowVoltageWarning = 94; // Wert : 0-250
  ParamSet.EmergencyGas = 35;                // Wert : 0-250     // Gaswert bei Empangsverlust
  ParamSet.EmergencyGasDuration = 20;            // Wert : 0-250     // Zeit bis auf EmergencyGas geschaltet wird, wg. Rx-Problemen
  ParamSet.UfoArrangement = 0;         // X oder + Formation
  ParamSet.I_Factor = 16;
- ParamSet.UserParam1 = 253;             // zur freien Verwendung
+ ParamSet.UserParam1 = 0;             // zur freien Verwendung
- ParamSet.UserParam2 = 100;             // zur freien Verwendung
+ ParamSet.UserParam2 = 0;             // zur freien Verwendung
- ParamSet.UserParam3 = 90;             // zur freien Verwendung
+ ParamSet.UserParam3 = 0;             // zur freien Verwendung
- ParamSet.UserParam4 = 90;             // zur freien Verwendung
+ ParamSet.UserParam4 = 0;             // zur freien Verwendung
- ParamSet.UserParam5 = 90;             // zur freien Verwendung
+ ParamSet.UserParam5 = 0;             // zur freien Verwendung
- ParamSet.UserParam6 = 90;             // zur freien Verwendung
+ ParamSet.UserParam6 = 0;             // zur freien Verwendung
  ParamSet.UserParam7 = 0;             // zur freien Verwendung
  ParamSet.UserParam8 = 0;             // zur freien Verwendung
  ParamSet.ServoNickControl = 100;     // Wert : 0-250     // Stellung des Servos
  ParamSet.ServoNickComp = 40;         // Wert : 0-250     // Einfluss Gyro/Servo
  ParamSet.ServoNickCompInvert = 0;    // Wert : 0-250     // Richtung Einfluss Gyro/Servo
  ParamSet.LoopThreshold = 90;         // Wert: 0-250  Schwelle für Stickausschlag
  ParamSet.LoopHysteresis = 50;
  ParamSet.LoopConfig = 0;             // Bitcodiert: 0x01=oben, 0x02=unten, 0x04=links, 0x08=rechts
  ParamSet.Yaw_PosFeedback = 90;        // Faktor, mit dem Yaw die Achsen Roll und Nick verkoppelt
  ParamSet.Yaw_NegFeedback = 5;
- ParamSet.AngleTurnOverNick = 100;
+ ParamSet.AngleTurnOverNick = 85;
- ParamSet.AngleTurnOverRoll = 100;
+ ParamSet.AngleTurnOverRoll = 85;
  ParamSet.GyroAccTrim = 32;        // 1/k
  ParamSet.DriftComp = 4;
  ParamSet.DynamicStability = 50;
+ ParamSet.J16Bitmask = 95;
+ ParamSet.J17Bitmask = 243;
+ ParamSet.J16Timing = 30;
+ ParamSet.J17Timing = 30;
+ ParamSet.NaviGpsModeControl = 253;
+ ParamSet.NaviGpsGain = 100;
+ ParamSet.NaviGpsP = 90;
+ ParamSet.NaviGpsI = 90;
+ ParamSet.NaviGpsD = 90;
+ ParamSet.NaviGpsACC = 0;
+ ParamSet.NaviGpsMinSat = 6;
+ ParamSet.NaviStickThreshold = 8;
  memcpy(ParamSet.Name, "Beginner\0", 9);
+}
 /***************************************************/
 // number [0..5]
 void ParamSet_ReadFromEEProm(uint8_t setnumber)
+{
    if (setnumber > 5) setnumber = 5;
    eeprom_read_block((uint8_t *) &ParamSet.ChannelAssignment[0], &EEPromArray[EEPROM_ADR_PARAMSET_BEGIN + PARAMSET_STRUCT_LEN * setnumber], PARAMSET_STRUCT_LEN);
+   LED_Init();
+}
 /***************************************************/
 /*        Write Parameter Set to EEPROM            */
+{
    if(setnumber > 5) setnumber = 5;
    eeprom_write_block((uint8_t *) &ParamSet.ChannelAssignment[0], &EEPromArray[EEPROM_ADR_PARAMSET_BEGIN + PARAMSET_STRUCT_LEN * setnumber], PARAMSET_STRUCT_LEN);
    // set this parameter set to active set
    eeprom_write_byte(&EEPromArray[PID_ACTIVE_SET], setnumber);
+   LED_Init();
+}
 /***************************************************/
 /*       Get active parameter set                  */

Subversion Repositories FlightCtrl

(root)/branches/V0.70d Code Redesign killagreg/eeprom.c @ 1334 - Rev 935 → 936