WebSVN - NaviCtrl - Diff - Rev 112 and 116

 // +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 // +  POSSIBILITY OF SUCH DAMAGE.
 // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 #include <stdio.h>
 #include <stdarg.h>
+#include <string.h>
 #include "91x_lib.h"
 #include "main.h"
 #include "uart0.h"
 #include "uart1.h"
 #include "timer.h"
 #include "ubx.h"
 #include "mkprotocol.h"
-u8 UART0_Request_VersionInfo    = FALSE;
-u8 UART0_Request_NaviData               = FALSE;
-u32 UART0_NaviData_Timer;
 u32 UART0_NaviData_Interval = 0;        // in ms
 //------------------------------------------------------------------------------------
+// global variables
-// global variables
+MKOSD_VersionInfo_t MKOSD_VersionInfo;
 #define UART0_BAUD_RATE 57600           //Baud Rate for the serial interfaces
 // UART0 MUXER
 UART0_MuxerState_t UART0_Muxer = UART0_UNDEF;
 // the rx buffer
 #define UART0_RX_BUFFER_LEN  150
 u8 UART0_rbuffer[UART0_RX_BUFFER_LEN];
 Buffer_t UART0_rx_buffer;
+u8 UART0_Request_VersionInfo    = FALSE;
+u8 UART0_Request_NaviData               = FALSE;
+u32 UART0_NaviData_Timer;
 u32 UART0_NaviData_Interval = 0;        // in ms
 //------------------------------------------------------------------------------------
         MKProtocol_DecodeSerialFrame(&UART0_rx_buffer, &SerialMsg); // decode serial frame in rxd buffer
+        switch(SerialMsg.Address) // check for Slave Address
+        {
+                case MKOSD_ADDRESS: // answers from the MKOSD
+                        switch(SerialMsg.CmdID)
+                        {
+                                case 'V':
+                                        memcpy(&MKOSD_VersionInfo, SerialMsg.pData, sizeof(MKOSD_VersionInfo)); // copy echo pattern
+                                        break;
+                                default:
+                                        break;
+                        } // case MKOSD_ADDRESS
-        switch(SerialMsg.Address) // check for Slave Address
+                        break;
-        {
                 case NC_ADDRESS:  // own Slave Address
-                switch(SerialMsg.CmdID)
+                        switch(SerialMsg.CmdID)
-                {
+                        {
-                        default:
+                                default:
-                                break;
+                                        break;
-                } // case NC_ADDRESS
+                        } // case NC_ADDRESS
-                // "break;" is missing here to fall thru to the common commands
+                        // "break;" is missing here to fall thru to the common commands
-                default:  // and any other Slave Address
+                default:  // and any other Slave Address
-                switch(SerialMsg.CmdID) // check CmdID
+                        switch(SerialMsg.CmdID) // check CmdID
-                {
+                        {
-                        case 'o': // request for navigation information
+                                case 'o': // request for navigation information
-                                UART0_NaviData_Interval = (u32) SerialMsg.pData[0] * 10;
+                                        UART0_NaviData_Interval = (u32) SerialMsg.pData[0] * 10;
-                                if(UART0_NaviData_Interval > 0) UART0_Request_NaviData = TRUE;
+                                        if(UART0_NaviData_Interval > 0) UART0_Request_NaviData = TRUE;
-                                break;
+                                        break;
-                        case 'v': // request for version info
+                                case 'v': // request for version info
-                                UART0_Request_VersionInfo = TRUE;
+                                        UART0_Request_VersionInfo = TRUE;
-                                break;
+                                        break;
-                        default:
+                                default:
-                                // unsupported command recieved
+                                        // unsupported command recieved
-                                break;
+                                        break;
+                        }
-                break; // default:
+                        break; // default:
+        }
+{
         if(DebugUART == UART0) return;
         UART0_Transmit(); // output pending bytes in tx buffer
         if(UART0_tx_buffer.Locked == TRUE) return;
+        if(UART0_Request_VersionInfo && (UART0_tx_buffer.Locked == FALSE))
+        {
+                MKProtocol_CreateSerialFrame(&UART0_tx_buffer, 'V', NC_ADDRESS,1, (u8 *)&UART_VersionInfo, sizeof(UART_VersionInfo));
+                UART0_Request_VersionInfo = FALSE;
+        }
         if(( (UART0_NaviData_Interval && CheckDelay(UART0_NaviData_Timer) ) || UART0_Request_NaviData) && (UART0_tx_buffer.Locked == FALSE))
+        {
                 NaviData.Errorcode = ErrorCode;
                 MKProtocol_CreateSerialFrame(&UART0_tx_buffer, 'O', NC_ADDRESS,1, (u8 *)&NaviData, sizeof(NaviData));
                 UART0_NaviData_Timer = SetDelay(UART0_NaviData_Interval);
                 UART0_Request_NaviData = FALSE;
+        }
         UART0_Transmit(); // output pending bytes in tx buffer
+}
+/**************************************************************/
+/* Get the version of the MKOSD                               */
+/**************************************************************/
+void UART0_GetMKOSDVersion(void)
+{
+        u32 timeout;
+        u8 msg[64];
+        MKOSD_VersionInfo.SWMajor = 0xFF;
+        MKOSD_VersionInfo.SWMinor = 0xFF;
+        MKOSD_VersionInfo.SWPatch = 0xFF;
+        if(UART0_Muxer != UART0_MKGPS) UART0_Connect_to_MKGPS();
+        while(UART0_tx_buffer.Locked == TRUE) UART0_Transmit(); // output pending bytes in tx buffer;
+        MKProtocol_CreateSerialFrame(&UART0_tx_buffer, 'v', MKOSD_ADDRESS, 0); // request for version info
+        while(UART0_tx_buffer.Locked == TRUE) UART0_Transmit(); // output pending bytes in tx buffer;
+        timeout = SetDelay(500);
+        do
+        {
+                UART0_ProcessRxData();
+                if(MKOSD_VersionInfo.SWMajor != 0xFF) break;
+        }while(!CheckDelay(timeout));
+        if(MKOSD_VersionInfo.SWMajor != 0xFF)
+        {
+                sprintf(msg, "\n\r MK-OSD V%d.%d%c", MKOSD_VersionInfo.SWMajor, MKOSD_VersionInfo.SWMinor, 'a'+MKOSD_VersionInfo.SWPatch);
+                UART1_PutString(msg);
+        }
+        //else UART1_PutString("\n\r No version information from MK-OSD.");

Subversion Repositories NaviCtrl

(root)/tags/V0.28i/uart0.c @ 506 - Rev 112 → 116