PDR/1.Software/PDR 1.02/include/pdr_location.h

#ifndef __PDR_LOCATION_H__
#define __PDR_LOCATION_H__

#ifdef __cplusplus
extern "C" {
#endif

#include "pdr_base.h"

#define HIST_GPS_NUM          8
#define ACCURACY_THRES        0.6f            // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֵ
#define YAW_THRES             10.0f           // Yaw<61>Ƿ<EFBFBD>Χ<EFBFBD><CEA7>ֵ


/**---------------------------------------------------------------------
* Function    : NavSys_Init
* Description : PDR<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϵͳ<EFBFBD><EFBFBD>ʼ<EFBFBD><EFBFBD>
* Date        : 2022/9/16 
*---------------------------------------------------------------------**/
void NavSys_Init(void);

/**---------------------------------------------------------------------
* Function    : InsLocation
* Description : PDR <EFBFBD><EFBFBD><EFBFBD>Ե<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>λ
* Date        : 2022/09/16 logzhan
*---------------------------------------------------------------------**/
int InsLocation(imu *ss_data,  KfPara_t *kf);


/**----------------------------------------------------------------------
* Function    : pdr_noGpsPredict
* Description : <EFBFBD><EFBFBD>û<EFBFBD><EFBFBD>gps<EFBFBD><EFBFBD>ϢʱԤ<EFBFBD><EFBFBD>GPSλ<EFBFBD>ã<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԥ<EFBFBD><EFBFBD>10<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
* Date        : 2020/07/08 logzhan
*---------------------------------------------------------------------**/
void NoGnssInfoPredict(KfPara_t* kf, lct_fs* result, PDR* g_pdr);

/**----------------------------------------------------------------------
* Function    : Nmea2Gnss
* Description : nmea<EFBFBD><EFBFBD><EFBFBD>ݽṹתgnss<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
* Date        : 2020/07/08 logzhan
*---------------------------------------------------------------------**/
void Nmea2Gnss(lct_nmea* nmea_data, GNSS_t* pgnss);


/**----------------------------------------------------------------------
* Function    : pdr_detectFixMode
* Description : <EFBFBD><EFBFBD><EFBFBD>⵱ǰPDR<EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD>ģʽ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>dz<EFBFBD><EFBFBD>غ;<EFBFBD>ֹģʽ,<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѡ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
*               ԭʼGPS<EFBFBD><EFBFBD><EFBFBD>߲<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
* Date        : 2020/07/08 logzhan
*               2020/02/08 logzhan : <EFBFBD>޸<EFBFBD>-1ΪINVAILD_GPS_YAW<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
*               <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ŀɶ<EFBFBD><EFBFBD><EFBFBD>
*---------------------------------------------------------------------**/
int DetectFixMode(GNSS_t* pgnss, KfPara_t* kf, PDR* g_pdr, lct_fs* result);

/**----------------------------------------------------------------------
* Function    : GnssCalHeading
* Description : <EFBFBD><EFBFBD>ȡGPSƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>(0 - 360<EFBFBD><EFBFBD>)
* Date        : 2022/09/16 logzhan
*               <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ŀɶ<EFBFBD><EFBFBD><EFBFBD>
*---------------------------------------------------------------------**/
double GnssCalHeading(GNSS_t* pgnss);

/**----------------------------------------------------------------------
* Function    : calPdrHeadingOffset
* Description : <EFBFBD><EFBFBD><EFBFBD><EFBFBD>GPS<EFBFBD>źŽϺ<EFBFBD>ʱ<EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ƽ<EFBFBD><EFBFBD>㷽<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƫ<EFBFBD><EFBFBD>
* Date        : 2020/07/08 logzhan
*---------------------------------------------------------------------**/
void CalPdrHeadingOffset(lct_nmea* nmea_data, PDR* p_pdr);

/**---------------------------------------------------------------------
* Function    : pdr_resetSysStatus
* Description : PDS <EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϵͳ״̬
* Date        : 2020/2/1 logzhan
*---------------------------------------------------------------------**/
void ResetSystemStatus(KfPara_t* kf);

/**----------------------------------------------------------------------
* Function    : pdr_gnssInsLocation
* Description : PDR GPS<EFBFBD>ں<EFBFBD>INS<EFBFBD><EFBFBD><EFBFBD>Զ<EFBFBD>λ
* Date        : 2021/01/29 logzhan
*---------------------------------------------------------------------**/
int GnssInsFusionLocation(lct_nmea* nmea_data, KfPara_t* kf, lct_fs* result);

/**---------------------------------------------------------------------
* Function    : pdr_initGnssInfo
* Description : PDS GNSS<EFBFBD><EFBFBD>λ<EFBFBD><EFBFBD>Ϣ<EFBFBD><EFBFBD>ʼ<EFBFBD><EFBFBD>
* Date        : 2020/2/1 logzhan
*---------------------------------------------------------------------**/
void  InitGnssInfo(void);

void  GnssUpdate(GNSS_t* gps, lct_nmea* nmea);


#ifdef __cplusplus
}
#endif

#endif