¶Ô±ÈÐÂÎļþ |
| | |
| | | #include "stdio.h" |
| | | #include "stdarg.h" |
| | | #include "stdlib.h" |
| | | #include "string.h" |
| | | //#include "stm32l0xx_hal.h" |
| | | #include "math.h" |
| | | #include "HIDO_Util.h" |
| | | #include "HIDO_Debug.h" |
| | | #include "HIDO_Timer.h" |
| | | |
| | | #include "GPS.h" |
| | | //#include "GPIO.h" |
| | | #include "Uart.h" |
| | | #include "WS2812.h" |
| | | #define GPS_DBG(level, fmt, ...) HIDO_Debug(fmt, __VA_ARGS__) |
| | | |
| | | #define GPS_UART_RX_BUF_SIZE 1024 |
| | | #define GPS_UART_TX_BUF_SIZE (4) |
| | | |
| | | typedef enum |
| | | { |
| | | GPS_RECV_STATE_IDLE = 0, |
| | | GPS_RECV_STATE_HEAD, |
| | | GPS_RECV_STATE_CR, |
| | | GPS_RECV_STATE_LF, |
| | | } E_GPSRecvState; |
| | | |
| | | typedef struct |
| | | { |
| | | E_GPSRecvState m_eState; |
| | | HIDO_CHAR m_acRecvBuf[128]; |
| | | HIDO_UINT32 m_u32RecvLen; |
| | | } ST_GPSRecv; |
| | | |
| | | static HIDO_UINT8 l_au8GPSUartRxBuf[GPS_UART_RX_BUF_SIZE]; |
| | | static HIDO_UINT8 l_au8GPSUartTxBuf[GPS_UART_TX_BUF_SIZE]; |
| | | |
| | | //static ST_GPIO l_astGPSPin[GPS_PIN_LAST]; |
| | | static HIDO_BOOL l_bIsPowerOn = HIDO_FALSE; |
| | | static ST_GPSRecv l_stGPSRecv; |
| | | static FN_GPSEventCallback l_fnGPSEventCallback; |
| | | ST_GPS l_stGPS; |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_AddHours |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | * Modified Date: : 2021å¹´1æ8æ¥ |
| | | *******************************************************************************/ |
| | | static void GPS_AddHours(ST_GPS *_pstGPS, HIDO_UINT32 _u32Hours) |
| | | { |
| | | _pstGPS->m_u8Hour += _u32Hours; |
| | | if (_pstGPS->m_u8Hour >= 24) |
| | | { |
| | | _pstGPS->m_u8Hour -= 24; |
| | | _pstGPS->m_u8Day++; |
| | | switch (_pstGPS->m_u8Mon) |
| | | { |
| | | case 1: |
| | | case 3: |
| | | case 5: |
| | | case 7: |
| | | case 8: |
| | | case 10: |
| | | if (_pstGPS->m_u8Day > 31) |
| | | { |
| | | _pstGPS->m_u8Day = 1; |
| | | _pstGPS->m_u8Mon++; |
| | | } |
| | | break; |
| | | case 2: |
| | | if (0 == (_pstGPS->m_u16Year % 4)) |
| | | { |
| | | if (_pstGPS->m_u8Day > 29) |
| | | { |
| | | _pstGPS->m_u8Day = 1; |
| | | _pstGPS->m_u8Mon++; |
| | | } |
| | | } |
| | | else |
| | | { |
| | | if (_pstGPS->m_u8Day > 28) |
| | | { |
| | | _pstGPS->m_u8Day = 1; |
| | | _pstGPS->m_u8Mon++; |
| | | } |
| | | } |
| | | break; |
| | | case 4: |
| | | case 6: |
| | | case 9: |
| | | case 11: |
| | | if (_pstGPS->m_u8Day > 30) |
| | | { |
| | | _pstGPS->m_u8Day = 1; |
| | | _pstGPS->m_u8Mon++; |
| | | } |
| | | break; |
| | | case 12: |
| | | if (_pstGPS->m_u8Day > 31) |
| | | { |
| | | _pstGPS->m_u8Day = 1; |
| | | _pstGPS->m_u8Mon = 1; |
| | | _pstGPS->m_u16Year++; |
| | | } |
| | | break; |
| | | } |
| | | } |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseDate |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | * Modified Date: : 2021å¹´1æ8æ¥ |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseDate(HIDO_DataStruct *_pstDateData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstDateData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *)_pstDateData->m_pData; |
| | | |
| | | if (u32Len != 6) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | _pstGPS->m_u8Day = HIDO_UtilStrBufToInt(pcStart, 2); |
| | | _pstGPS->m_u8Mon = HIDO_UtilStrBufToInt(pcStart + 2, 2); |
| | | _pstGPS->m_u16Year = HIDO_UtilStrBufToInt(pcStart + 4, 2) + 2000; |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseState |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | * Modified Date: : 2021å¹´1æ8æ¥ |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseState(HIDO_DataStruct *_pstStateData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstStateData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstStateData->m_pData; |
| | | |
| | | if (u32Len != 1) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if(pcStart[0] == 'A') |
| | | { |
| | | _pstGPS->m_eState = GPS_STATE_VALID; |
| | | } |
| | | else |
| | | { |
| | | _pstGPS->m_eState = GPS_STATE_INVALID; |
| | | } |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseTime |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseTime(HIDO_DataStruct *_pstTimeData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstTimeData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstTimeData->m_pData; |
| | | HIDO_CHAR *pcDot = NULL; |
| | | |
| | | pcDot = HIDO_UtilStrnchr(pcStart, '.', u32Len); |
| | | if (NULL == pcDot) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if ((pcDot - pcStart) != 6) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | _pstGPS->m_u8Hour = HIDO_UtilStrBufToInt(pcStart, 2); |
| | | _pstGPS->m_u8Min = HIDO_UtilStrBufToInt(pcStart + 2, 2); |
| | | _pstGPS->m_u8Sec = HIDO_UtilStrBufToInt(pcStart + 4, 2); |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseLat |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseLat(HIDO_DataStruct *_pstLatData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstLatData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstLatData->m_pData; |
| | | HIDO_CHAR *pcDot = NULL; |
| | | HIDO_UINT32 u32TempLen = 0; |
| | | double dd; |
| | | double mmmm; |
| | | double mm; |
| | | |
| | | if (u32Len < 9) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | pcDot = HIDO_UtilStrnchr(pcStart, '.', u32Len); |
| | | if (NULL == pcDot || (pcDot - pcStart) != 4) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | dd = HIDO_UtilStrBufToInt(pcStart, 2); |
| | | mm = HIDO_UtilStrBufToInt(pcStart + 2, 2); |
| | | u32TempLen = u32Len - (pcDot + 1 - pcStart); |
| | | mmmm = HIDO_UtilStrBufToInt(pcDot + 1, u32TempLen); |
| | | while(u32TempLen != 0) |
| | | { |
| | | mmmm /= 10.0; |
| | | u32TempLen--; |
| | | } |
| | | |
| | | mm = mm + mmmm; |
| | | _pstGPS->m_dLat = dd + (mm / 60.0); |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseLon |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseLon(HIDO_DataStruct *_pstLonData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstLonData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstLonData->m_pData; |
| | | HIDO_CHAR *pcDot = NULL; |
| | | HIDO_UINT32 u32TempLen = 0; |
| | | double ddd; |
| | | double mmmm; |
| | | double mm; |
| | | |
| | | if (u32Len < 10) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | pcDot = HIDO_UtilStrnchr(pcStart, '.', u32Len); |
| | | if (NULL == pcDot || (pcDot - pcStart) != 5) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | ddd = HIDO_UtilStrBufToInt(pcStart, 3); |
| | | mm = HIDO_UtilStrBufToInt(pcStart + 3, 2); |
| | | u32TempLen = u32Len - (pcDot + 1 - pcStart); |
| | | mmmm = HIDO_UtilStrBufToInt(pcDot + 1, u32TempLen); |
| | | while(u32TempLen != 0) |
| | | { |
| | | mmmm /= 10.0; |
| | | u32TempLen--; |
| | | } |
| | | |
| | | mm = mm + mmmm; |
| | | _pstGPS->m_dLon = ddd + (mm / 60.0); |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseDir |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseDir(HIDO_DataStruct *_pstDirData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstDirData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstDirData->m_pData; |
| | | HIDO_CHAR *pcDot = NULL; |
| | | |
| | | if (u32Len >= 1) |
| | | { |
| | | pcDot = HIDO_UtilStrnchr(pcStart, '.', u32Len); |
| | | if (pcDot) |
| | | { |
| | | _pstGPS->m_u16Dir = HIDO_UtilStrBufToInt(pcStart, pcDot - pcStart); |
| | | } |
| | | else |
| | | { |
| | | _pstGPS->m_u16Dir = HIDO_UtilStrBufToInt(pcStart, u32Len); |
| | | } |
| | | } |
| | | else |
| | | { |
| | | _pstGPS->m_u16Dir = 0; |
| | | } |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseLatSign |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseLatSign(HIDO_DataStruct *_pstLatSignData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstLatSignData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstLatSignData->m_pData; |
| | | |
| | | if (u32Len > 1) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (0 == u32Len) |
| | | { |
| | | return HIDO_OK; |
| | | } |
| | | else |
| | | { |
| | | if (pcStart[0] == 'S') |
| | | { |
| | | _pstGPS->m_dLat = -_pstGPS->m_dLat; |
| | | } |
| | | } |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseLonSign |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseLonSign(HIDO_DataStruct *_pstLonSignData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstLonSignData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstLonSignData->m_pData; |
| | | |
| | | if (u32Len > 1) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (0 == u32Len) |
| | | { |
| | | return HIDO_OK; |
| | | } |
| | | else |
| | | { |
| | | if (pcStart[0] == 'W') |
| | | { |
| | | _pstGPS->m_dLon = -_pstGPS->m_dLon; |
| | | } |
| | | } |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseSpeed |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_ParseSpeed(HIDO_DataStruct *_pstSpeedData, ST_GPS *_pstGPS) |
| | | { |
| | | HIDO_UINT32 u32Len = _pstSpeedData->m_u32Len; |
| | | HIDO_CHAR *pcStart = (HIDO_CHAR *) _pstSpeedData->m_pData; |
| | | HIDO_CHAR acSpeed[10]; |
| | | |
| | | if (u32Len >= 10) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (u32Len >= 1) |
| | | { |
| | | memcpy(acSpeed, pcStart, u32Len); |
| | | acSpeed[u32Len] = 0; |
| | | _pstGPS->m_u16Speed = atof(acSpeed) * 1.852; |
| | | } |
| | | else |
| | | { |
| | | _pstGPS->m_u16Speed = 0; |
| | | } |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_DataCheck |
| | | * Description : GPSæ°æ®æ ¼å¼æ£æ¥ |
| | | * Input : _pcData GPSæ°æ® |
| | | * : _u32Len GPSæ°æ®é¿åº¦ |
| | | * Output : None |
| | | * Return : HIDO_OK æå, HIDO_ERR 失败 |
| | | * Author : hido.ltd |
| | | * Modified Date: : 2021å¹´5æ07æ¥ |
| | | *******************************************************************************/ |
| | | static HIDO_INT32 GPS_DataCheck(HIDO_CHAR *_pcData, HIDO_UINT32 _u32Len) |
| | | { |
| | | HIDO_DataStruct stData; |
| | | HIDO_DataStruct stCheckValue; |
| | | HIDO_UINT8 u8CheckValue = 0; |
| | | HIDO_UINT8 u8CalcValue = 0; |
| | | HIDO_UINT32 i = 0; |
| | | |
| | | if(HIDO_UtilParseFormat((HIDO_UINT8 *)_pcData, _u32Len, "$%p*%p\r\n", &stData, &stCheckValue) != 2) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | u8CheckValue = HIDO_UtilHexStrBufToInt((HIDO_CHAR *)stCheckValue.m_pData, stCheckValue.m_u32Len); |
| | | u8CalcValue = ((HIDO_UINT8 *)stData.m_pData)[0]; |
| | | for(i = 1; i < stData.m_u32Len; i++) |
| | | { |
| | | u8CalcValue ^= ((HIDO_UINT8 *)stData.m_pData)[i]; |
| | | } |
| | | |
| | | if(u8CalcValue != u8CheckValue) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseGGA |
| | | * Description : GPS GGAæ°æ®è§£æ(ä»
æ£æ¥æ°æ®æ¯å¦ææ) |
| | | * Input : _pcData GGAæ°æ® |
| | | * : _u32Len GGAæ°æ®é¿åº¦ |
| | | * Output : None |
| | | * Return : HIDO_OK æå, HIDO_ERR 失败 |
| | | * Author : hido.ltd |
| | | * Modified Date: : 2021å¹´5æ07æ¥ |
| | | *******************************************************************************/ |
| | | uint8_t GPS_data[100]; |
| | | uint8_t GPS_successful_flag; |
| | | extern uint32_t uwbled,rtkled,led4g,powerled; |
| | | uint8_t jinru_parsegga_flag; |
| | | uint8_t fangchai_flag; |
| | | uint8_t GPS_ParseGGA_data[256]; |
| | | uint8_t GPS_ParseGGA_changdu; |
| | | extern uint16_t g_com_map[256]; |
| | | extern uint8_t bat_percent; |
| | | uint8_t gpsbaoxu; |
| | | static HIDO_INT32 GPS_ParseGGA(HIDO_CHAR *_pcData, HIDO_UINT32 _u32Len) |
| | | { |
| | | uint16_t state_flag; |
| | | ST_GPS stGPS; |
| | | HIDO_DataStruct stPosState; |
| | | jinru_parsegga_flag=1; |
| | | memset(&stGPS, 0, sizeof(ST_GPS)); |
| | | if (GPS_DataCheck(_pcData, _u32Len) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (HIDO_UtilParseFormat((HIDO_UINT8 *) _pcData, _u32Len, "$%*,%*,%*,%*,%*,%*,%p,%*,%*,%*,%*,%*,%*,%*,%**", &stPosState) != 15) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | if(*(HIDO_CHAR *)stPosState.m_pData != '0') |
| | | { |
| | | // HIDO_DebugString(_pcData, _u32Len); |
| | | if(l_fnGPSEventCallback != NULL) |
| | | { |
| | | l_fnGPSEventCallback(GPS_TYPE_GGA, _pcData, _u32Len); |
| | | } |
| | | rtkled=BLUE; |
| | | GPS_successful_flag=1; |
| | | _pcData[_u32Len-1]=0; |
| | | _pcData[_u32Len-2]=0; |
| | | // memcpy(GPS_data,_pcData, _u32Len-2);//廿å车æ¢è¡ |
| | | state_flag = 0; |
| | | state_flag = fangchai_flag; |
| | | |
| | | HIDO_UINT32 u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)GPS_ParseGGA_data, sizeof(GPS_ParseGGA_data), "%s,%X,%02x,%x,%d,%d,%d,%d\r\n", |
| | | _pcData, g_com_map[2], bat_percent,0,0,0,state_flag,gpsbaoxu); |
| | | gpsbaoxu++; |
| | | GPS_ParseGGA_changdu=u32Len; |
| | | |
| | | } |
| | | else |
| | | { |
| | | rtkled=RED; |
| | | GPS_successful_flag=0; |
| | | _pcData[_u32Len-1]=0; |
| | | _pcData[_u32Len-2]=0; |
| | | // memcpy(GPS_data,_pcData, _u32Len-2); |
| | | state_flag = 0; |
| | | state_flag = fangchai_flag; |
| | | |
| | | HIDO_UINT32 u32Len = HIDO_UtilSnprintf((HIDO_CHAR *)GPS_ParseGGA_data, sizeof(GPS_ParseGGA_data), "%s,%X,%02x,%x,%d,%d,%d,%d\r\n", |
| | | _pcData, g_com_map[2], bat_percent,0,0,0,state_flag,gpsbaoxu); |
| | | gpsbaoxu++; |
| | | GPS_ParseGGA_changdu=u32Len; |
| | | } |
| | | UDPClient_UploadGPS(); |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_ParseRMC |
| | | * Description : |
| | | * Input : |
| | | * Output : |
| | | * Return : |
| | | * Author : wx:duj_an |
| | | *******************************************************************************/ |
| | | HIDO_INT32 GPS_ParseRMC(HIDO_CHAR *_pcData, HIDO_UINT32 _u32Len) |
| | | { |
| | | HIDO_DataStruct stTimeData; |
| | | HIDO_DataStruct stStateData; |
| | | HIDO_DataStruct stLatData; |
| | | HIDO_DataStruct stLatSignData; |
| | | HIDO_DataStruct stLonData; |
| | | HIDO_DataStruct stLonSignData; |
| | | HIDO_DataStruct stSpeedData; |
| | | HIDO_DataStruct stDirData; |
| | | HIDO_DataStruct stDateData; |
| | | ST_GPS *_pstGPS = &l_stGPS; |
| | | |
| | | if(NULL == _pstGPS) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_DataCheck(_pcData, _u32Len) != HIDO_OK) |
| | | { |
| | | _pstGPS->m_eState = GPS_STATE_INVALID; |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (HIDO_UtilParseFormat((HIDO_UINT8 *) _pcData, _u32Len, "$%*,%p,%p,%p,%p,%p,%p,%p,%p,%p,%*,%*,%**", &stTimeData, &stStateData, |
| | | &stLatData, &stLatSignData, &stLonData, &stLonSignData, &stSpeedData, &stDirData, &stDateData) != 13) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseState(&stStateData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (_pstGPS->m_eState != GPS_STATE_VALID) |
| | | { |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | if (GPS_ParseTime(&stTimeData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseDate(&stDateData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseLat(&stLatData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseLon(&stLonData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseSpeed(&stSpeedData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseDir(&stDirData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseLatSign(&stLatSignData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | if (GPS_ParseLonSign(&stLonSignData, _pstGPS) != HIDO_OK) |
| | | { |
| | | return HIDO_ERR; |
| | | } |
| | | |
| | | GPS_AddHours(_pstGPS, 8); |
| | | |
| | | return HIDO_OK; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_RecvFsm |
| | | * Description : GPS æ°æ®æ¥æ¶ç¶ææº |
| | | * Input : _u8RecvChar ä¸ä¸ªæ¥æ¶å符 |
| | | * Output : None |
| | | * Return : one |
| | | * Author : hido.ltd |
| | | * Modified Date: : 2021å¹´5æ07æ¥ |
| | | *******************************************************************************/ |
| | | HIDO_VOID GPS_RecvFsm(HIDO_UINT8 _u8RecvChar) |
| | | { |
| | | switch (l_stGPSRecv.m_eState) |
| | | { |
| | | case GPS_RECV_STATE_IDLE: |
| | | { |
| | | if ('$' == _u8RecvChar) |
| | | { |
| | | l_stGPSRecv.m_eState = GPS_RECV_STATE_CR; |
| | | l_stGPSRecv.m_u32RecvLen = 0; |
| | | l_stGPSRecv.m_acRecvBuf[l_stGPSRecv.m_u32RecvLen++] = _u8RecvChar; |
| | | } |
| | | break; |
| | | } |
| | | case GPS_RECV_STATE_CR: |
| | | { |
| | | l_stGPSRecv.m_acRecvBuf[l_stGPSRecv.m_u32RecvLen++] = _u8RecvChar; |
| | | |
| | | if (l_stGPSRecv.m_u32RecvLen >= (sizeof(l_stGPSRecv.m_acRecvBuf) - 2)) |
| | | { |
| | | l_stGPSRecv.m_eState = GPS_RECV_STATE_IDLE; |
| | | break; |
| | | } |
| | | |
| | | if ('\r' == _u8RecvChar) |
| | | { |
| | | l_stGPSRecv.m_eState = GPS_RECV_STATE_LF; |
| | | } |
| | | |
| | | break; |
| | | } |
| | | case GPS_RECV_STATE_LF: |
| | | { |
| | | if ('\n' == _u8RecvChar) |
| | | { |
| | | l_stGPSRecv.m_acRecvBuf[l_stGPSRecv.m_u32RecvLen++] = _u8RecvChar; |
| | | l_stGPSRecv.m_acRecvBuf[l_stGPSRecv.m_u32RecvLen] = '\0'; |
| | | |
| | | if(strstr(l_stGPSRecv.m_acRecvBuf, "GGA,") != HIDO_NULL) |
| | | { |
| | | GPS_ParseGGA(l_stGPSRecv.m_acRecvBuf, l_stGPSRecv.m_u32RecvLen); |
| | | memset(l_stGPSRecv.m_acRecvBuf,0, l_stGPSRecv.m_u32RecvLen); |
| | | } |
| | | else if(strstr(l_stGPSRecv.m_acRecvBuf, "RMC,") != HIDO_NULL) |
| | | { |
| | | GPS_ParseRMC(l_stGPSRecv.m_acRecvBuf, l_stGPSRecv.m_u32RecvLen); |
| | | } |
| | | } |
| | | |
| | | l_stGPSRecv.m_eState = GPS_RECV_STATE_IDLE; |
| | | break; |
| | | } |
| | | default: |
| | | { |
| | | break; |
| | | } |
| | | } |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_Rest |
| | | * Description : GPSå¤ä½ |
| | | * Input : None |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | * Modified Date: : 2021å¹´1æ8æ¥ |
| | | *******************************************************************************/ |
| | | //static HIDO_VOID GPS_Rest(void) |
| | | //{ |
| | | // GPIO_SET(&l_astGPSPin[GPS_PIN_REST]); |
| | | // HAL_Delay(10); |
| | | // GPIO_RESET(&l_astGPSPin[GPS_PIN_REST]); |
| | | // HAL_Delay(10); |
| | | // GPIO_SET(&l_astGPSPin[GPS_PIN_REST]); |
| | | //} |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_Powe.\Objects\uwb_simple_example.axf: Error: L6218E: Undefined symbol gps_power_state (referred from sn74hc595.o).rOn |
| | | * Description : GPSä¸çµ |
| | | * Input : None |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | * Modified Date: : 2021å¹´1æ8æ¥ |
| | | *******************************************************************************/ |
| | | //HIDO_VOID GPS_PowerOn(void) |
| | | //{ |
| | | // l_bIsPowerOn = HIDO_TRUE; |
| | | //// GPIO_RESET(&l_astGPSPin[GPS_PIN_EN]); |
| | | // HAL_GPIO_WritePin(GPIOA, GPIO_PIN_12, GPIO_PIN_SET); |
| | | //} |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_PowerOff |
| | | * Description : GPSæçµ |
| | | * Input : None |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | * Modified Date: : 2021å¹´1æ8æ¥ |
| | | *******************************************************************************/ |
| | | //HIDO_VOID GPS_PowerOff(void) |
| | | //{ |
| | | // l_bIsPowerOn = HIDO_FALSE; |
| | | //// GPIO_RESET(&l_astGPSPin[GPS_PIN_EN]); |
| | | // HAL_GPIO_WritePin(GPIOA, GPIO_PIN_12, GPIO_PIN_RESET); |
| | | //} |
| | | |
| | | /******************************************************************************* |
| | | * Global Function * |
| | | *******************************************************************************/ |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_PinRegister |
| | | * Description : GPS模åç®¡èæ³¨å |
| | | * Input : _ePin 管èå®ä¹ |
| | | * : _pstGPIOx GPIOx |
| | | * : _u16GPIOPin GPIO_PIN_x |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | * Modified Date: : 2021å¹´1æ8æ¥ |
| | | *******************************************************************************/ |
| | | //HIDO_VOID GPS_PinRegister(E_GPSPin _ePin, GPIO_TypeDef* _pstGPIOx, HIDO_UINT16 _u16GPIOPin) |
| | | //{ |
| | | // l_astGPSPin[_ePin].m_pstGPIOx = _pstGPIOx; |
| | | // l_astGPSPin[_ePin].m_u16GPIOPin = _u16GPIOPin; |
| | | //} |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_Poll |
| | | * Description : GPS轮询å¤ç |
| | | * Input : None |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | *******************************************************************************/ |
| | | HIDO_VOID GPS_Poll(void) |
| | | { |
| | | HIDO_UINT8 u8RecvChar = 0; |
| | | |
| | | while (Uart_GetChar(UART_ID_GPS, &u8RecvChar) == HIDO_OK) |
| | | { |
| | | GPS_RecvFsm(u8RecvChar); |
| | | } |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_SetEventCallback |
| | | * Description : GPS设置GPSäºä»¶åè° |
| | | * Input : None |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | *******************************************************************************/ |
| | | HIDO_VOID GPS_SetEventCallback(FN_GPSEventCallback _fnEventCallback) |
| | | { |
| | | l_fnGPSEventCallback = _fnEventCallback; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_IsIdle |
| | | * Description : GPS轮询å¤ç |
| | | * Input : None |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | *******************************************************************************/ |
| | | HIDO_BOOL GPS_IsIdle(void) |
| | | { |
| | | if(l_bIsPowerOn) |
| | | { |
| | | return HIDO_FALSE; |
| | | } |
| | | |
| | | return HIDO_TRUE; |
| | | } |
| | | |
| | | /******************************************************************************* |
| | | * Function Name : GPS_Init |
| | | * Description : GPS模ååå§å |
| | | * Input : None |
| | | * Output : None |
| | | * Return : None |
| | | * Author : hido.ltd |
| | | *******************************************************************************/ |
| | | //HIDO_VOID GPS_Init(void) |
| | | //{ |
| | | // GPS_PowerOn(); |
| | | // GPS_Rest(); |
| | | |
| | | // ST_UartInit stInit; |
| | | |
| | | // stInit.m_eRxMode = UART_RX_MODE_INT; |
| | | // stInit.m_eTxMode = UART_TX_MODE_POLL; |
| | | // stInit.m_pu8RxBuf = l_au8GPSUartRxBuf; |
| | | // stInit.m_u32RxBufSize = GPS_UART_RX_BUF_SIZE; |
| | | // stInit.m_pu8TxBuf = l_au8GPSUartTxBuf; |
| | | // stInit.m_u32TxBufSize = GPS_UART_TX_BUF_SIZE; |
| | | // stInit.m_u32TxQueueMemberCnt = 2; |
| | | // Uart_Init(UART_ID_GPS, &stInit); |
| | | |
| | | // HIDO_UtilBzero(&l_stGPSRecv, sizeof(ST_GPSRecv)); |
| | | //} |