Although the traditional object trajectory detection system which using external observation method have high measurement accuracy,but the complex equipment,high cost makes its application is very limited and difficult to large-scale popularity.However,the movement of the object trajectory is needed in all aspects in our daily life,such as the movement distance measurement,human-computer interaction,navigation and so on.With the development of MEMS sensors,the object motion trajectory detection which using MEMS sensors have advantages of high integration,high precision,low cost,easy to carry and so on.In the smart phone manufacturers continue to pursue product differentiation today,almost all smart phones are integrated motion sensors,which makes today’s smart phones generally have the ability to perceive their own movement.So it is very significantly to make the trajectory tracking technology large-scale popularity by achieving the trajectory tracking with using the sensors in smart phones.The error model of the trajectory detection system is established by studying the working principle of the relevant sensor and the method of trajectory estimation.Based on this model,a Kalman filter for the trajectory detection process is constructed,and an adaptive compensation algorithm based on zero state is proposed to eliminate the cumulative error of the trajectory calculation process.Finally,the rotation method is used to convert the motion trajectory of the main coordinate system into the geographic coordinate system.The mobile phone trajectory detection system based on MEMS sensor is constructed by means of mobile terminal data acquisition module and PC side data processing module.And the motion trajectory detection effect of the system in one dimension,two-dimensional and three-dimensional space is verified by experiment. |