Mercurial > public > ostc4

diff Small_CPU/Src/uartProtocol_GNSS.c @ 899:2225c467f1e9 Evo_2_23 tip

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
Added data path and visualization for position data: The GNSS data exchange is now initialized and triggered on a cyclic basis (once a second). RTE verion has been increased because of interface change. For now only the position data is shown in a T7 surface views. The functionality may be switched on/off using the compile switch ENABLE_GNSS.
author Ideenmodellierer
date Mon, 30 Sep 2024 21:56:05 +0200
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Small_CPU/Src/uartProtocol_GNSS.c	Mon Sep 30 21:56:05 2024 +0200
@@ -0,0 +1,113 @@
+/**
+  ******************************************************************************
+  * @file    uartProtocol_GNSS.c
+  * @author  heinrichs weikamp gmbh
+  * @version V0.0.1
+  * @date    30-Sep-2024
+  * @brief   Interface functionality operation of GNSS devices
+  *
+  @verbatim
+
+
+  @endverbatim
+  ******************************************************************************
+  * @attention
+  *
+  * <h2><center>&copy; COPYRIGHT(c) 2024 heinrichs weikamp</center></h2>
+  *
+  ******************************************************************************
+  */
+/* Includes ------------------------------------------------------------------*/
+
+#include <string.h>
+#include "scheduler.h"
+#include <uartProtocol_GNSS.h>
+#include "uart.h"
+#include "GNSS.h"
+
+#ifdef ENABLE_GNSS
+
+static uartGnssStatus_t gnssOpState = UART_GNSS_INIT;
+static receiveStateGnss_t rxState = GNSSRX_READY;
+
+void ConvertByteToHexString(uint8_t byte, char* str)
+{
+	uint8_t worker = 0;
+	uint8_t digit = 0;
+	uint8_t digitCnt = 1;
+
+	worker = byte;
+	while((worker!=0) && (digitCnt != 255))
+	{
+		digit = worker % 16;
+		if( digit < 10)
+		{
+			digit += '0';
+		}
+		else
+		{
+			digit += 'A' - 10;
+		}
+		str[digitCnt--]= digit;
+		worker = worker / 16;
+	}
+}
+
+void uartGnss_Control(void)
+{
+	static uint32_t delayStartTick = 0;
+
+	uint32_t tick = HAL_GetTick();
+
+	switch (gnssOpState)
+	{
+		case UART_GNSS_INIT:	delayStartTick = tick;
+								gnssOpState = UART_GNSS_LOAD;
+				break;
+		case UART_GNSS_LOAD:	if(time_elapsed_ms(delayStartTick,HAL_GetTick()) > 1000)
+								{
+									GNSS_LoadConfig(&GNSS_Handle);
+									gnssOpState = UART_GNSS_GET_ID;
+									delayStartTick = tick;
+								}
+				break;
+		case UART_GNSS_GET_ID:	if(time_elapsed_ms(delayStartTick,HAL_GetTick()) > 250)
+								{
+									GNSS_GetUniqID(&GNSS_Handle);
+									gnssOpState = UART_GNSS_IDLE;
+									rxState = GNSSRX_RECEIVING;
+									delayStartTick = tick;
+								}
+				break;
+		case UART_GNSS_IDLE:	if(time_elapsed_ms(delayStartTick,HAL_GetTick()) > 1000)
+								{
+									GNSS_GetPVTData(&GNSS_Handle);
+									gnssOpState = UART_GNSS_OPERATING;
+									rxState = GNSSRX_RECEIVING;
+									delayStartTick = tick;
+								}
+				break;
+		case UART_GNSS_OPERATING: if(time_elapsed_ms(delayStartTick,HAL_GetTick()) > 1000)
+								{
+									gnssOpState = UART_GNSS_IDLE;	/* simple error handling => start next request */
+									rxState = GNSSRX_READY;
+								}
+				break;
+		default:
+				break;
+	}
+}
+
+void uartGnss_ProcessData(void)
+{
+	if(rxState == GNSSRX_RECEIVING)
+	{
+		if(GNSS_ParseBuffer(&GNSS_Handle))
+		{
+			gnssOpState = UART_GNSS_IDLE;
+		}
+	}
+}
+
+#endif
+