WebSVN - FlightCtrl - Diff - Rev 885 and 886 - /branches/V0.72p Code Redesign killagreg/main.c

 // +  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 // +  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 // +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 // +  POSSIBILITY OF SUCH DAMAGE.
 // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-#include "main.h"
+#include <avr/boot.h>
-unsigned char EEPromArray[E2END+1] EEMEM;
-unsigned char PlatinenVersion = 10;
-unsigned char SendVersionToNavi = 1;
-// -- Parametersatz aus EEPROM lesen ---
-// number [0..5]
-void ReadParameterSet(unsigned char number, unsigned char *buffer, unsigned char length)
-{
-   if (number > 5) number = 5;
-   eeprom_read_block(buffer, &EEPromArray[EEPROM_ADR_PARAM_BEGIN + length * number], length);
-}
+#include <avr/io.h>
+#include <avr/interrupt.h>
-// -- Parametersatz ins EEPROM schreiben ---
+#include "main.h"
-// number [0..5]
-void WriteParameterSet(unsigned char number, unsigned char *buffer, unsigned char length)
+#include "timer0.h"
-{
+#include "timer2.h"
-   if(number > 5) number = 5;
+#include "uart.h"
-   eeprom_write_block(buffer, &EEPromArray[EEPROM_ADR_PARAM_BEGIN + length * number], length);
+#if defined (__AVR_ATmega644P__)
-   eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], number);                              // diesen Parametersatz als aktuell merken
+#include "uart1.h"
-}
+#endif
+#include "led.h"
+#include "menu.h"
-unsigned char GetActiveParamSetNumber(void)
+#include "fc.h"
+#include "rc.h"
-{
+#include "analog.h"
- unsigned char set;
+#include "printf_P.h"
- set = eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET]);
+#ifdef USE_KILLAGREG
+#include "mm3.h"
+#endif
- if(set > 5)
+#ifdef USE_NAVICTRL
-  {
+#include "spi.h"
+#endif
-   set = 2;
+#if !defined (USE_KILLAGREG) && !defined (USE_NAVICTRL)
-   eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], set);                                 // diesen Parametersatz als aktuell merken
+#include "mk3mag.h"
-  }
+#endif
+#include "twimaster.h"
- return(set);
-}
-void CalMk3Mag(void)
-{
- static unsigned char stick = 1;
- if(PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] > -20) stick = 0;
- if((PPM_in[EE_Parameter.Kanalbelegung[K_NICK]] < -70) && !stick)
-  {
-   stick = 1;
-   WinkelOut.CalcState++;
+#include "eeprom.h"
-   if(WinkelOut.CalcState > 4)
-    {
-//     WinkelOut.CalcState = 0; // in Uart.c
-     beeptime = 1000;
-    }
-   else Piep(WinkelOut.CalcState);
+#include "_Settings.h"
   DebugOut.Analog[19] = WinkelOut.CalcState;
 uint8_t BoardRelease = 10;
 //############################################################################
+//Hauptprogramm
+int main (void)
+//############################################################################
 //Hauptprogramm
-int main (void)
+        unsigned int timer;
-//############################################################################
-{
+        // disable interrupts global
-        unsigned int timer;
+        cli();
-        //unsigned int timer2 = 0;
-    DDRB  = 0x00;
-    PORTB = 0x00;
-    for(timer = 0; timer < 1000; timer++); // verzögern
-    if(PINB & 0x01) PlatinenVersion = 11; else PlatinenVersion = 10;
-    DDRC  = 0x81; // SCL
+        // get board release
+    DDRB  = 0x00;
-    PORTC = 0xff; // Pullup SDA
+    PORTB = 0x00;
+    for(timer = 0; timer < 1000; timer++); // make some delay
+    if(PINB & (1<<PINB0)) BoardRelease = 11;
-    DDRB  = 0x1B; // LEDs und Druckoffset
+    else BoardRelease = 10;
     PORTB = 0x01; // LED_Rot
-    DDRD  = 0x3E; // Speaker & TXD & J3 J4 J5
+        // set LED ports as output
-    DDRD  |=0x80; // J7
+        DDRB |= (1<<DDB1)|(1<<DDB0);
+        ROT_ON;
+        GRN_OFF;
+        // disable watchdog
-        PORTD = 0xF7; // LED
+    MCUSR &=~(1<<WDRF);
+    WDTCSR |= (1<<WDCE)|(1<<WDE);
+    WDTCSR = 0;
+    BeepTime = 2000;
+        PPM_in[CH_THRUST] = 0;
+        StickYaw = 0;
+        StickRoll = 0;
+        StickPitch = 0;
-    MCUSR &=~(1<<WDRF);
+    ROT_OFF;
     WDTCSR |= (1<<WDCE)|(1<<WDE);
-    WDTCSR = 0;
+        // initalize modules
+        LED_Init();
+    TIMER0_Init();
+    TIMER2_Init();
+        USART0_Init();
         #if defined (__AVR_ATmega644P__)
+        if (BoardRelease == 11) USART1_Init();
+        #endif
+    RC_Init();
+        ADC_Init();
+        I2C_Init();
     beeptime = 2000;
+        #ifdef USE_KILLAGREG
-        StickGier = 0; PPM_in[K_GAS] = 0;StickRoll = 0; StickNick = 0;
+        MM3_Init();
+        #endif
-    ROT_OFF;
+        #ifdef USE_NAVICTRL
         SPI_MasterInit();
-    Timer_Init();
+        #endif
-        UART_Init();
-    rc_sum_init();
-        ADC_Init();
-        i2c_init();
-        SPI_MasterInit();
+        #if !defined (USE_KILLAGREG) && !defined (USE_NAVICTRL)
+        MK3MAG_Init();
-        sei();
-    VersionInfo.Hauptversion = VERSION_HAUPTVERSION;
-    VersionInfo.Nebenversion = VERSION_NEBENVERSION;
-    VersionInfo.PCKompatibel = VERSION_KOMPATIBEL;
-        printf("\n\rFlightControl\n\rHardware:%d.%d\n\rSoftware:V%d.%d%c ",PlatinenVersion/10,PlatinenVersion%10, VERSION_HAUPTVERSION, VERSION_NEBENVERSION,VERSION_INDEX + 'a');
-        printf("\n\r==============================");
-        GRN_ON;
+        #endif
 #define EE_DATENREVISION 70 // wird angepasst, wenn sich die EEPROM-Daten geändert haben
-    if(eeprom_read_byte(&EEPromArray[EEPROM_ADR_VALID]) != EE_DATENREVISION)
         // enable interrupts global
-          printf("\n\rInit. EEPROM: Generiere Default-Parameter...");
+        sei();
-          DefaultKonstanten1();
+    VersionInfo.Major = VERSION_MAJOR;
+    VersionInfo.Minor = VERSION_MINOR;
+    VersionInfo.PCCompatible = VERSION_COMPATIBLE;
+        printf("\n\rFlightControl\n\rHardware:%d.%d\n\rSoftware:V%d.%d%c ",BoardRelease/10,BoardRelease%10, VERSION_MAJOR, VERSION_MINOR,VERSION_INDEX + 'a');
+        printf("\n\r==============================");
-          for (unsigned char i=0;i<6;i++)
+        GRN_ON;
-       if(i==2) DefaultKonstanten2(); // Kamera
+        // Parameter set handling
-       if(i==3) DefaultKonstanten3(); // Beginner
+        ParamSet_Init();
-       if(i>3)  DefaultKonstanten2(); // Kamera
-       WriteParameterSet(i, (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
+    if(GetParamWord(PID_ACC_PITCH) > 1023)
+     {
-          eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], 3); // default-Setting
+       printf("\n\rACC not calibrated!");
+     }
+        //wait for a short time (otherwise the RC channel check won't work below)
+        timer = SetDelay(500);
+        while(!CheckDelay(timer));
+        #if !defined (USE_KILLAGREG) && !defined (USE_NAVICTRL)
+        printf("\n\rSupport for MK3MAG Compass");
+        #endif
+        if(ParamSet.GlobalConfig & CFG_HEIGHT_CONTROL)
+         {
+           printf("\n\rCalibrating air pressure sensor..");
+           timer = SetDelay(1000);
-          eeprom_write_byte(&EEPromArray[EEPROM_ADR_VALID], EE_DATENREVISION);
+       SearchAirPressureOffset();
            while (!CheckDelay(timer));
+       printf("OK\n\r");
     if(eeprom_read_byte(&EEPromArray[EEPROM_ADR_ACC_NICK]) > 4)
-     {
-       printf("\n\rACC nicht abgeglichen!");
+        #ifdef USE_KILLAGREG
         printf("\n\rSupport for MicroMag3 Compass");
         #if defined (__AVR_ATmega644P__)
-        ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
+        if(BoardRelease == 10)
+        {
-    printf("\n\rBenutze Parametersatz %d", GetActiveParamSetNumber());
+                printf("\n\rSupport for GPS at 1st UART");
+        }
         else
         if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
-         {
-           printf("\n\rAbgleich Luftdrucksensor..");
+                printf("\n\rSupport for GPS at 2nd UART");
            timer = SetDelay(1000);
-       SucheLuftruckOffset();
+        #else // (__AVR_ATmega644__)
-           while (!CheckDelay(timer));
+                printf("\n\rSupport for GPS at 1st UART");
-       printf("OK\n\r");
-        }
+        #endif
+        #endif
         SetNeutral();
         ROT_OFF;
-        ROT_OFF;
+    BeepTime = 2000;
     ExternControl.Digital[0] = 0x55;
     beeptime = 2000;
     ExternControl.Digital[0] = 0x55;
         printf("\n\rControl: ");
         if (ParamSet.GlobalConfig & CFG_HEADING_HOLD) printf("HeadingHold");
-        printf("\n\rSteuerung: ");
+        else printf("Neutral");
         if (EE_Parameter.GlobalConfig & CFG_HEADING_HOLD) printf("HeadingHold");
-        else printf("Neutral");
+        printf("\n\n\r");
-        printf("\n\n\r");
+    LCD_Clear();
-    LcdClear();
+    I2CTimeout = 5000;
     I2CTimeout = 5000;
-    WinkelOut.Orientation = 1;
+        while (1)
-        while (1)
+        {
         if(UpdateMotor)      // control interval
+        {
-                if(UpdateMotor)      // ReglerIntervall
+                        UpdateMotor=0; // reset Flag, is enabled every 2 ms by isr of timer0
                         //PORTD |= (1<<PORTD4);
-                    UpdateMotor=0;
+            MotorControl();
-//PORTD |= 0x08;
+                        //PORTD &= ~(1<<PORTD4);
             if(WinkelOut.CalcState) CalMk3Mag();
-            else MotorRegler();
+                        SendMotorData();
 //PORTD &= ~0x08;
-            SendMotorData();
+            ROT_OFF;
-            ROT_OFF;
+            if(PcAccess) PcAccess--;
-            if(PcZugriff) PcZugriff--;
+            else
-             else
+            {
-              {
+               DubWiseKeys[0] = 0;
-               DubWiseKeys[0] = 0;
+               DubWiseKeys[1] = 0;
-               DubWiseKeys[1] = 0;
+                           ExternControl.Config = 0;
+               ExternStickPitch= 0;
-                           ExternControl.Config = 0;
+               ExternStickRoll = 0;
-               ExternStickNick = 0;
+               ExternStickYaw = 0;
-               ExternStickRoll = 0;
+            }
                ExternStickGier = 0;
-              }
+            if(!I2CTimeout)
             if(SenderOkay)  SenderOkay--;
-            if(!I2CTimeout)
+                                I2CTimeout = 5;
-                {
+                                I2C_Reset();
-                 I2CTimeout = 5;
-                 i2c_reset();
+                                if((BeepModulation == 0xFFFF) && MotorsOn)
-                  if((BeepMuster == 0xffff) && MotorenEin)
-                   {
-                    beeptime = 10000;
-                    BeepMuster = 0x0080;
+                                {
-                }
+                                        BeepTime = 10000; // 1 second
-            else
-                {
+                                        BeepModulation = 0x0080;
-                 I2CTimeout--;
                  ROT_OFF;
+                        }
-                }
+                        else
+                        {
-            if(SIO_DEBUG && (!UpdateMotor || !MotorenEin))
+                                I2CTimeout--;
+                                ROT_OFF;
+                        }
-              {
+                        if(SIO_DEBUG && (!UpdateMotor || !MotorsOn))
+                        {
+                                USART0_TransmitTxData();
+                                USART0_ProcessRxData();
+                        }
-               DatenUebertragung();
+                        else USART0_ProcessRxData();
-               BearbeiteRxDaten();
                         if(CheckDelay(timer))
               else BearbeiteRxDaten();
-         if(CheckDelay(timer))
+                if(UBat < ParamSet.LowVoltageWarning)

Subversion Repositories FlightCtrl

(root)/branches/V0.72p Code Redesign killagreg/main.c @ 1211 - Rev 885 → 886