CN109035121B - Single-sensor data association preprocessing method - Google Patents
Single-sensor data association preprocessing method Download PDFInfo
- Publication number
- CN109035121B CN109035121B CN201810804816.8A CN201810804816A CN109035121B CN 109035121 B CN109035121 B CN 109035121B CN 201810804816 A CN201810804816 A CN 201810804816A CN 109035121 B CN109035121 B CN 109035121B
- Authority
- CN
- China
- Prior art keywords
- target
- trackv
- sensor
- inputv
- expected position
- 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
Links
- 238000007781 pre-processing Methods 0.000 title claims abstract description 15
- 238000000034 method Methods 0.000 title claims abstract description 13
- 238000001514 detection method Methods 0.000 claims abstract description 23
- 238000004891 communication Methods 0.000 description 3
- 230000001052 transient effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q50/00—Information and communication technology [ICT] specially adapted for implementation of business processes of specific business sectors, e.g. utilities or tourism
- G06Q50/40—Business processes related to the transportation industry
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
- H04L69/00—Network arrangements, protocols or services independent of the application payload and not provided for in the other groups of this subclass
- H04L69/22—Parsing or analysis of headers
Landscapes
- Engineering & Computer Science (AREA)
- Business, Economics & Management (AREA)
- Human Resources & Organizations (AREA)
- Marketing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Health & Medical Sciences (AREA)
- Economics (AREA)
- General Health & Medical Sciences (AREA)
- Computer Security & Cryptography (AREA)
- Signal Processing (AREA)
- Primary Health Care (AREA)
- Strategic Management (AREA)
- Tourism & Hospitality (AREA)
- Physics & Mathematics (AREA)
- General Business, Economics & Management (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Traffic Control Systems (AREA)
Abstract
The invention discloses a single-sensor data association preprocessing method, which comprises the following steps: step 1, receiving a sensor CAN message, analyzing the sensor CAN message, calculating the relative speed of a vehicle and a target object detected by a sensor, adding a timestamp to the sensor CAN message, and obtaining a target detection position inputV with the timestamp; step 2, judging whether the target expected position trackV is empty; step 3, if the target expected position trackV is empty, trackV = inputV; otherwise, entering step 4; step 4, judging whether the timestamp difference T _ input-T _ track is smaller than a preset value A or not; if not, then rack v = inputV; if yes, entering step 5; and 5, estimating the trackV at the T _ input moment according to the timestamp difference and the relative speed of the vehicle and the target object. The invention can improve the stability of the system.
Description
Technical Field
The invention belongs to the technical field of sensor data processing, and particularly relates to a single sensor data association preprocessing method.
Background
With the modern technology progress and the scientific and technological development, people have higher and higher requirements on vehicles, and intelligent control of the vehicles, such as unmanned vehicles, self-adaptive cruise, active safety of the vehicles, full-automatic parking and other functions, is required to be realized on the basis of meeting the traditional driving. The sensor modules (such as laser radar, millimeter wave radar, camera and the like) for sensing the environment and the situation are important components in intelligent control, and are important for processing data acquired by a single sensor and fusing data acquired by a plurality of sensors.
Therefore, it is necessary to develop a new single-sensor data correlation preprocessing method.
Disclosure of Invention
The invention aims to provide a single-sensor data association preprocessing method, which is used for reducing the stability of a system, reducing the data processing amount and improving the efficiency of data preprocessing.
The single-sensor data association preprocessing method comprises the following steps of:
the method comprises the following steps:
step a, receiving a sensor CAN message, analyzing the sensor CAN message, calculating the relative speed of a vehicle and a target object detected by a sensor, adding a timestamp to the sensor CAN message, and obtaining a target detection position inputV with the timestamp, wherein the target detection position inputV = { input1, input2, input3, …, input x, … and input } and m represents the number of the target object contained in the sensor data of the current frame of the sensor;
step b, judging whether the target expected position trackV is empty, wherein the target expected position trackV = { track1, track2, track3, track x, …, track }, and n represents the number of target objects contained in the previous frame of sensor data;
step c, if the target expected position trackV is empty, setting the target expected position trackV as a current target detection position inputV; if the target expected position trackV is not empty, entering step d;
step d, judging whether the timestamp difference between the target expected position trackV and the target detection position inputV is smaller than a preset value A or not, wherein the timestamp of the target expected position trackV is T _ track, and the timestamp of the target detection position inputV is T _ input; if not, setting the target expected position trackV as the current target detection position inputV; if yes, entering step e;
and e, estimating the target expected position inputV at the time of T _ input according to the time stamp difference and the relative speed of the vehicle and the target object.
Further, in the step a, calculating a relative speed between the vehicle and the target object detected by the sensor, specifically:
acquiring the absolute speed of a target object from a sensor;
acquiring the absolute speed of the vehicle from the CAN bus;
the relative speed of the target object and the host vehicle is calculated according to the absolute speed of the target object and the host vehicle.
Further, in step e, a calculation formula of trackV at the time of T _ input is as follows:
target expected position trackV at time T _ input = target expected position trackV + (T _ input-T _ track) at time T _ track, relative speed of the host vehicle and the target object.
Further, the preset value A is 0.3 s.
The invention has the following advantages: before the data association between the target detection position and the target prediction position is performed, a precondition judgment condition is set, that is, whether the timestamp difference between the target expected position and the target detection position is smaller than a preset value A or not is judged, if the timestamp difference is larger than the preset value A, the sensor is in a fault (for example, the sensor has a communication fault), and if the sensor continues to be estimated at the moment, the estimated result is inaccurate and has a large error. The invention adopts the processing mode of directly discarding the estimated value when the time stamp difference is more than or equal to the preset value A, can avoid the influence of transient fault of the sensor on the system, and thus provides the stability of the system. In addition, the invention estimates the time difference only when the time difference is less than the preset value A, thereby reducing the data processing amount and improving the efficiency of data preprocessing.
Drawings
FIG. 1 is a flow chart of the present invention.
Detailed Description
The invention will be further explained with reference to the drawings.
As shown in fig. 1, the single-sensor data association preprocessing method of the present invention includes the following steps:
step a, the sensor sends sensed information to the processor through the CAN bus, the processor receives the CAN message of the sensor, analyzes the CAN message of the sensor, calculates the relative speed of the vehicle and a target object detected by the sensor, and adds a timestamp to the CAN message of the sensor to obtain a target detection position inputV with the timestamp. Target detection position inputV = { input1, input2, input3, …, input x, …, input m }, where m denotes the number of target objects included in sensor data of the sensor current frame;
and b, judging whether the target expected position trackV is empty or not. Where the target expected position trackV represents a set of target expected positions, the target expected position trackV = { track1, track2, track3, track x, …, track }, and n represents the number of target objects included in the last frame of sensor data. Only in the initial state, the trackV is empty.
Step c, if the target expected position trackV is empty, setting the target expected position trackV as a current target detection position inputV, namely, trackV = inputV; if the target expected position trackV is not empty, entering step d;
step d, judging whether a timestamp difference (i.e. T _ input-T _ track) between the target expected position trackV (timestamp is T _ track) and the target detection position inputV (timestamp is T _ input) is smaller than a preset value a (in this embodiment, a is 0.3 seconds); if T _ input-T _ track is less than A, the target position detected by the current sensor is considered to be a credible target position, and then the step e is carried out; otherwise, T _ input-T _ track ≧ A, which indicates that the sensor is out of order (e.g., sensor communication failure), the target expected location trackV is set to the current target detection location inputV, i.e., the estimate is discarded directly.
E, synchronizing the existing target expected position trackV (with the timestamp of T _ track) to the current target detection position inputV time (T _ input): and estimating the trackV at the T _ input moment according to the timestamp difference and the relative speed of the host vehicle and the target object. Such as: t _ input-T _ track = as, the relative velocity is bm/s, and the target expected position trackV at time T _ input = target expected position trackV + a × b at time T _ track.
In this embodiment, in the step a, the calculating the relative speed between the host vehicle and the target object detected by the sensor specifically includes: acquiring the absolute speed of a target object from a sensor; acquiring the absolute speed of the vehicle from the CAN bus; the relative speed of the target object and the host vehicle is calculated according to the absolute speed of the target object and the host vehicle.
In this embodiment, a precondition is set before the data association between the target detection position and the target predicted position is performed, that is, whether the timestamp difference between the target expected position and the target detection position is smaller than a preset value a is determined, if the timestamp difference is greater than the preset value a, it indicates that the sensor has a fault (for example, the sensor has a communication fault), and if the estimation is continued, the estimated result is inaccurate and has a large error. The invention adopts the processing mode of directly discarding the estimated value when the time stamp difference is more than or equal to the preset value A, can avoid the influence of transient fault of the sensor on the system, and thus provides the stability of the system. In addition, the invention estimates the time difference only when the time difference is less than the preset value A, thereby reducing the data processing amount and improving the efficiency of data preprocessing.
Claims (4)
1. A single-sensor data association preprocessing method is characterized by comprising the following steps:
step a, receiving a sensor CAN message, analyzing the sensor CAN message, calculating the relative speed of a vehicle and a target object detected by a sensor, adding a timestamp to the sensor CAN message, and obtaining a target detection position inputV with the timestamp, wherein the target detection position inputV = { input1, input2, input3, …, input x, … and input } and m represents the number of the target object contained in the sensor data of the current frame of the sensor;
step b, judging whether the target expected position trackV is empty, wherein the target expected position trackV = { track1, track2, track3, track x, …, track }, and n represents the number of target objects contained in the previous frame of sensor data;
step c, if the target expected position trackV is empty, setting the target expected position trackV as a current target detection position inputV; if the target expected position trackV is not empty, entering step d;
step d, judging whether the timestamp difference between the target expected position trackV and the target detection position inputV is smaller than a preset value A or not, wherein the timestamp of the target expected position trackV is T _ track, and the timestamp of the target detection position inputV is T _ input; if not, setting the target expected position trackV as the current target detection position inputV; if yes, entering step e;
and e, estimating the target expected position inputV at the time of T _ input according to the time stamp difference and the relative speed of the vehicle and the target object.
2. The single-sensor data association preprocessing method according to claim 1, characterized in that: in the step a, calculating the relative speed between the vehicle and the target object detected by the sensor, specifically:
acquiring the absolute speed of a target object from a sensor;
acquiring the absolute speed of the vehicle from the CAN bus;
the relative speed of the target object and the host vehicle is calculated according to the absolute speed of the target object and the host vehicle.
3. The single-sensor data association preprocessing method according to claim 1 or 2, characterized in that: in step e, a calculation formula of trackV at the time of T _ input is as follows:
target expected position trackV at time T _ input = target expected position trackV + (T _ input-T _ track) at time T _ track, relative speed of the host vehicle and the target object.
4. The single-sensor data association preprocessing method according to claim 1 or 2, characterized in that: the preset value A is 0.3.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810804816.8A CN109035121B (en) | 2018-07-20 | 2018-07-20 | Single-sensor data association preprocessing method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810804816.8A CN109035121B (en) | 2018-07-20 | 2018-07-20 | Single-sensor data association preprocessing method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109035121A CN109035121A (en) | 2018-12-18 |
CN109035121B true CN109035121B (en) | 2021-08-06 |
Family
ID=64643891
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810804816.8A Active CN109035121B (en) | 2018-07-20 | 2018-07-20 | Single-sensor data association preprocessing method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109035121B (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020139967A1 (en) | 2018-12-28 | 2020-07-02 | Didi Research America, Llc | Distributed system execution using a serial timeline |
US11550623B2 (en) | 2018-12-28 | 2023-01-10 | Beijing Voyager Technology Co., Ltd. | Distributed system task management using a simulated clock |
US11397610B2 (en) | 2018-12-28 | 2022-07-26 | Beijing Voyager Technology Co., Ltd. | Architecture for simulation clock-based simulation of distributed systems |
CN115599330B (en) * | 2022-09-28 | 2023-08-01 | 北京亚控科技发展有限公司 | Fault diagnosis method and related device of data acquisition system |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
AU2003303306A1 (en) * | 2002-10-09 | 2004-09-06 | California Institute Of Technology | Sensor web |
CN101114405A (en) * | 2005-09-21 | 2008-01-30 | 宁波奇科威数字教学设备有限公司 | Digitization experimental laboratory system and data control method thereof |
US7705743B2 (en) * | 2006-03-01 | 2010-04-27 | L-3 Communications Corporation | Self-assembling wireless network, vehicle communications system, railroad wheel and bearing monitoring system and methods therefor |
CN101951659B (en) * | 2010-08-13 | 2013-09-25 | 华南理工大学 | Self-organization method of sensor network and mobile terminal system based on same |
CN108237848B (en) * | 2016-12-23 | 2019-12-31 | 保隆霍富(上海)电子有限公司 | Tire position locating method and device |
CN106989744A (en) * | 2017-02-24 | 2017-07-28 | 中山大学 | A kind of rotor wing unmanned aerial vehicle autonomic positioning method for merging onboard multi-sensor |
-
2018
- 2018-07-20 CN CN201810804816.8A patent/CN109035121B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN109035121A (en) | 2018-12-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109035121B (en) | Single-sensor data association preprocessing method | |
CN109099920B (en) | Sensor target accurate positioning method based on multi-sensor association | |
US9440650B2 (en) | Collision prediction apparatus | |
CN111505624B (en) | Environment sensing method based on machine vision and millimeter wave radar data fusion | |
US8731809B2 (en) | Traffic congestion prediction method | |
US7254504B2 (en) | Method for the temporal synchronisation of a plurality of vehicle sensors | |
KR20220001498A (en) | Method and system for predicting a trajectory of a target vehicle in an environment of a vehicle | |
CN115856872A (en) | Vehicle motion track continuous tracking method | |
CN110426714B (en) | Obstacle identification method | |
KR20200068258A (en) | Apparatus and method for predicting sensor fusion target in vehicle and vehicle including the same | |
CN114268787B (en) | Delay compensation method, device, equipment and storage medium based on AR-HUD | |
JP6169146B2 (en) | Object recognition integration apparatus and object recognition integration method | |
JP2018521401A (en) | Improved calculation of time to collision for vehicles | |
JP6333437B1 (en) | Object recognition processing device, object recognition processing method, and vehicle control system | |
US11636691B2 (en) | Sensor recognition integration device | |
CN110861678A (en) | Train wheel diameter checking method and device | |
CN104614704B (en) | A kind of method and apparatus of determining mobile terminal locations | |
CN111163419A (en) | Malicious user detection method based on state mean value in vehicle cooperation dynamic tracking | |
CN113494938B (en) | Object recognition device and object recognition method | |
KR102261155B1 (en) | Method and apparatus for controlling a vehicle using two virtual sensors | |
CN114260890B (en) | Method and device for determining state of robot, robot and storage medium | |
CN115294172A (en) | Target detection method and device, electronic equipment and storage medium | |
CN108827369B (en) | Method for improving sensor association efficiency | |
CN112346985B (en) | ACC function failure determination method, system, device and storage medium | |
CN116923457B (en) | Man-machine co-driving system, method and device |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |