WebSVN - NaviCtrl - Diff - Rev 199 and 201

 #include "uart0.h"
 #include "uart1.h"
 #include "uart2.h"
 #include "menu.h"
+#define ABO_TIMEOUT 4000 // disable abo after 4 seconds
 u32 USB_AboTimeOut = 0;
 // the tx buffer
 #define USB_TX_BUFFER_LEN  150
 u8 USB_Request_NewWaypoint      = FALSE;
 u8 USB_Request_ReadWaypoint     = 255;
 u8 USB_Request_Data3D           = FALSE;
 u8 USB_Request_Echo                 = FALSE;
-u8 USB_DisplayLine = 0;
+u8 USB_DisplayKeys = 0;
 u8 USB_ConfirmFrame = 0;
 u32 USB_DebugData_Timer = 0;
 u32 USB_DebugData_Interval = 0; // in ms
 u32 USB_NaviData_Timer = 0;
 u32 USB_NaviData_Interval = 0;  // in ms
+u32 USB_Data3D_Timer = 0;
+u32 USB_Data3D_Interval = 0;    // in ms
-u32 USB_Data3D_Timer = 0;               // in ms
+u32 USB_Display_Timer = 0;
-u32 USB_Data3D_Interval = 0;
+u32 USB_Display_Interval = 0;   // in ms
 //-----------------------------------------------------------------
+                {
                         case 'a':// request for the labels of the analog debug outputs
                                 USB_Request_DebugLabel = SerialMsg.pData[0];
                                 if(USB_Request_DebugLabel > 31) USB_Request_DebugLabel = 31;
                                 break;
+                        /*
                         case 'b': // submit extern control
                                 memcpy(&ExternControl, SerialMsg.pData, sizeof(ExternControl));
                                 USB_ConfirmFrame = ExternControl.Frame;
                                 break;
+                        */
                         case 'd': // request for debug data;
                                 USB_DebugData_Interval = (u32) SerialMsg.pData[0] * 10;
+                                USB_AboTimeOut = SetDelay(ABO_TIMEOUT);
                                 if(USB_DebugData_Interval > 0) USB_Request_DebugData = TRUE;
                                 break;
                         case 'c': // request for 3D data;
+                                USB_Data3D_Interval = (u32) SerialMsg.pData[0] * 10;
-                                USB_Data3D_Interval = (u32) SerialMsg.pData[0] * 10;
+                                USB_AboTimeOut = SetDelay(ABO_TIMEOUT);
                                 if(USB_Data3D_Interval > 0) USB_Request_Data3D = TRUE;
                                 break;
                         /*
                         case 'g':// request for external control data
                                 USB_Request_ExternalControl = TRUE;
                                 break;
                         */
                         case 'h':// reqest for display line
-                                RemoteKeys |= SerialMsg.pData[0];
+                                USB_DisplayKeys |= ~SerialMsg.pData[0];
+                                USB_Display_Interval = (u32) SerialMsg.pData[1] * 10;
-                                if(RemoteKeys != 0) USB_DisplayLine = 0;
+                                USB_AboTimeOut = SetDelay(ABO_TIMEOUT);
                                 USB_Request_Display = TRUE;
                                 break;
                         case 'l':// reqest for display columns
                                 MenuItem = SerialMsg.pData[0];
                                 USB_Request_Display1 = TRUE;
                                 break;
                         case 'o': // request for navigation information
-                        case 'o': // request for navigation information
+                                USB_NaviData_Interval = (u32) SerialMsg.pData[0] * 10;
-                                USB_NaviData_Interval = (u32) SerialMsg.pData[0] * 10;
+                                USB_AboTimeOut = SetDelay(ABO_TIMEOUT);
                                 if(USB_NaviData_Interval > 0) USB_Request_NaviData = TRUE;
 void USB_TransmitTxData(void)
+{
         USB_Transmit(); // output pending bytes in tx buffer
         if((USB_tx_buffer.Locked == TRUE)) return;
+        if(CheckDelay(USB_AboTimeOut))
+        {
+                USB_DebugData_Interval = 0;
+                USB_NaviData_Interval = 0;
+                USB_Data3D_Interval = 0;
+                USB_Display_Interval = 0;
+        }
         if((USB_Request_DebugLabel != 0xFF) && (USB_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'A', NC_ADDRESS, 2, &USB_Request_DebugLabel, sizeof(USB_Request_DebugLabel), (u8 *) ANALOG_LABEL[USB_Request_DebugLabel], 16);
                 USB_Request_DebugLabel = 0xFF;
         }
-        if(USB_ConfirmFrame && (USB_tx_buffer.Locked == FALSE))
+        else if(USB_ConfirmFrame && (USB_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'B', NC_ADDRESS, 1, &USB_ConfirmFrame, sizeof(USB_ConfirmFrame));
                 USB_ConfirmFrame = 0;
         }
-        if( (( (USB_DebugData_Interval > 0) && CheckDelay(USB_DebugData_Timer)) || USB_Request_DebugData) && (USB_tx_buffer.Locked == FALSE))
+        else if( (( (USB_DebugData_Interval > 0) && CheckDelay(USB_DebugData_Timer)) || USB_Request_DebugData) && (USB_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'D', NC_ADDRESS, 1,(u8 *)&DebugOut, sizeof(DebugOut));
                 USB_DebugData_Timer = SetDelay(USB_DebugData_Interval);
                 USB_Request_DebugData = FALSE;
-        }
+        }
-        if((( (USB_Data3D_Interval > 0) && CheckDelay(USB_Data3D_Timer) ) || USB_Request_Data3D) && (USB_tx_buffer.Locked == FALSE))
+        else if((( (USB_Data3D_Interval > 0) && CheckDelay(USB_Data3D_Timer) ) || USB_Request_Data3D) && (USB_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'C', NC_ADDRESS, 1,(u8 *)&Data3D, sizeof(Data3D));
                 USB_Data3D_Timer = SetDelay(USB_Data3D_Interval);
                 USB_Request_Data3D = FALSE;
-        }
+        }
-        if(USB_Request_ExternalControl && (USB_tx_buffer.Locked == FALSE))
+        else if(USB_Request_ExternalControl && (USB_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'G', NC_ADDRESS, 1, (u8 *)&ExternControl, sizeof(ExternControl));
                 USB_Request_ExternalControl = FALSE;
         }
-        if(USB_Request_Display && (USB_tx_buffer.Locked == FALSE))
+        else if( (( (USB_Display_Interval > 0) && CheckDelay(USB_Display_Timer)) || USB_Request_Display) && (USB_tx_buffer.Locked == FALSE))
         {
-                LCD_PrintMenu();
-                MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'H', NC_ADDRESS, 2, &USB_DisplayLine, sizeof(USB_DisplayLine), (u8*)&DisplayBuff[USB_DisplayLine * 20], 20);
+                Menu_Update(USB_DisplayKeys);
-                USB_DisplayLine++;
+                USB_DisplayKeys = 0;
-                if(USB_DisplayLine >= 4) USB_DisplayLine = 0;
+                MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'H', NC_ADDRESS, 1, (u8*)DisplayBuff, sizeof(DisplayBuff));
                 USB_Request_Display = FALSE;
         }
-        if(USB_Request_Display1 && (USB_tx_buffer.Locked == FALSE))
+        else if(USB_Request_Display1 && (USB_tx_buffer.Locked == FALSE))
         {
-                LCD_PrintMenu();
+                Menu_Update(0);
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'L', NC_ADDRESS, 3, (u8*)&MenuItem, sizeof(MenuItem), (u8*)&MaxMenuItem, sizeof(MaxMenuItem),(u8*)DisplayBuff, sizeof(DisplayBuff));
                 USB_Request_Display1 = FALSE;
         }
-        if(USB_Request_VersionInfo && (USB_tx_buffer.Locked == FALSE))
+        else if(USB_Request_VersionInfo && (USB_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'V', NC_ADDRESS,1, (u8 *)&UART_VersionInfo, sizeof(UART_VersionInfo));
                 USB_Request_VersionInfo = FALSE;
         }
-        if(( (USB_NaviData_Interval && CheckDelay(USB_NaviData_Timer) ) || USB_Request_NaviData) && (USB_tx_buffer.Locked == FALSE))
+        else if(( (USB_NaviData_Interval && CheckDelay(USB_NaviData_Timer) ) || USB_Request_NaviData) && (USB_tx_buffer.Locked == FALSE))
+        {
                 NaviData.Errorcode = ErrorCode;
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'O', NC_ADDRESS,1, (u8 *)&NaviData, sizeof(NaviData));
                 USB_NaviData_Timer = SetDelay(USB_NaviData_Interval);
                 USB_Request_NaviData = FALSE;
         }
-        if(USB_Request_ErrorMessage && (USB_tx_buffer.Locked == FALSE))
+        else if(USB_Request_ErrorMessage && (USB_tx_buffer.Locked == FALSE))
+        {
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'E', NC_ADDRESS, 1, (u8 *)&ErrorMSG, sizeof(ErrorMSG));
                 USB_Request_ErrorMessage = FALSE;
         }
-        if(USB_Request_NewWaypoint && (USB_tx_buffer.Locked == FALSE))
+        else if(USB_Request_NewWaypoint && (USB_tx_buffer.Locked == FALSE))
+        {
                 u8 WPNumber = WPList_GetCount();
                 MKProtocol_CreateSerialFrame(&USB_tx_buffer, 'W', NC_ADDRESS, 1, &WPNumber, sizeof(WPNumber));
                 USB_Request_NewWaypoint = FALSE;
         }
-        if((USB_Request_ReadWaypoint != 0xFF) && (USB_tx_buffer.Locked == FALSE))
+        else if((USB_Request_ReadWaypoint != 0xFF) && (USB_tx_buffer.Locked == FALSE))
+        {
                 u8 WPNumber = WPList_GetCount();
                 if (USB_Request_ReadWaypoint < WPNumber)
+                {

Subversion Repositories NaviCtrl

(root)/tags/V0.20c/usb.c @ 627 - Rev 199 → 201