增加跳跃时间

zhyinch

2022-02-17 af4710835316cb2fd8dd70db7867e23147206f31

 Ô´Âë/ºËÐÄ°å/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)
{
@@ -124,7 +138,7 @@
   UART_DMAConfiguration();
   
}
u8 overrun_flag=0,receiveingdata_flag,gpsdataready_flag;
u8 overrun_flag=0,receiveingdata_flag,gpsdataready_flag,waitggaend_flag,ggaend_idx;
u8 RTCMdata[2000];
u32 lastusartdata_timer;
u16 rtcm_i,gps_packlen;
@@ -154,6 +168,7 @@
      gps_packlen = rtcm_i;
      rtcm_i = 0;
      t1++;
      waitggaend_flag = 1;
      if(g_com_map[DEV_ROLE])
      {
         UWBSendOnePackData(RTCMdata,gps_packlen);
@@ -167,6 +182,11 @@
      lastusartdata_timer = time32_incr;
      //Usart1ParseDataCallback(m_EUART_DMA_RXBuf[m_EUART_DMA_RXPtr]);
      RTCMdata[rtcm_i++] = m_EUART_DMA_RXBuf[m_EUART_DMA_RXPtr];
//      if(waitggaend_flag&&m_EUART_DMA_RXBuf[m_EUART_DMA_RXPtr]=='*')
//      {
//         waitggaend_flag = 0;
//         ggaend_idx = rtcm_i;
//      }
      //delay_us(10);
      m_EUART_DMA_RXPtr++;
      if( m_EUART_DMA_RXPtr >= EUART_RX_BUF_SIZE )
@@ -353,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;
}