WebSVN - FlightCtrl - Diff - Rev 1038 and 1051

 // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 // + Copyright (c) 04.2007 Holger Buss
 // + only for non-profit use
 // + www.MikroKopter.com
 // + see the File "License.txt" for further Informations
 // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
+#include <stdarg.h>
+#include <string.h>
 #include "main.h"
 #include "uart.h"
-unsigned char GetExternalControl = 0,DebugDisplayAnforderung = 0,DebugDataAnforderung = 0,GetVersionAnforderung = 0;
+unsigned char GetExternalControl = 0,DebugDisplayAnforderung = 0,DebugDataAnforderung = 0,GetVersionAnforderung = 0, GetPPMChannelAnforderung = 0;
 unsigned volatile char SioTmp = 0;
 unsigned volatile char SendeBuffer[MAX_SENDE_BUFF];
 unsigned volatile char RxdBuffer[MAX_EMPFANGS_BUFF];
 unsigned volatile char NMEABuffer[MAX_EMPFANGS_BUFF];
 unsigned volatile char NeuerDatensatzEmpfangen = 0;
 unsigned volatile char NeueKoordinateEmpfangen = 0;
 unsigned volatile char UebertragungAbgeschlossen = 1;
 unsigned volatile char CntCrcError = 0;
 unsigned volatile char AnzahlEmpfangsBytes = 0;
+unsigned char *pRxData = 0;
+unsigned char RxDataLen = 0;
 unsigned volatile char PC_DebugTimeout = 0;
-unsigned char RemotePollDisplayLine = 0;
-unsigned char NurKanalAnforderung = 0;
 unsigned char DebugTextAnforderung = 255;
 unsigned char PcZugriff = 100;
 unsigned char MotorTest[4] = {0,0,0,0};
-unsigned char DubWiseKeys[4] = {0,0,0,0};
 unsigned char MeineSlaveAdresse = 1; // Flight-Ctrl
 unsigned char ConfirmFrame;
 struct str_DebugOut    DebugOut;
 struct str_ExternControl  ExternControl;
 struct str_VersionInfo VersionInfo;
 struct str_WinkelOut WinkelOut;
 int Debug_Timer,Kompass_Timer;
+unsigned int DebugDataIntervall = 200;
 const unsigned char ANALOG_TEXT[32][16] =
+{
    //1234567890123456
     "IntegralNick    ", //0
     "IntegralRoll    ",
     "AccNick         ",
     "AccRoll         ",
     "GyroGier        ",
     "HoehenWert      ", //5
     "AccZ            ",
     "Gas             ",
     "KompassValue    ",
     "Spannung        ",
     "Empfang         ", //10
     "Ersatzkompass   ",
     "Motor_Vorne     ",
     "Motor_Hinten    ",
     "Motor_Links     ",
     "Motor_Rechts    ", //15
     "                ",
     "Distance        ",
     "OsdBar          ",
     "MK3Mag CalState ",
     "Servo           ", //20
     "Nick            ",
     "Roll            ",
     "                ",
     "                ",
     "                ", //25
     "                ",
     "Kalman_MaxDrift ",
     "                ",
     "Kalman K        ",
     "GPS_Nick        ", //30
     "GPS_Roll        "
 };
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 //++ Sende-Part der Datenübertragung
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 SIGNAL(INT_VEC_TX)
+{
  static unsigned int ptr = 0;
  unsigned char tmp_tx;
  if(!UebertragungAbgeschlossen)
+  {
    ptr++;                    // die [0] wurde schon gesendet
    tmp_tx = SendeBuffer[ptr];
    if((tmp_tx == '\r') || (ptr == MAX_SENDE_BUFF))
+    {
      ptr = 0;
      UebertragungAbgeschlossen = 1;
+    }
    UDR = tmp_tx;
   }
   else ptr = 0;
+}
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 //++ Empfangs-Part der Datenübertragung, incl. CRC-Auswertung
 //+++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 SIGNAL(INT_VEC_RX)
+{
  static unsigned int crc;
  static unsigned char crc1,crc2,buf_ptr;
  static unsigned char UartState = 0;
  unsigned char CrcOkay = 0;
  SioTmp = UDR;
  if(buf_ptr >= MAX_EMPFANGS_BUFF)    UartState = 0;
  if(SioTmp == '\r' && UartState == 2)
+  {
    UartState = 0;
    crc -= RxdBuffer[buf_ptr-2];
    crc -= RxdBuffer[buf_ptr-1];
    crc %= 4096;
    crc1 = '=' + crc / 64;
    crc2 = '=' + crc % 64;
    CrcOkay = 0;
    if((crc1 == RxdBuffer[buf_ptr-2]) && (crc2 == RxdBuffer[buf_ptr-1])) CrcOkay = 1; else { CrcOkay = 0; CntCrcError++;};
    if(!NeuerDatensatzEmpfangen && CrcOkay) // Datensatz schon verarbeitet
+    {
      NeuerDatensatzEmpfangen = 1;
-         AnzahlEmpfangsBytes = buf_ptr;
+         AnzahlEmpfangsBytes = buf_ptr + 1;
      RxdBuffer[buf_ptr] = '\r';
          if(RxdBuffer[2] == 'R') wdt_enable(WDTO_250MS); // Reset-Commando
         }
+  }
   else
   switch(UartState)
+  {
    case 0:
           if(SioTmp == '#' && !NeuerDatensatzEmpfangen) UartState = 1;  // Startzeichen und Daten schon verarbeitet
                   buf_ptr = 0;
                   RxdBuffer[buf_ptr++] = SioTmp;
                   crc = SioTmp;
           break;
    case 1: // Adresse auswerten
                   UartState++;
                   RxdBuffer[buf_ptr++] = SioTmp;
                   crc += SioTmp;
                   break;
    case 2: //  Eingangsdaten sammeln
                   RxdBuffer[buf_ptr] = SioTmp;
                   if(buf_ptr < MAX_EMPFANGS_BUFF) buf_ptr++;
                   else UartState = 0;
                   crc += SioTmp;
                   break;
    default:
           UartState = 0;
           break;
+  }
+}
 // --------------------------------------------------------------------------
 void AddCRC(unsigned int wieviele)
+{
  unsigned int tmpCRC = 0,i;
  for(i = 0; i < wieviele;i++)
+  {
    tmpCRC += SendeBuffer[i];
+  }
    tmpCRC %= 4096;
    SendeBuffer[i++] = '=' + tmpCRC / 64;
    SendeBuffer[i++] = '=' + tmpCRC % 64;
    SendeBuffer[i++] = '\r';
   UebertragungAbgeschlossen = 0;
   UDR = SendeBuffer[0];
+}
 // --------------------------------------------------------------------------
-void SendOutData(unsigned char cmd,unsigned char modul, unsigned char *snd, unsigned char len)
+void SendOutData(unsigned char cmd,unsigned char modul, unsigned char BufferAnzahl, ...) //unsigned char *snd, unsigned char len)
+{
+ va_list ap;
  unsigned int pt = 0;
  unsigned char a,b,c;
  unsigned char ptr = 0;
+ unsigned char *snd = 0;
+ int len = 0;
  SendeBuffer[pt++] = '#';               // Startzeichen
  SendeBuffer[pt++] = modul;             // Adresse (a=0; b=1,...)
  SendeBuffer[pt++] = cmd;                       // Commando
+ va_start(ap, BufferAnzahl);
+ if(BufferAnzahl)
+ {
+                snd = va_arg(ap, unsigned char*);
+                len = va_arg(ap, int);
+                ptr = 0;
+                BufferAnzahl--;
+ }
  while(len)
+  {
+        if(len)
-  {
+        {
+           a = snd[ptr++];
-   if(len) { a = snd[ptr++]; len--;} else a = 0;
+           len--;
+           if((!len) && BufferAnzahl)
+                {
+                        snd = va_arg(ap, unsigned char*);
+                        len = va_arg(ap, int);
+                        ptr = 0;
+                        BufferAnzahl--;
+                }
+        }
+        else a = 0;
+        if(len)
+        {
+                b = snd[ptr++];
+                len--;
+                if((!len) && BufferAnzahl)
+                {
+                        snd = va_arg(ap, unsigned char*);
+                        len = va_arg(ap, int);
+                        ptr = 0;
+                        BufferAnzahl--;
+                }
+        }
+        else b = 0;
+        if(len)
+        {
+                c = snd[ptr++];
+                len--;
+                if((!len) && BufferAnzahl)
-   if(len) { b = snd[ptr++]; len--;} else b = 0;
+                {
+                        snd = va_arg(ap, unsigned char*);
+                        len = va_arg(ap, int);
+                        ptr = 0;
+                        BufferAnzahl--;
+                }
+        }
-   if(len) { c = snd[ptr++]; len--;} else c = 0;
+        else c = 0;
    SendeBuffer[pt++] = '=' + (a >> 2);
    SendeBuffer[pt++] = '=' + (((a & 0x03) << 4) | ((b & 0xf0) >> 4));
    SendeBuffer[pt++] = '=' + (((b & 0x0f) << 2) | ((c & 0xc0) >> 6));
    SendeBuffer[pt++] = '=' + ( c & 0x3f);
+  }
+ va_end(ap);
  AddCRC(pt);
+}
 // --------------------------------------------------------------------------
-void Decode64(unsigned char *ptrOut, unsigned char len, unsigned char ptrIn,unsigned char max)  // Wohin mit den Daten; Wie lang; Wo im RxdBuffer
+void Decode64(void)  // die daten werden im rx buffer dekodiert, das geht nur, weil aus 4 byte immer 3 gemacht werden.
+{
  unsigned char a,b,c,d;
- unsigned char ptr = 0;
  unsigned char x,y,z;
+ unsigned char ptrIn = 3; // start at begin of data block
+ unsigned char ptrOut = 3;
+ unsigned char len = AnzahlEmpfangsBytes - 6; // von der Gesamtbytezahl eines Frames gehen 3 Bytes des Headers  ('#',Addr, Cmd) und 3 Bytes des Footers (CRC1, CRC2, '\r') ab.
  while(len)
+  {
    a = RxdBuffer[ptrIn++] - '=';
    b = RxdBuffer[ptrIn++] - '=';
    c = RxdBuffer[ptrIn++] - '=';
    d = RxdBuffer[ptrIn++] - '=';
-   if(ptrIn > max - 2) break;     // nicht mehr Daten verarbeiten, als empfangen wurden
    x = (a << 2) | (b >> 4);
    y = ((b & 0x0f) << 4) | (c >> 2);
    z = ((c & 0x03) << 6) | d;
-   if(len--) ptrOut[ptr++] = x; else break;
+   if(len--) RxdBuffer[ptrOut++] = x; else break;
-   if(len--) ptrOut[ptr++] = y; else break;
+   if(len--) RxdBuffer[ptrOut++] = y; else break;
-   if(len--) ptrOut[ptr++] = z; else break;
+   if(len--) RxdBuffer[ptrOut++] = z;   else break;
+  }
+        pRxData = (unsigned char*)&RxdBuffer[3]; // decodierte Daten beginnen beim 4. Byte
         RxDataLen = ptrOut - 3;  // wie viele Bytes wurden dekodiert?
+}
 // --------------------------------------------------------------------------
 void BearbeiteRxDaten(void)
+{
  if(!NeuerDatensatzEmpfangen) return;
- unsigned int tmp_int_arr1[1];
-// unsigned int tmp_int_arr2[2];
-// unsigned int tmp_int_arr3[3];
- unsigned char tmp_char_arr2[2];
-// unsigned char tmp_char_arr3[3];
-// unsigned char tmp_char_arr4[4];
+  Decode64(); // dekodiere datenblock im Empfangsbuffer
  //if(!MotorenEin)
   switch(RxdBuffer[2])
+  {
    case 'K':// Kompasswert
-            Decode64((unsigned char *) &tmp_int_arr1[0],sizeof(tmp_int_arr1),3,AnzahlEmpfangsBytes);
+            memcpy((unsigned char *)&KompassValue , (unsigned char *)pRxData, sizeof(KompassValue));
-            KompassValue = tmp_int_arr1[0];
             KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
                         break;
    case 'a':// Texte der Analogwerte
-            Decode64((unsigned char *) &tmp_char_arr2[0],sizeof(tmp_char_arr2),3,AnzahlEmpfangsBytes);
+            DebugTextAnforderung = pRxData[0];
-            DebugTextAnforderung = tmp_char_arr2[0];
+            if (DebugTextAnforderung > 31) DebugTextAnforderung = 31;
             PcZugriff = 255;
                         break;
    case 'b':
-                        Decode64((unsigned char *) &ExternControl,sizeof(ExternControl),3,AnzahlEmpfangsBytes);
+                        memcpy((unsigned char *)&ExternControl, (unsigned char *)pRxData, sizeof(ExternControl));
-                        RemoteTasten |= ExternControl.RemoteTasten;
             ConfirmFrame = ExternControl.Frame;
             PcZugriff = 255;
             break;
-   case 'c':
-                        Decode64((unsigned char *) &ExternControl,sizeof(ExternControl),3,AnzahlEmpfangsBytes);
-                        RemoteTasten |= ExternControl.RemoteTasten;
+   case 'd': // Poll the debug data
-            ConfirmFrame = ExternControl.Frame;
+                        DebugDataIntervall = pRxData[0] * 10;
-            DebugDataAnforderung = 1;
+            if (DebugDataIntervall) DebugDataAnforderung = 1;
-            PcZugriff = 255;
             break;
-   case 'f': // Poll the debug data
-            DebugDataAnforderung = 1;
-            break;
-   case 'h':// x-1 Displayzeilen
+   case 'l':// x-1 Displayzeilen
-            Decode64((unsigned char *) &tmp_char_arr2[0],sizeof(tmp_char_arr2),3,AnzahlEmpfangsBytes);
-            RemoteTasten |= tmp_char_arr2[0];
+            MenuePunkt = pRxData[0];
-                        if(tmp_char_arr2[1] == 255) NurKanalAnforderung = 1; else NurKanalAnforderung = 0; // keine Displaydaten
                         DebugDisplayAnforderung = 1;
                         break;
-   case 't':// Motortest
+   case 'm':// Motortest
-            Decode64((unsigned char *) &MotorTest[0],sizeof(MotorTest),3,AnzahlEmpfangsBytes);
+            memcpy(&MotorTest[0], (unsigned char *)pRxData, sizeof(MotorTest));
-            PcZugriff = 255;
+            while(!UebertragungAbgeschlossen);
-                        break;
-   case 'k':// Keys von DubWise
-            Decode64((unsigned char *) &DubWiseKeys[0],sizeof(DubWiseKeys),3,AnzahlEmpfangsBytes);
+            SendOutData('M', MeineSlaveAdresse, 0);
-                        ConfirmFrame = DubWiseKeys[3];
             PcZugriff = 255;
                         break;
    case 'v': // Version-Anforderung     und Ausbaustufe
             GetVersionAnforderung = 1;
             break;
    case 'g'://
                         GetExternalControl = 1;
             break;
+   case 'p': // get PPM Channels
+                        GetPPMChannelAnforderung = 1;
+                        break;
-   case 'q':// "Get"-Anforderung für Settings
+   case 't':// "Get"-Anforderung für Settings
             // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen
+            if(pRxData[0] == 0xFF)
+                        {
+                                pRxData[0] = GetActiveParamSetNumber();
+                        }
+                        else // request active parameter set
+                        {
+                                if(pRxData[0] < 1) pRxData[0] = 1; // limit to 5
+                                else if(pRxData[0] > 5) pRxData[0] = 5; // limit to 5
+                                // load requested parameter set
-            Decode64((unsigned char *) &tmp_char_arr2[0],sizeof(tmp_char_arr2),3,AnzahlEmpfangsBytes);
+                                ReadParameterSet(pRxData[0], (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
+                        }
             while(!UebertragungAbgeschlossen);
-            if(tmp_char_arr2[0] != 0xff)
-             {
-                          if(tmp_char_arr2[0] > 5) tmp_char_arr2[0] = 5;
-                  ReadParameterSet(tmp_char_arr2[0], (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
-                  SendOutData('L' + tmp_char_arr2[0] -1,MeineSlaveAdresse,(unsigned char *) &EE_Parameter.Kanalbelegung[0],STRUCT_PARAM_LAENGE);
-             }
-             else
-                  SendOutData('L' + GetActiveParamSetNumber()-1,MeineSlaveAdresse,(unsigned char *) &EE_Parameter.Kanalbelegung[0],STRUCT_PARAM_LAENGE);
+            SendOutData('T', MeineSlaveAdresse, 2, &pRxData[0], sizeof(unsigned char), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
             break;
-   case 'l':
-   case 'm':
-   case 'n':
-   case 'o':
-   case 'p': // Parametersatz speichern
+   case 's': // Parametersatz speichern
+                        if((1 <= pRxData[0]) && (pRxData[0] <= 5)) // check for setting to be in range
+                        {
-            Decode64((unsigned char *) &EE_Parameter.Kanalbelegung[0],STRUCT_PARAM_LAENGE,3,AnzahlEmpfangsBytes);
+                                memcpy((unsigned char *) &EE_Parameter.Kanalbelegung[0], (unsigned char *)&pRxData[1], STRUCT_PARAM_LAENGE);
-                        WriteParameterSet(RxdBuffer[2] - 'l' + 1, (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
+                                WriteParameterSet(pRxData[0], (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
-            eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], RxdBuffer[2] - 'l' + 1);  // aktiven Datensatz merken
+                                eeprom_write_byte(&EEPromArray[EEPROM_ADR_ACTIVE_SET], RxdBuffer[2] - 'l' + 1);  // aktiven Datensatz merken
-            Umschlag180Nick = (long) EE_Parameter.WinkelUmschlagNick * 2500L;
+                                Umschlag180Nick = (long) EE_Parameter.WinkelUmschlagNick * 2500L;
-            Umschlag180Roll = (long) EE_Parameter.WinkelUmschlagRoll * 2500L;
+                                Umschlag180Roll = (long) EE_Parameter.WinkelUmschlagRoll * 2500L;
-            Piep(GetActiveParamSetNumber());
+                                Piep(GetActiveParamSetNumber());
+                                while(!UebertragungAbgeschlossen);
+                SendOutData('S', MeineSlaveAdresse, 1, &pRxData[0], sizeof(unsigned char));
+                        }
-         break;
+                        break;
+  }
 // DebugOut.AnzahlZyklen =  Debug_Timer_Intervall;
- NeuerDatensatzEmpfangen = 0;
+        NeuerDatensatzEmpfangen = 0;
+        pRxData = 0;
+        RxDataLen = 0;
+}
 //############################################################################
 //Routine für die Serielle Ausgabe
 int uart_putchar (char c)
 //############################################################################
+{
         if (c == '\n')
                 uart_putchar('\r');
         //Warten solange bis Zeichen gesendet wurde
         loop_until_bit_is_set(USR, UDRE);
         //Ausgabe des Zeichens
         UDR = c;
         return (0);
+}
 // --------------------------------------------------------------------------
 void WriteProgramData(unsigned int pos, unsigned char wert)
+{
   //if (ProgramLocation == IN_RAM) Buffer[pos] = wert;
   // else eeprom_write_byte(&EE_Buffer[pos], wert);
   // Buffer[pos] = wert;
+}
 //############################################################################
 //INstallation der Seriellen Schnittstelle
 void UART_Init (void)
 //############################################################################
+{
         //Enable TXEN im Register UCR TX-Data Enable & RX Enable
         UCR=(1 << TXEN) | (1 << RXEN);
     // UART Double Speed (U2X)
         USR   |= (1<<U2X);
         // RX-Interrupt Freigabe
         UCSRB |= (1<<RXCIE);
         // TX-Interrupt Freigabe
         UCSRB |= (1<<TXCIE);
         //Teiler wird gesetzt
         UBRR=(SYSCLK / (BAUD_RATE * 8L) - 1);
         //UBRR = 33;
         //öffnet einen Kanal für printf (STDOUT)
         //fdevopen (uart_putchar, 0);
         //sbi(PORTD,4);
-  Debug_Timer = SetDelay(200);
+        Debug_Timer = SetDelay(DebugDataIntervall);
-  Kompass_Timer = SetDelay(220);
+        Kompass_Timer = SetDelay(220);
-  MeineSlaveAdresse = 1; // Flight-Ctrl
+        MeineSlaveAdresse = 1; // Flight-Ctrl
+        VersionInfo.Major = VERSION_MAJOR;
+        VersionInfo.Minor = VERSION_MINOR;
+        VersionInfo.Patch = VERSION_PATCH;
+        VersionInfo.Compatible  = VERSION_SERIAL_COMPATIBLE;
+        pRxData = 0;
+        RxDataLen = 0;
+}
 //---------------------------------------------------------------------------------------------
 void DatenUebertragung(void)
+{
  if(!UebertragungAbgeschlossen) return;
    if(GetExternalControl && UebertragungAbgeschlossen)        // Bei Get werden die vom PC einstellbaren Werte vom PC zurückgelesen
    {
-      SendOutData('G',MeineSlaveAdresse,(unsigned char *) &ExternControl,sizeof(ExternControl));
+      SendOutData('G',MeineSlaveAdresse, 1, (unsigned char *) &ExternControl, sizeof(ExternControl));
           GetExternalControl = 0;
+   }
     if((CheckDelay(Kompass_Timer)) && UebertragungAbgeschlossen)
+         {
                   WinkelOut.Winkel[0] = (int) (IntegralNick / 108);  // etwa in 0,1 Grad
                   WinkelOut.Winkel[1] = (int) (IntegralRoll / 108);  // etwa in 0,1 Grad
                   WinkelOut.UserParameter[0] = Parameter_UserParam1;
                   WinkelOut.UserParameter[1] = Parameter_UserParam2;
-          SendOutData('w',MeineSlaveAdresse,(unsigned char *) &WinkelOut,sizeof(WinkelOut));
+          SendOutData('k',MeineSlaveAdresse, 1, (unsigned char *) &WinkelOut,sizeof(WinkelOut));
           if(WinkelOut.CalcState > 4)  WinkelOut.CalcState = 6; // wird dann in SPI auf Null gesetzt
           Kompass_Timer = SetDelay(99);
          }
-    if((CheckDelay(Debug_Timer) || DebugDataAnforderung) && UebertragungAbgeschlossen)
+    if((( DebugDataIntervall && CheckDelay(Debug_Timer)) || DebugDataAnforderung) && UebertragungAbgeschlossen)
+         {
-          SendOutData('D',MeineSlaveAdresse,(unsigned char *) &DebugOut,sizeof(DebugOut));
+          SendOutData('D',MeineSlaveAdresse, 1, (unsigned char *) &DebugOut,sizeof(DebugOut));
           DebugDataAnforderung = 0;
-          Debug_Timer = SetDelay(MIN_DEBUG_INTERVALL);
+          if(DebugDataIntervall) Debug_Timer = SetDelay(DebugDataIntervall);
          }
     if(DebugTextAnforderung != 255) // Texte für die Analogdaten
+     {
-      SendOutData('A',DebugTextAnforderung + '0',(unsigned char *) ANALOG_TEXT[DebugTextAnforderung],16);
+      SendOutData('A', MeineSlaveAdresse, 2, (unsigned char *)&DebugTextAnforderung, sizeof(DebugTextAnforderung),(unsigned char *) ANALOG_TEXT[DebugTextAnforderung], 16);
       DebugTextAnforderung = 255;
+         }
-     if(ConfirmFrame && UebertragungAbgeschlossen)   // Datensatz ohne CRC bestätigen
+     if(ConfirmFrame && UebertragungAbgeschlossen)   // Datensatz bestätigen
+         {
-      SendeBuffer[0] = '#';
-      SendeBuffer[1] = ConfirmFrame;
+                SendOutData('B', MeineSlaveAdresse, 1, (uint8_t*)&ConfirmFrame, sizeof(ConfirmFrame));
-      SendeBuffer[2] = '\r';
-      UebertragungAbgeschlossen = 0;
-      ConfirmFrame = 0;
+        ConfirmFrame = 0;
-      UDR = SendeBuffer[0];
+     }
      if(DebugDisplayAnforderung && UebertragungAbgeschlossen)
+         {
       Menu();
+      SendOutData('L',MeineSlaveAdresse, 3, &MenuePunkt, sizeof(MenuePunkt), &MaxMenue, sizeof(MaxMenue), DisplayBuff, sizeof(DisplayBuff));
           DebugDisplayAnforderung = 0;
-      if(++RemotePollDisplayLine == 4 || NurKanalAnforderung)
-      {
-       SendOutData('4',0,(unsigned char *)&PPM_in,sizeof(PPM_in));   // DisplayZeile übertragen
-       RemotePollDisplayLine = -1;
-      }
-      else  SendOutData('0' + RemotePollDisplayLine,0,(unsigned char *)&DisplayBuff[20 * RemotePollDisplayLine],20);   // DisplayZeile übertragen
          }
     if(GetVersionAnforderung && UebertragungAbgeschlossen)
      {
-      SendOutData('V',MeineSlaveAdresse,(unsigned char *) &VersionInfo,sizeof(VersionInfo));
+      SendOutData('V',MeineSlaveAdresse, 1, (unsigned char *) &VersionInfo, sizeof(VersionInfo));
           GetVersionAnforderung = 0;
+     }
+     if(GetPPMChannelAnforderung && UebertragungAbgeschlossen)
+     {
+                 SendOutData('P',MeineSlaveAdresse, 1, (unsigned char *) &PPM_in, sizeof(PPM_in));
+                 GetPPMChannelAnforderung = 0;
+         }
+}

Subversion Repositories FlightCtrl

(root)/tags/V0.80e/uart.c @ 1951 - Rev 1038 → 1051