| | |
| | | #include "Usart.h" |
| | | #include <string.h> |
| | | #include <stdarg.h> |
| | | #include <stdio.h> |
| | | |
| | | #include "modbus.h" |
| | | #include "Rcc_Nvic_Systick.h" |
| | | #include "global_param.h" |
| | | //æ°æ®åééååé |
| | | EUART_Frame m_EUART_TxFrames[EUART_TX_FRM_SIZE]; //æ°æ®åé帧éå |
| | | volatile int8_t m_EUART_TxFrm_Tail = 0; //æ°æ®åé帧éåå°¾æé |
| | |
| | | //DMAæ°æ®æ¥æ¶ç¼å |
| | | uint8_t m_EUART_DMA_RXBuf[EUART_RX_BUF_SIZE]; //DMAæ°æ®æ¥æ¶ç¼å |
| | | volatile int32_t m_EUART_DMA_RXPtr = 0; //å½åæ°æ®å°å |
| | | int16_t DMA_rxtemp = 0,DMA_rxtemp2 = 0; //å½åæ°æ®å°åç¼å |
| | | u16 datadelaycount = 0; //å©ä½1使°æ®å»¶æ¶çå¾
å¤ç |
| | | //æ å¿åé |
| | | volatile uint8_t m_bEUARTPushingFrms = 0; //æ£å¨å¾åééååæ°æ® |
| | | volatile uint8_t m_bEUARTCheckingSend = 0; //æ£å¨ç¡®è®¤æ°æ®åé |
| | |
| | | volatile uint8_t m_bEUARTTxEn = 0; //使è½åé |
| | | |
| | | void (*Usart1ParseDataCallback)(uint8_t); |
| | | |
| | | void Usart1InitVariables(void) |
| | | { |
| | | 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) |
| | | { |
| | |
| | | |
| | | //åå§å管è |
| | | GPIO_InitStructure.GPIO_Pin = EU_RX_PIN; |
| | | GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING; //Rx䏿è¾å
¥ |
| | | GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; //Rx䏿è¾å
¥ |
| | | GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; |
| | | GPIO_Init(EU_RX_GPIO, &GPIO_InitStructure); |
| | | |
| | |
| | | GPIO_InitStructure.GPIO_Pin = EU_485_PIN; |
| | | GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //Txæ¨æ½å¤ç¨è¾åº GPIO_Mode_AF_PP |
| | | GPIO_Init(EU_485_GPIO, &GPIO_InitStructure); |
| | | |
| | | OUT485_DISABLE; |
| | | #ifdef UART_GPIO_REMAP_ENABLE |
| | | GPIO_PinRemapConfig(UART_GPIO_REMAP, ENABLE); |
| | | #endif |
| | |
| | | UART_DMAConfiguration(); |
| | | |
| | | } |
| | | |
| | | u8 overrun_flag=0,receiveingdata_flag,gpsdataready_flag,waitggaend_flag,ggaend_idx; |
| | | u8 RTCMdata[2000]; |
| | | u32 lastusartdata_timer; |
| | | 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; |
| | |
| | | m_bEUARTCheckingRec = 0; |
| | | return; |
| | | } |
| | | if(time32_incr-lastusartdata_timer>450&&receiveingdata_flag) |
| | | { |
| | | gpsdataready_flag = 1; |
| | | receiveingdata_flag = 0; |
| | | gps_packlen = rtcm_i; |
| | | rtcm_i = 0; |
| | | t1++; |
| | | waitggaend_flag = 1; |
| | | last_sendtimes = sendtimes; |
| | | sendtimes = 0; |
| | | if(g_com_map[DEV_ROLE]) |
| | | { |
| | | UWBSendOnePackData(RTCMdata,gps_packlen); |
| | | gpsdataready_flag = 0; |
| | | } |
| | | } |
| | | DMACnt = EUART_RX_BUF_SIZE - (EUART_RX_DMA_CH->CNDTR); |
| | | while( m_EUART_DMA_RXPtr != DMACnt && MaxDataLen > 0) |
| | | { |
| | | Usart1ParseDataCallback(m_EUART_DMA_RXBuf[m_EUART_DMA_RXPtr]); |
| | | receiveingdata_flag = 1; |
| | | 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 ) |
| | | { |
| | |
| | | } |
| | | m_bEUARTCheckingRec = 0; |
| | | } |
| | | |
| | | |
| | | #ifndef EXUART_USE_TXDMA |
| | | //æ¥è¯¢æ¹å¼åéæ°æ® |
| | |
| | | { |
| | | OUT485_DISABLE; |
| | | m_bEUARTTxEn = 0; |
| | | t3++; |
| | | // temp32 = GPIOC->CRH; //C10æ¬ç©ºè¾å
¥ |
| | | // temp32 &= ~(0x00000000F<<8); |
| | | // temp32 |= (0x000000004<<8); |
| | |
| | | m_bEUARTCheckingSend = 0; |
| | | return; |
| | | } |
| | | OUT485_ENABLE; |
| | | |
| | | if(!m_bEUARTTxEn) |
| | | { |
| | | m_bEUARTTxEn = 1; |
| | | OUT485_ENABLE; |
| | | t4++; |
| | | #ifdef BAUDRATE_19200 |
| | | delay_us(500); |
| | | #else |
| | | delay_us(10); |
| | | #endif |
| | | // temp32 = GPIOC->CRH; //C10å¤ç¨æ¨æ½è¾åº |
| | | // temp32 &= ~(0x00000000F<<8); |
| | | // temp32 |= (0x000000009<<8); |
| | |
| | | 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; |
| | | } |