61 lines
2.1 KiB
C
61 lines
2.1 KiB
C
|
/******************** (C) COPYRIGHT 2020 Geek************************************
|
|||
|
|
* File Name : simulator_location_pdr.h
|
|||
|
|
* Department : Sensor Algorithm Team
|
|||
|
|
* Current Version : V1.2
|
|||
|
|
* Author : logzhan
|
|||
|
|
* Date of Issued : 2020.7.4
|
|||
|
|
* Comments : PDR <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>켣ƽ<EFBFBD><EFBFBD><EFBFBD>Ĺ<EFBFBD><EFBFBD>ܺ<EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
********************************************************************************/
|
|||
|
|
#ifndef _PDR_TRACK_SMOOTHING_H_
|
|||
|
|
#define _PDR_TRACK_SMOOTHING_H_
|
|||
|
|
|
|||
|
|
#ifdef __cplusplus
|
|||
|
|
extern "C" {
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
#include "pdr_linearFit.h"
|
|||
|
|
#include "pdr_sensor.h"
|
|||
|
|
|
|||
|
|
|
|||
|
|
#define FITTING_DOCK_SIZE 3
|
|||
|
|
|
|||
|
|
typedef struct DoublePair {
|
|||
|
|
double x;
|
|||
|
|
double y;
|
|||
|
|
} DoublePair;
|
|||
|
|
|
|||
|
|
/**----------------------------------------------------------------------
|
|||
|
|
* Function : trackSmoothingSlideWindowSet
|
|||
|
|
* Description : ʹ<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><EFBFBD><EFBFBD><EFBFBD>ͨ<EFBFBD><EFBFBD><EFBFBD>˺<EFBFBD>
|
|||
|
|
* <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>趨<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڴ<EFBFBD>С<EFBFBD><EFBFBD>
|
|||
|
|
* Input : slideWindowSize: <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڵĴ<EFBFBD>С
|
|||
|
|
* Output : size : <EFBFBD><EFBFBD>ǰ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڵĴ<EFBFBD>С<EFBFBD><EFBFBD>һ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>0,<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ش<EFBFBD>СΪ0ʱ˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>û<EFBFBD><EFBFBD><EFBFBD>
|
|||
|
|
* <EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϊ0<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڴ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʧ<EFBFBD>ܡ<EFBFBD>
|
|||
|
|
* Date : 2020/7/4 logzhan
|
|||
|
|
*---------------------------------------------------------------------**/
|
|||
|
|
int TrackSmoothSetWinSize(size_t slideWindowSize);
|
|||
|
|
|
|||
|
|
/**----------------------------------------------------------------------
|
|||
|
|
* Function : trackSmoothing
|
|||
|
|
* Description : <EFBFBD>켣ƽ<EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD><EFBFBD>رպ<EFBFBD><EFBFBD><EFBFBD>Ҫʹ<EFBFBD>ô˺<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͷ<EFBFBD><EFBFBD><EFBFBD>Դ
|
|||
|
|
* Input : lat: <EFBFBD><EFBFBD><EFBFBD><EFBFBD>γ<EFBFBD><EFBFBD>
|
|||
|
|
* lon: <EFBFBD><EFBFBD><EFBFBD>뾭<EFBFBD><EFBFBD>
|
|||
|
|
* Output : outLat: <EFBFBD><EFBFBD><EFBFBD><EFBFBD>γ<EFBFBD>ȴ洢<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ָ<EFBFBD><EFBFBD>
|
|||
|
|
* outLon: <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ȴ洢<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ָ<EFBFBD><EFBFBD>
|
|||
|
|
* return: <EFBFBD><EFBFBD><EFBFBD>ش<EFBFBD><EFBFBD><EFBFBD>״̬
|
|||
|
|
* Date : 2020/7/4 logzhan
|
|||
|
|
*---------------------------------------------------------------------**/
|
|||
|
|
int pdr_trackSmooth(double lat, double lon, double *outLat, double *outLon);
|
|||
|
|
|
|||
|
|
/**----------------------------------------------------------------------
|
|||
|
|
* Function : trackSmoothSlideWindowFree
|
|||
|
|
* Description : <EFBFBD>켣ƽ<EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD><EFBFBD>رպ<EFBFBD><EFBFBD><EFBFBD>Ҫʹ<EFBFBD>ô˺<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͷ<EFBFBD><EFBFBD><EFBFBD>Դ
|
|||
|
|
* Date : 2020/7/4 logzhan
|
|||
|
|
*---------------------------------------------------------------------**/
|
|||
|
|
int freeTrackSmooth(void);
|
|||
|
|
|
|||
|
|
#ifdef __cplusplus
|
|||
|
|
}
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
#endif // !_TRACK_SMOOTHING_MODULE_H_
|