WebSVN - NaviCtrl - Diff - Rev 608 and 620

 NaviData_Home_t NaviData_Home;
 NaviData_Target_t NaviData_Target;
 NaviData_Flags_t NaviData_Flags;
 NaviData_Tiny_t NaviData_Tiny;
 NaviData_Pos_t NaviData_Failsafe;
-NaviData_Pos_t NaviData_Out1Trigger;
+NaviData_Out_t NaviData_Out1Trigger;
 NaviData_t NaviData;
 u8 UART1_Request_VersionInfo    = FALSE;
 u8 UART1_Request_ExternalControl= FALSE;
                         i2 = abs(GPSData.Position.Longitude)%10000000L;
 */
+}
+u16 SendTriggerPos(void)
+{
+ u16 sent = 0;
+ NaviData_Out1Trigger.Index = 18;
+ sent = MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'O', NC_ADDRESS, 1 , (u8 *)&NaviData_Out1Trigger, sizeof(NaviData_Out1Trigger)) + 1;
+ Out1TriggerUpdateNewData = 0;
+// BeepTime = 50; // beep
+ return(sent);
+}
 u16 TransmitNavigationData(u16 MaxBytesPerSecond, u8 clear) // returns the minumum pause time in ms
 {
 static u8 state = 0, count_flags = 2, count_target = 3, count_home = 4, count_wp = 5 , count_tiny = 6, count_fs = 7;
-static u16 CRC_Home = 0, CRC_Target = 0, CRC_Flags = 0, CRC_Wp = 0, CRC_Fs = 0, CRC_Out;
+static u16 CRC_Home = 0, CRC_Target = 0, CRC_Flags = 0, CRC_Wp = 0, CRC_Fs = 0;
-u16 pause, sent = 0, crc_home, crc_target, crc_flags, crc_wp, crc_fs, crc_out;
+u16 pause, sent = 0, crc_home, crc_target, crc_flags, crc_wp, crc_fs;
         CRC_Fs++;
         return(1);
+ }
 while(!sent)
+ {
+//      if(Out1TriggerUpdateNewData && MaxBytesPerSecond > 200)   // (only if the data link can transmit more than 200Bytes per secons) -> it wouldn't fit into the data-flow if there are too few bytes available
+//     sent += SendTriggerPos(); // dann passen die 35 Bytes noch ohne Verzögerung
                 switch(state++)
+                {
                  case 0:
                  case 6:
+                 case 5:
 // belegt 35 ASCII-Zeichen
                                 NaviData_Flags.Index = 11;
                                 NaviData_Flags.ActualLongitude = NaviData.CurrentPosition.Longitude;
                                 NaviData_Flags.ActualLatitude = NaviData.CurrentPosition.Latitude;
                                 NaviData_Flags.Altimeter = NaviData.Altimeter;
                                  count_wp = 12*2;
+                                }
                                 break;
                  case 3:
                  case 9:
-// 39 ASCII-Zeichen
+// 35 ASCII-Zeichen
                                 NaviData_Failsafe.Index = 17;
                                 NaviData_Failsafe.ActualLongitude = NaviData.CurrentPosition.Longitude;
                                 NaviData_Failsafe.ActualLatitude = NaviData.CurrentPosition.Latitude;
                                 NaviData_Failsafe.Altimeter = NaviData.Altimeter;
                                 NaviData_Failsafe.GroundSpeed = NaviData.GroundSpeed / 10;
                                 NaviData_Failsafe.OSDStatusFlags = (FC.StatusFlags & OSD_FLAG_MASK1) | (FC.StatusFlags2 & OSD_FLAG_MASK2);
                                 NaviData_Failsafe.Longitude = GPS_FailsafePosition.Longitude;
                                 NaviData_Failsafe.Latitude = GPS_FailsafePosition.Latitude;
-                                NaviData_Failsafe.Altitude = GPS_FailsafePosition.Altitude;
                                 crc_fs = CRC16((unsigned char*)(&NaviData_Failsafe.Longitude), sizeof(NaviData_Pos_t) - START_PAYLOAD_DATA); // update crc for the license structure
                                 if((crc_fs != CRC_Fs) || (--count_fs == 0))
+                                {
                                  sent += MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'O', NC_ADDRESS, 1 , (u8 *)&NaviData_Failsafe, sizeof(NaviData_Failsafe)) + 1;
                                  CRC_Fs = crc_fs;
                                  sent += MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'O', NC_ADDRESS, 1 , (u8 *)&NaviData_Home, sizeof(NaviData_Home)) + 1;
                                  CRC_Home = crc_home;
                                  count_home = 25;
+                                }
                                 break;
-                 case 5:
                  case 11:
-                 case 13:
-// 39 ASCII-Zeichen
-                                NaviData_Out1Trigger.Index = 18;
-                                NaviData_Out1Trigger.ActualLongitude = NaviData.CurrentPosition.Longitude;
-                                NaviData_Out1Trigger.ActualLatitude = NaviData.CurrentPosition.Latitude;
-                                NaviData_Out1Trigger.Altimeter = NaviData.Altimeter;
-                                NaviData_Out1Trigger.GroundSpeed = NaviData.GroundSpeed / 10;
-                                NaviData_Out1Trigger.OSDStatusFlags = (FC.StatusFlags & OSD_FLAG_MASK1) | (FC.StatusFlags2 & OSD_FLAG_MASK2);
-                                crc_out = CRC16((unsigned char*)(&NaviData_Out1Trigger.Longitude), sizeof(NaviData_Pos_t) - START_PAYLOAD_DATA); // update crc for the license structure
-                                if((crc_out != CRC_Out))
-                                {
-                                 sent += MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'O', NC_ADDRESS, 1 , (u8 *)&NaviData_Out1Trigger, sizeof(NaviData_Out1Trigger)) + 1;
-                                 CRC_Out = crc_out;
-DebugOut.Analog[17]++;
-                                }
-                                break;
-                 case 12:
 // belegt 39 ASCII-Zeichen
                                 NaviData_Deviation.Index = 14;
                                 NaviData_Deviation.ActualLongitude = NaviData.CurrentPosition.Longitude;
                                 NaviData_Deviation.ActualLatitude = NaviData.CurrentPosition.Latitude;
                                 NaviData_Deviation.Altimeter = NaviData.Altimeter;
                                 NaviData_Deviation.AngleNick = NaviData.AngleNick;
                                 NaviData_Deviation.AngleRoll = NaviData.AngleRoll;
                                 NaviData_Deviation.SatsInUse = NaviData.SatsInUse;
                             sent += MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'O', NC_ADDRESS, 1 , (u8 *)&NaviData_Deviation, sizeof(NaviData_Deviation)) + 1;
                                 break;
-                 case 14:
+                 case 12:
 // belegt 43 ASCII-Zeichen
                                 NaviData_Volatile.Index = 16;
                                 NaviData_Volatile.ActualLongitude = NaviData.CurrentPosition.Longitude;
                                 NaviData_Volatile.ActualLatitude = NaviData.CurrentPosition.Latitude;
                                 NaviData_Volatile.Altimeter = NaviData.Altimeter;
                                 NaviData_Volatile.CompassHeading = NaviData.CompassHeading / 2;
                                 NaviData_Volatile.Gas = NaviData.Gas;
                                 NaviData_Volatile.SetpointAltitude = NaviData.SetpointAltitude;
                                 sent += MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'O', NC_ADDRESS, 1 , (u8 *)&NaviData_Volatile, sizeof(NaviData_Volatile)) + 1;
                         break;
-                 case 15:
+                 case 13:
 // belegt 27 ASCII-Zeichen
                                 NaviData_Tiny.Index = 10;
                                 NaviData_Tiny.ActualLongitude = NaviData.CurrentPosition.Longitude;
                                 NaviData_Tiny.ActualLatitude = NaviData.CurrentPosition.Latitude;
                                 NaviData_Tiny.Altimeter = NaviData.Altimeter;
                                 break;
+                }
+ }
         pause = (sent * 1000) / MaxBytesPerSecond;
         UART1_NaviData_Timer = SetDelay(UART1_NaviData_Interval);
         UART1_Request_NaviData = FALSE;
         LastTransmittedFCStatusFlags2 = NaviData.FCStatusFlags2;
 return(pause);
 // Clear at timeout:
         else if(UART1_ExternalControlConfirmFrame && (UART1_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&UART1_tx_buffer, 'B', NC_ADDRESS, 1,(u8 *)&UART1_ExternalControlConfirmFrame, sizeof(UART1_ExternalControlConfirmFrame));
                 UART1_ExternalControlConfirmFrame = 0;
+        }
+        else
+        if((UART1_NaviData_Interval > 0) && Out1TriggerUpdateNewData && UART1_NaviData_MaxBytes > 200)    // (only if the data link can transmit more than 200Bytes per secons) -> it wouldn't fit into the data-flow if there are too few bytes available
+         {
+          //sent +=
+          SendTriggerPos(); // dann passen die 35 Bytes noch ohne Verzögerung
+         }
         else if(( ((UART1_NaviData_Interval > 0) && CheckDelay(UART1_NaviData_Timer) ) || UART1_Request_NaviData) && (UART1_tx_buffer.Locked == FALSE))
+        {
           u16 time = 0;
 //UART1_NaviData_MaxBytes = 250;
       if(UART1_NaviData_MaxBytes == 0) // Transmit the big NC Data frame

Subversion Repositories NaviCtrl

(root)/tags/V2.18a/uart1.c @ 816 - Rev 608 → 620