CN110675435B - Vehicle trajectory tracking method based on Kalman filtering and chi 2 detection smoothing processing - Google Patents

Vehicle trajectory tracking method based on Kalman filtering and chi 2 detection smoothing processing Download PDF

Info

Publication number
CN110675435B
CN110675435B CN201910949419.4A CN201910949419A CN110675435B CN 110675435 B CN110675435 B CN 110675435B CN 201910949419 A CN201910949419 A CN 201910949419A CN 110675435 B CN110675435 B CN 110675435B
Authority
CN
China
Prior art keywords
chi
state
target vehicle
vehicle
measurement
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910949419.4A
Other languages
Chinese (zh)
Other versions
CN110675435A (en
Inventor
郑朝辉
巨志扬
冯敏健
张辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Maxieye Automobile Technology Co ltd
Original Assignee
Shanghai Maxieye Automobile Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shanghai Maxieye Automobile Technology Co ltd filed Critical Shanghai Maxieye Automobile Technology Co ltd
Priority to CN201910949419.4A priority Critical patent/CN110675435B/en
Publication of CN110675435A publication Critical patent/CN110675435A/en
Application granted granted Critical
Publication of CN110675435B publication Critical patent/CN110675435B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/277Analysis of motion involving stochastic approaches, e.g. using Kalman filters
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/10Image acquisition modality
    • G06T2207/10016Video; Image sequence
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/30Subject of image; Context of image processing
    • G06T2207/30241Trajectory

Landscapes

  • Engineering & Computer Science (AREA)
  • Multimedia (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Navigation (AREA)

Abstract

The invention discloses a method based on Kalman filtering and chi 2 A vehicle track tracking method for detecting smoothing processing aims at finding a more effective vehicle tracking detection mode, and comprises the following steps: constructing a kinematic model and a measurement model of the running process of the target vehicle; obtaining the historical motion track of the target vehicle, substituting the kinematic model and the measurement model into a time updating equation and a state updating equation in a Kalman filter to iteratively update the motion state of the target vehicle, and predicting the motion state at the next moment; structure chi 2 And the fault detector is used for carrying out fault detection on the prediction result. The invention applies Chi to the problems of possible recognition error or loss and the like in the tracking of the prior art 2 The fault detector can effectively reduce the deviation of track prediction and improve the track identification accuracy.

Description

Based on Kalman filtering and chi 2 Vehicle track tracking method for detecting smoothing processing
Technical Field
The invention relates to the field of automatic driving, in particular to a Kalman filtering and chi-based method 2 And detecting a vehicle track tracking method of smoothing processing.
Background
With the continuous development and progress of scientific technology, unmanned vehicles are taken as the main trend of modern vehicle development, and various research applications and experimental tests of various aspects are developed around various technologies and functions of large vehicle enterprises and universities. The track tracking control is a basis for realizing unmanned driving and also serves as an important technology for intelligent vehicle control, and long-time target tracking needs to be carried out on the vehicle to obtain the driving track of the vehicle in the current scene.
For a vehicle tracking detection mode through a video image, the obtained original vehicle track has the defects of unstable detection borrowing point frame, many jumps in the track, poor smoothness and the like, meanwhile, the noise problems of large-area shielding, illumination influence, background disorder, shade change and the like exist in the tracking process, the processing result obtained by applying the traditional tracking algorithm is not accurate, and the position information and the speed information of the target vehicle are difficult to obtain accurately.
Disclosure of Invention
In order to find a more effective vehicle tracking detection mode, the invention provides a method based on Kalman filtering and chi 2 Method for detecting smoothly processed vehicle trajectory tracking, Kalman filtering and chi 2 The vehicle track tracking method for detecting the smoothing processing comprises the following steps:
step S1, the obtained motion video image of the target vehicle is regarded as a two-dimensional plane coordinate system, and a kinematic model and a measurement model of the driving process of the target vehicle are constructed by taking the central point of the identification rectangular frame of the target vehicle as an analysis object:
step S2, obtaining the historical motion track of the target vehicle, substituting the kinematic model and the measurement model into a time updating equation and a state updating equation in a Kalman filter to iteratively update the motion state of the target vehicle, and predicting the motion state at the next moment;
step S3, constructing chi 2 Fault detector and constructing χ according to Kalman filter 2 A detection statistic of the fault detector; and comparing the detection statistic with a preset threshold, and when the detection statistic is greater than the threshold, selecting the prior state estimation value at the k moment as the posterior state estimation value at the k moment to participate in executing the step S2 so as to dynamically acquire the motion track of the target vehicle in real time, wherein k represents the moment and is an integer greater than 0.
Preferably, the kinematic model of the driving process of the target vehicle is:
X k+1 =AX k +BW k
in the formula, X k The real motion state of the target vehicle at the moment k;
A∈R 4×4 is expressed as acting on X k A state transition matrix of (c);
B∈R 4 representation of process noise W k A coefficient matrix of (a);
W k ∈R 4 denotes the compliance W at time k k N (0, Q) distributed process noise;
Q∈R 4×4 representing process noise covarianceA matrix;
the measurement model is as follows:
Z k =HX k +V k
in the formula, H is epsilon to R 2×4 A representation measurement model matrix that maps the true state space into an observation space;
V k ∈R 2 representing compliance V k N (0, R) distributed measurement noise;
R∈R 2×2 representing the measurement noise covariance matrix.
Preferably, said constructing said χ according to said kalman filtering algorithm 2 The detection statistics of the fault detector include the steps of:
substituting Kalman gain in a steady state of a Kalman filter into the state updating equation to obtain a state estimation value at the moment k;
obtaining a residual deviation L according to the state estimation value at the moment k and the measurement model k
According to the residual deviation L k Construct the detection statistic g k Wherein the detection statistic g k Comprises the following steps:
g k =L k T B k L k
B k =E(L k L k T )=HPH T +R
in the formula, L k Obeying a Gaussian distribution, B k Is a residual deviation L k The covariance matrix of (a);
h represents a measurement model matrix;
p is an estimation error covariance matrix in the Kalman filter;
r is measurement noise V k The covariance matrix of (a);
g k and (3) the chi-square distribution of m degrees of freedom is obeyed, and the m is a natural number and is not far away from 0.
Preferably, the preset threshold value is confirmed by referring to a chi-square distribution table based on the detection statistic freedom value and a preset probability confidence range.
Preferably, the detection statistic freedom value is 1, and the preset probability confidence range is 95%.
Preferably, the step S2 is preceded by the steps of:
initializing the kinematic model and the measurement model according to preset conditions, wherein the preset conditions are process noise, measurement noise and a state initial value X 0 The following conditions are satisfied:
Figure BDA0002225293720000031
preferably, initializing the kinematic model and the measurement model according to preset conditions comprises the steps of:
confirming a sampling period, and initializing the kinematic model and the measurement model according to the sampling period and the preset condition.
Compared with the prior art, the Kalman filtering and Chi filtering based method is characterized in that 2 The vehicle track tracking method for detecting the smoothing processing has the following technical effects:
the invention is based on Kalman filtering and chi 2 The vehicle track tracking method for detecting smoothing processing applies chi to the problems of recognition error or loss and the like which may occur in the tracking process in the prior art 2 The fault detector can effectively reduce the deviation of track prediction and improve the track identification accuracy, and meanwhile, the X-shaped 2 The fault detector is a detector which is usually matched with Kalman filtering for use, and the complexity of detection calculation is low, so that the fault detector is convenient for industrial application.
Additional aspects and advantages of the invention will be set forth in part in the description which follows, and in part will be obvious from the description, or may be learned by practice of the invention.
Drawings
The foregoing and/or additional aspects and advantages of the present invention will become apparent and readily appreciated from the following description of the embodiments, taken in conjunction with the accompanying drawings of which:
FIG. 1 provides a Kalman filtering and chi-based algorithm according to an embodiment of the present invention 2 And detecting a flow schematic diagram of the vehicle track tracking method of the smoothing processing.
Detailed Description
Reference will now be made in detail to embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein like or similar reference numerals refer to the same or similar elements or elements having the same or similar function throughout. The embodiments described below with reference to the drawings are illustrative only and should not be construed as limiting the invention.
Referring to fig. 1, an embodiment of the invention is based on kalman filtering and χ filtering 2 The vehicle track tracking method for detecting the smoothing processing comprises the following steps:
and step S1, regarding the acquired motion video image of the target vehicle as a two-dimensional plane coordinate system, and constructing a kinematic model and a measurement model of the running process of the target vehicle by taking the central point of the identification rectangular frame of the target vehicle as an analysis object.
In some embodiments, the target vehicle motion video image is preferably acquired by an in-vehicle vision system.
The specific address and the kinematic model of the target vehicle in the driving process are as follows:
X k+1 =AX k +BW k
in the formula, X k The real motion state of the target vehicle at the moment k;
A∈R 4×4 is expressed as acting on X k A state transition matrix of (c);
B∈R 4 representation of process noise W k A coefficient matrix of (a);
W k ∈R 4 denotes the compliance W at time k k N (0, Q) distributed process noise;
Q∈R 4×4 representing a process noise covariance matrix;
the measurement model is as follows:
Z k =HX k +V k
in the formula, H is epsilon to R 2×4 Representing a measurement model matrix that maps the true state space into observationsA space;
V k ∈R 2 representing compliance V k N (0, R) distributed measurement noise;
R∈R 2×2 representing the measurement noise covariance matrix.
Step S2, obtaining the historical motion track of the target vehicle, substituting the kinematic model and the measurement model into a time updating equation and a state updating equation in a Kalman filter to iteratively update the motion state of the target vehicle, and predicting the motion state at the next moment;
in some embodiments, step S2 is followed by the following steps:
initializing a kinematic model and a measurement model according to preset conditions, wherein the preset conditions are process noise, measurement noise and a state initial value X 0 The following conditions are satisfied:
Figure BDA0002225293720000051
Figure BDA0002225293720000052
Figure BDA0002225293720000053
preferably, the covariance matrix of the process noise can be estimated from the actual running process, and is referred to herein as:
E(W k W k T )=Q
the covariance matrix of the measured noise can be generally obtained from data and actual measurements of the relevant measurement sensor, such as the camera manufacturer, and is referred to herein as:
E(V k V k T )=R
the initial covariance of the system state is:
E(X 0 X 0 T )=∑ 0|0
preferably, initializing the kinematic model and the measurement model according to preset conditions comprises the following steps: confirming a sampling period, and initializing a kinematic model and a measurement model according to the sampling period and preset conditions.
For example, assuming a sampling period Δ t during tracking, the kinematic model and measurement model parameter matrices are defined as follows:
Figure BDA0002225293720000054
Figure BDA0002225293720000061
Figure BDA0002225293720000062
the states of the kinematic model and the measurement model are defined as follows:
Figure BDA0002225293720000063
Figure BDA0002225293720000064
Figure BDA0002225293720000065
wherein, X k ∈R 4 Representing the real motion state of the target vehicle at the moment k;
x (k) and v x (k) Respectively representing the coordinate and the speed value of the target vehicle in the x-axis direction in the video image at the time of k;
y (k) and v y (k) Respectively representing the coordinate and the speed value of the target vehicle in the y-axis direction at the time of k;
a x (k) representing the acceleration of the target vehicle in the x-axis direction, a y (k) Representing the acceleration of the target vehicle in the y-axis direction;
Z k ∈R 2 representing the observation vector, i.e. the detected vehicle position in the camera or video, because only the center position of the moving vehicle can be detected and only the position of the center point of the identification rectangular frame of the target vehicle can be observed when the observation vector is established, the observation vector only comprises the coordinates of the center point of the position of the target vehicle and has no speed information, wherein x is z (k) And y z (k) And x-axis coordinate values and y-axis coordinate values corresponding to the center points of the rectangular frames of the target vehicle detected in the image sequence at the time k are respectively shown.
The kalman filter comprises two main processes: estimating and correcting, wherein the estimation process mainly comprises the steps of establishing prior estimation on the current state by using a time updating equation, and timely calculating the current state variable and the error covariance estimation value forwards so as to construct a prior estimation value for the next time state; the correction process is responsible for feedback, and an improved posterior estimation of the current state is established on the basis of the prior estimation value and the current measurement variable in the estimation process by using a measurement updating equation. The time update equation and the state update equation of the discrete kalman filter are given below.
The time update equation:
Figure BDA0002225293720000071
Figure BDA0002225293720000072
P k - =AP k-1 A T +Q
P k-1 (0)=P 0
P 0 =diag(1,1,1,1)
the state update equation:
K k =P k - H T (HP k - H T +R) -1
Figure BDA0002225293720000073
P k =(I-K k H)P k -
in the formula (I), the compound is shown in the specification,
Figure BDA0002225293720000074
the prior estimation value of the Kalman filter for the motion state of the target vehicle at the moment k is represented;
Figure BDA0002225293720000075
representing the posterior estimation value of the corresponding Kalman filter to the motion state of the target vehicle at the k-1 moment;
Figure BDA0002225293720000076
representing an estimate of the posterior state at time k;
P k - representing an n x n prior estimation error covariance matrix;
P k representing an n x n posteriori estimation error covariance matrix;
i represents an n × n-order identity matrix;
K k representing an n x m order matrix, called kalman gain or blending factor, functions to minimize the covariance of the a posteriori estimation errors.
In the embodiment of the present invention, the estimated predicted motion trajectory of the target vehicle can be obtained by substituting the kinematic model and the measurement model constructed in step S1 into the time update equation and the state update equation.
Step S3, constructing chi 2 Fault detector and constructing χ according to Kalman filter 2 A detection statistic of the fault detector; comparing the detection statistic with a preset threshold, and selecting the prior state estimation value of the k moment as the rear of the k moment when the detection statistic is larger than the thresholdThe state-of-experience estimation value participates in executing step S2 to dynamically acquire the motion trajectory of the target vehicle in real time, where k represents a time and is an integer greater than 0.
Specifically, χ is constructed according to a Kalman filtering algorithm 2 The detection statistics of the fault detector include the steps of:
substituting Kalman gain in a steady state of a Kalman filter into a state updating equation to obtain a state estimation value at the moment k;
obtaining residual deviation L according to state estimation value and measurement model at the moment k k
According to the residual deviation L k Construct the detection statistic g k Wherein the statistic g is detected k Comprises the following steps:
g k =L k T B k L k
B k =E(L k L k T )=HPH T +R
in the formula, L k Obeying a Gaussian distribution, B k Is a residual deviation L k The covariance matrix of (a);
h represents a measurement model matrix;
p is an estimation error covariance matrix in the Kalman filter;
r is measurement noise V k The covariance matrix of (a);
g k and (3) the chi-square distribution of m degrees of freedom is obeyed, and the m is a natural number and is not far away from 0.
In some embodiments, the predetermined threshold is determined by consulting a chi-square distribution table based on the detection statistic freedom value and a predetermined probability confidence range.
For example, when the degree of freedom of the detection statistic is 1 and the preset probability confidence range is 95%, the corresponding preset threshold value of 3.84 can be obtained by referring to the chi-square distribution table. Thus, when g is k Less than a predetermined threshold, i.e. g k When the concentration is less than or equal to 3.84, χ 2 The fault detector will not activate an alarm, otherwise when g k When it is greater than the preset threshold value, χ 2 The fault detector gives an alarm that the residual deviation value is too large and exceeds the confidence range, and simultaneously the fault detector gives an alarm to the faultThe following adjustments are made in the state iteration process of kalman filtering:
Figure BDA0002225293720000091
i.e. discarding the measured value Z at time k k Directly selecting the prior state estimated value of k time
Figure BDA0002225293720000092
And the estimated value is used as the posterior state estimated value of the k moment and participates in the next prediction and iteration process. By continuously repeating the steps S2 and S3, the motion trail of the target vehicle can be dynamically obtained in real time,
it is worth noting that the chi-square detection in the steady state working state of the kalman filter is considered in the present invention, and the parameters in the steady state of the kalman filter are as follows:
Figure BDA0002225293720000093
K@PH T (HPH T +R) -1
in the formula, P k - The prior estimation error covariance matrix at the moment k is obtained, P is the estimation error covariance matrix when the Kalman filter reaches the steady state, and the prior estimation and the posterior estimation error covariance matrix P at the moment k - 、P k And when the covariance matrix of the estimation errors in the steady state of the Kalman filter is equal to P, substituting the covariance matrix of the estimation errors in the steady state of the Kalman filter into a formula state updating equation to obtain the Kalman gain K when the Kalman filter reaches the steady state.
Chi-square detection of residual deviation L of time k k Is defined as:
Figure BDA0002225293720000094
from the measurement model to the residual deviation L k Simultaneous residual error L k Another form of expression:
Figure BDA0002225293720000095
in the formula, X k Is the true value of the system state, V k To measure noise.
Compared with the prior art, the embodiment of the invention is based on Kalman filtering and chi 2 The vehicle track tracking method for detecting the smoothing processing has the following technical effects:
the embodiment of the invention is based on Kalman filtering and chi 2 The vehicle track tracking method for detecting smoothing processing applies chi to the problems of recognition error or loss and the like which may occur in the tracking process in the prior art 2 The fault detector can effectively reduce the deviation of track prediction and improve the track identification accuracy, and meanwhile, the X-shaped 2 The fault detector is a detector which is usually matched with Kalman filtering for use, and the complexity of detection calculation is low, so that the fault detector is convenient for industrial application.
The foregoing is only a partial embodiment of the present invention, and it should be noted that, for those skilled in the art, various modifications and decorations can be made without departing from the principle of the present invention, and these modifications and decorations should also be regarded as the protection scope of the present invention.

Claims (3)

1. Based on Kalman filtering and chi 2 Vehicle trajectory tracking method for detection smoothing, characterized in that it is based on Kalman filtering and chi 2 The vehicle track tracking method for detecting the smoothing processing comprises the following steps:
step S1, the obtained motion video image of the target vehicle is regarded as a two-dimensional plane coordinate system, and the central point of the identification rectangular frame of the target vehicle is used as an analysis object to construct a kinematic model and a measurement model of the target vehicle in the running process;
step S2, obtaining the historical motion track of the target vehicle, substituting the kinematic model and the measurement model into a time updating equation and a state updating equation in a Kalman filter to iteratively update the motion state of the target vehicle, and predicting the motion state at the next moment;
step S3, constructing chi 2 Fault detector and constructing χ according to Kalman filter 2 A detection statistic of the fault detector; comparing the detection statistic with a preset threshold, and when the detection statistic is greater than the threshold, selecting the prior state estimation value at the time k as the posterior state estimation value at the time k to participate in executing the step S2 so as to dynamically acquire the motion track of the target vehicle in real time, wherein the time k represents an integer greater than 0;
the kinematic model of the target vehicle in the running process is as follows:
X k+1 =AX k +BW k
in the formula, X k The real motion state of the target vehicle at the moment k;
A∈R 4×4 is expressed as acting on X k A state transition matrix of (c);
B∈R 4 representation of process noise W k A coefficient matrix of (a);
W k ∈R 4 denotes the compliance W at time k k N (0, Q) distributed process noise;
Q∈R 4×4 representing a process noise covariance matrix;
the measurement model is as follows:
Z k =HX k +V k
in the formula, H is epsilon to R 2×4 A representation measurement model matrix that maps the true state space into an observation space;
V k ∈R 2 representing compliance V k N (0, R) distributed measurement noise;
R∈R 2×2 representing a measurement noise covariance matrix;
constructing the χ according to the Kalman filtering algorithm 2 The detection statistics of the fault detector include the steps of:
substituting Kalman gain in a steady state of a Kalman filter into the state updating equation to obtain a state estimation value at the moment k;
obtaining a residual deviation L according to the state estimation value at the moment k and the measurement model k
According to the residual deviation L k Construct the detection statistic g k Wherein the detection statistic g k Comprises the following steps:
g k =L k T B k L k
B k =E(L k L k T )=HPH T +R
in the formula, L k Obeying a Gaussian distribution, B k Is a residual deviation L k The covariance matrix of (a);
h represents a measurement model matrix;
p is an estimation error covariance matrix in the Kalman filter;
r is measurement noise V k The covariance matrix of (a);
g k the chi-square distribution of m degrees of freedom is obeyed, and the chi-square distribution is not far away from 0, wherein m is a natural number;
the preset threshold value is determined by looking up a chi-square distribution table based on the detection statistic freedom value and a preset probability confidence range;
the degree of freedom of the detection statistic is 1, and the preset probability confidence range is 95%.
2. The Kalman filtering and chi-based system of claim 1 2 The vehicle trajectory tracking method for detecting smoothing processing, characterized in that the step S2 is preceded by the steps of:
initializing the kinematic model and the measurement model according to preset conditions, wherein the preset conditions are process noise, measurement noise and a state initial value X 0 The following conditions are satisfied:
Figure FDA0003690408040000021
3. such as rightKalman filtering and chi-based according to claim 2 2 The vehicle track tracking method for detecting smoothing processing is characterized in that initializing the kinematic model and the measurement model according to preset conditions comprises the following steps:
confirming a sampling period, and initializing the kinematic model and the measurement model according to the sampling period and the preset condition.
CN201910949419.4A 2019-10-08 2019-10-08 Vehicle trajectory tracking method based on Kalman filtering and chi 2 detection smoothing processing Active CN110675435B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910949419.4A CN110675435B (en) 2019-10-08 2019-10-08 Vehicle trajectory tracking method based on Kalman filtering and chi 2 detection smoothing processing

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910949419.4A CN110675435B (en) 2019-10-08 2019-10-08 Vehicle trajectory tracking method based on Kalman filtering and chi 2 detection smoothing processing

Publications (2)

Publication Number Publication Date
CN110675435A CN110675435A (en) 2020-01-10
CN110675435B true CN110675435B (en) 2022-08-02

Family

ID=69080900

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910949419.4A Active CN110675435B (en) 2019-10-08 2019-10-08 Vehicle trajectory tracking method based on Kalman filtering and chi 2 detection smoothing processing

Country Status (1)

Country Link
CN (1) CN110675435B (en)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111667512B (en) * 2020-05-28 2024-04-09 浙江树人学院(浙江树人大学) Multi-target vehicle track prediction method based on improved Kalman filtering
CN111666891B (en) * 2020-06-08 2023-09-26 北京百度网讯科技有限公司 Method and device for estimating movement state of obstacle
CN112230801A (en) * 2020-10-23 2021-01-15 上海磐启微电子有限公司 Kalman smoothing processing method, memory and equipment applied to touch trajectory
CN112550294B (en) * 2020-11-16 2021-12-24 东南大学 Path tracking control method based on vehicle fault signal isolation
CN112433531A (en) * 2021-01-27 2021-03-02 国汽智控(北京)科技有限公司 Trajectory tracking method and device for automatic driving vehicle and computer equipment
CN113115230B (en) * 2021-03-26 2023-08-18 北京工业大学 Vehicle broadcast communication control method based on information physical system
CN113610263B (en) * 2021-06-18 2023-06-09 广东能源集团科学技术研究院有限公司 Power plant operation vehicle track estimation method and system
CN113763434B (en) * 2021-09-26 2024-02-02 东风汽车集团股份有限公司 Target track prediction method based on Kalman filtering multi-motion model switching
CN114001976B (en) * 2021-10-19 2024-03-12 杭州飞步科技有限公司 Method, device, equipment and storage medium for determining control error
CN114162134B (en) * 2022-02-14 2022-05-06 西南交通大学 Method, device and storage medium for predicting vehicle track on sea-crossing bridge
CN115376277A (en) * 2022-08-05 2022-11-22 美的集团(上海)有限公司 Health safety monitoring and early warning method, electronic equipment and storage medium
CN115342817B (en) * 2022-10-20 2023-02-03 北京理工大学 Method, system, equipment and medium for monitoring track tracking state of unmanned tracked vehicle
CN116434567B (en) * 2022-12-13 2024-01-26 武汉溯野科技有限公司 Traffic flow detection method and device, electronic equipment and road side equipment

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018014602A1 (en) * 2016-07-19 2018-01-25 东南大学 Volume kalman filtering method suitable for high-dimensional gnss/ins deep coupling
CN108303684A (en) * 2018-01-31 2018-07-20 长沙深之瞳信息科技有限公司 Ground surveillance radar multi-object tracking method based on radial velocity information
CN109275121A (en) * 2018-08-20 2019-01-25 浙江工业大学 A kind of Vehicle tracing method based on adaptive extended kalman filtering

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8909589B2 (en) * 2012-09-12 2014-12-09 Numerica Corp. Methods and systems for updating a predicted location of an object in a multi-dimensional space

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018014602A1 (en) * 2016-07-19 2018-01-25 东南大学 Volume kalman filtering method suitable for high-dimensional gnss/ins deep coupling
CN108303684A (en) * 2018-01-31 2018-07-20 长沙深之瞳信息科技有限公司 Ground surveillance radar multi-object tracking method based on radial velocity information
CN109275121A (en) * 2018-08-20 2019-01-25 浙江工业大学 A kind of Vehicle tracing method based on adaptive extended kalman filtering

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于卡尔曼滤波运动目标检测技术的研究;张弛等;《电脑与电信》;20120910(第09期);全文 *

Also Published As

Publication number Publication date
CN110675435A (en) 2020-01-10

Similar Documents

Publication Publication Date Title
CN110675435B (en) Vehicle trajectory tracking method based on Kalman filtering and chi 2 detection smoothing processing
CN107292911B (en) Multi-target tracking method based on multi-model fusion and data association
CN108802707B (en) Improved Kalman filtering method for target tracking
CN110796010B (en) Video image stabilizing method combining optical flow method and Kalman filtering
Rambach et al. Learning to fuse: A deep learning approach to visual-inertial camera pose estimation
CN110595466B (en) Lightweight inertial-assisted visual odometer implementation method based on deep learning
CN111178385A (en) Target tracking method for robust online multi-sensor fusion
CN109829933B (en) Image target tracking method and device
CN111666891B (en) Method and device for estimating movement state of obstacle
CN101511024A (en) Movement compensation method of real time electronic steady image based on motion state recognition
Michot et al. Bi-objective bundle adjustment with application to multi-sensor slam
CN110572139B (en) Fusion filtering implementation method and device for vehicle state estimation, storage medium and vehicle
JP2020052687A (en) Position estimation device
CN116309731A (en) Multi-target dynamic tracking method based on self-adaptive Kalman filtering
CN108900775B (en) Real-time electronic image stabilization method for underwater robot
CN112734823B (en) Image-based visual servo jacobian matrix depth estimation method
Stachniss et al. Analyzing gaussian proposal distributions for mapping with rao-blackwellized particle filters
Li et al. Estimation and tracking of a moving target by unmanned aerial vehicles
CN108469729B (en) Human body target identification and following method based on RGB-D information
CN113362358A (en) Robust pose estimation method based on instance segmentation in dynamic scene
KR101483549B1 (en) Method for Camera Location Estimation with Particle Generation and Filtering and Moving System using the same
CN112446851A (en) Endpoint detection algorithm based on high-speed pulse type image sensor
CN108230370B (en) Tracking target speed prediction method based on holder and storage medium
CN113592907B (en) Visual servo tracking method and device based on optical flow
KR101789776B1 (en) Bias correcting apparatus for yaw angle estimation of mobile robots and method thereof

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20201021

Address after: Room 205, No. 570 shengxia Road, Pudong New Area (Shanghai) pilot Free Trade Zone, Shanghai, 201203

Applicant after: SHANGHAI MAXIEYE AUTOMOBILE TECHNOLOGY Co.,Ltd.

Address before: 314100 Room 401, building C6, No. 555 Chuangye Road, Dayun Town, Jiashan County, Jiaxing City, Zhejiang Province

Applicant before: JIAXING ZHIJIA TECHNOLOGY Co.,Ltd.

GR01 Patent grant
GR01 Patent grant