1对6

zhyinch

2022-03-01 617d989d294c30b5f04f643b1ec7e5d9b4878a1a

 Ô´Âë/ºËÐÄ°å/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)
{
@@ -130,6 +144,8 @@
u16 rtcm_i,gps_packlen;
u16 t1,t2,t3,t4;
extern volatile uint32_t time32_incr;
extern u16 sendtimes;
u16 last_sendtimes;
void UART_CheckReceive(void)
{
   int32_t DMACnt = 0;
@@ -147,7 +163,7 @@
      m_bEUARTCheckingRec = 0;
      return;
   }
   if(time32_incr-lastusartdata_timer>300&&receiveingdata_flag)
   if(time32_incr-lastusartdata_timer>450&&receiveingdata_flag)
   {
      gpsdataready_flag = 1;
      receiveingdata_flag = 0;
@@ -155,6 +171,8 @@
      rtcm_i = 0;
      t1++;
      waitggaend_flag = 1;
      last_sendtimes = sendtimes;
      sendtimes = 0;
      if(g_com_map[DEV_ROLE])
      {
         UWBSendOnePackData(RTCMdata,gps_packlen);
@@ -359,3 +377,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;
}