From 85cdaac35f9db30b91f45ead0d78c2c0ee3220cb Mon Sep 17 00:00:00 2001
From: zhyinch <zhyinch@gmail.com>
Date: 星期四, 23 十二月 2021 10:49:44 +0800
Subject: [PATCH] 初步测试完成
---
源码/核心板/Src/OnChipDevices/Usart.c | 233 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1 files changed, 233 insertions(+), 0 deletions(-)
diff --git "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/OnChipDevices/Usart.c" "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/OnChipDevices/Usart.c"
index 21b7603..1b05619 100644
--- "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/OnChipDevices/Usart.c"
+++ "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/OnChipDevices/Usart.c"
@@ -1,5 +1,6 @@
#include "Usart.h"
#include <string.h>
+#include <stdarg.h>
#include <stdio.h>
#include "modbus.h"
#include "Rcc_Nvic_Systick.h"
@@ -25,7 +26,20 @@
{
m_EUART_TxFrm_FreeFrmLen = EUART_TX_FRM_SIZE-1;
}
+ HIDO_DataStruct stPosState[4];
+HIDO_INT32 GPS_ParseGGA(HIDO_CHAR *_pcData, HIDO_UINT32 _u32Len)
+{
+ if (HIDO_UtilParseFormat((HIDO_UINT8 *) _pcData, _u32Len, "$%*,%*,%p,%*,%p,%*,%p,%*,%*,%p,%*,%*,%*,%*,%**",
+ &stPosState[0], &stPosState[1], &stPosState[2], &stPosState[3]) != 15)
+ {
+ return HIDO_ERR;
+ }
+
+ //l_u8PosState = atoi((HIDO_CHAR *)stPosState.m_pData);
+
+ return HIDO_OK;
+}
//UART DMA的配置
void UART_DMAConfiguration(void)
{
@@ -359,3 +373,222 @@
return (ch);
}
+HIDO_UINT32 HIDO_UtilParseFormat(HIDO_UINT8 *_pu8Src, HIDO_UINT32 _u32SrcLen, const HIDO_CHAR *_pcFmt, ...)
+{
+ va_list sArgPtr = { NULL };
+ int nParseNum = 0;
+ HIDO_CHAR cSign = ' ';
+ HIDO_BOOL bReturn = HIDO_FALSE;
+
+ if((NULL == _pu8Src) || (NULL == _pcFmt))
+ {
+ return 0;
+ }
+
+ va_start(sArgPtr, _pcFmt);
+
+ while ((*_pcFmt) != '\0')
+ {
+ if(0 == _u32SrcLen)
+ {
+ if(!(('%' == *_pcFmt) && ('e' == *(_pcFmt + 1))))
+ {
+ break;
+ }
+ }
+
+ if ((*_pcFmt) == '%')
+ {
+ _pcFmt++;
+ cSign = *(_pcFmt++);
+
+ switch (cSign)
+ {
+ case '*':
+ {
+ while (_u32SrcLen)
+ {
+ if (*_pu8Src != *_pcFmt)
+ {
+ _pu8Src++;
+ _u32SrcLen--;
+ }
+ else
+ {
+ break;
+ }
+ }
+
+ nParseNum++;
+
+ break;
+ }
+ case 'd':
+ {
+ HIDO_BOOL bNeg = HIDO_FALSE;
+ HIDO_BOOL bBeg = HIDO_FALSE;
+
+ HIDO_UINT32 nResult = 0;
+ int *pInt = NULL;
+ HIDO_CHAR c = ' ';
+
+ pInt = va_arg(sArgPtr, INT32_PTR);
+
+ while (_u32SrcLen)
+ {
+ c = *_pu8Src;
+
+ if ((HIDO_FALSE == bBeg) && c == '-')
+ {
+ bNeg = HIDO_TRUE;
+ bBeg = HIDO_TRUE;
+ }
+ else if ((c >= '0') && (c <= '9'))
+ {
+ bBeg = HIDO_TRUE;
+ nResult = nResult * 10 + (c - '0');
+ }
+ else
+ {
+ break;
+ }
+
+ _pu8Src++;
+ _u32SrcLen--;
+ }
+
+ if (HIDO_TRUE == bNeg)
+ {
+ nResult = (~nResult) + 1;
+ }
+
+ if (NULL != pInt)
+ {
+ *pInt = nResult;
+ }
+
+ nParseNum++;
+
+ break;
+ }
+ case 'x':
+ {
+ HIDO_UINT32 nResult = 0;
+ HIDO_UINT32 *pUint = NULL;
+ HIDO_CHAR c;
+
+ pUint = va_arg(sArgPtr, UINT32_PTR);
+
+ while (_u32SrcLen)
+ {
+ c = *_pu8Src;
+
+ if ((c >= '0') && (c <= '9'))
+ {
+ nResult = (nResult << 4) + (c - '0');
+ }
+ else if ((c >= 'a') && (c <= 'f'))
+ {
+ nResult = (nResult << 4) + (c - 'a' + 0x0A);
+ }
+ else if ((c >= 'A') && (c <= 'F'))
+ {
+ nResult = (nResult << 4) + (c - 'A' + 0x0A);
+ }
+ else
+ {
+ break;
+ }
+
+ _pu8Src++;
+ _u32SrcLen--;
+ }
+
+ if (NULL != pUint)
+ {
+ *pUint = nResult;
+ }
+
+ nParseNum++;
+
+ break;
+ }
+ case 'p':
+ {
+ HIDO_DataStruct *pDptr = va_arg(sArgPtr, DATA_PTR);
+ HIDO_UINT8 *pStart = NULL;
+ HIDO_UINT32 nCount = 0;
+
+ pStart = _pu8Src;
+
+ while (_u32SrcLen)
+ {
+ if (*_pu8Src != *_pcFmt)
+ {
+ nCount++;
+ }
+ else
+ {
+ break;
+ }
+
+ _pu8Src++;
+ _u32SrcLen--;
+ }
+
+ if(NULL != pDptr)
+ {
+ pDptr->m_pData = pStart;
+ pDptr->m_u32Len = nCount;
+ }
+
+ nParseNum++;
+
+ break;
+ }
+ case 'e':
+ {
+ HIDO_UINT8 **ppPtr = va_arg(sArgPtr, U8_PTR_PTR);
+
+ if (ppPtr)
+ {
+ *ppPtr = _pu8Src;
+ }
+
+ nParseNum++;
+ bReturn = HIDO_TRUE;
+
+ break;
+ }
+ default:
+ {
+ bReturn = HIDO_TRUE;
+ nParseNum = 0;
+
+ break;
+ }
+ }
+
+ if(HIDO_TRUE == bReturn)
+ {
+ break;
+ }
+ }
+ else if (*_pu8Src == *_pcFmt)
+ {
+ _pu8Src++;
+ _pcFmt++;
+ _u32SrcLen--;
+ }
+ else
+ {
+ nParseNum = 0;
+
+ break;
+ }
+ }
+
+ va_end(sArgPtr);
+
+ return nParseNum;
+}
--
Gitblit v1.9.3