CN108776333A - A kind of secondary cascade fusion method of data, system, mobile unit and storage medium - Google Patents

A kind of secondary cascade fusion method of data, system, mobile unit and storage medium Download PDF

Info

Publication number
CN108776333A
CN108776333A CN201810632460.4A CN201810632460A CN108776333A CN 108776333 A CN108776333 A CN 108776333A CN 201810632460 A CN201810632460 A CN 201810632460A CN 108776333 A CN108776333 A CN 108776333A
Authority
CN
China
Prior art keywords
flight path
fusion
forward direction
measurement
measures
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.)
Granted
Application number
CN201810632460.4A
Other languages
Chinese (zh)
Other versions
CN108776333B (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.)
Uisee Shanghai Automotive Technologies Ltd
Original Assignee
Uisee Shanghai Automotive Technologies 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 Uisee Shanghai Automotive Technologies Ltd filed Critical Uisee Shanghai Automotive Technologies Ltd
Priority to CN201810632460.4A priority Critical patent/CN108776333B/en
Publication of CN108776333A publication Critical patent/CN108776333A/en
Application granted granted Critical
Publication of CN108776333B publication Critical patent/CN108776333B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/86Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • G01S13/867Combination of radar systems with cameras
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F18/00Pattern recognition
    • G06F18/20Analysing
    • G06F18/25Fusion techniques

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Theoretical Computer Science (AREA)
  • Electromagnetism (AREA)
  • Data Mining & Analysis (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Biology (AREA)
  • Evolutionary Computation (AREA)
  • General Engineering & Computer Science (AREA)
  • Artificial Intelligence (AREA)
  • Traffic Control Systems (AREA)

Abstract

The present embodiments relate to a kind of secondary cascade fusion methods of data, system, mobile unit and storage medium, pass through distributed data fusion mode, inter-process first is carried out to initial data by sensor, obtain the measurement flight path of barrier and corresponding measurement time, and to Fusion Module or global Fusion Module before being sent to, the measurement flight path of barrier is merged twice based on the measurement time of acquisition by forward direction Fusion Module and global Fusion Module again, and the fusion process of global Fusion Module needs the preceding fusion results to Fusion Module, belong to distributed data fusion method, compared to the data fusion of centralization, distributed data fusion traffic load is low, redundancy is high, computing resource is few and adaptation flexibility ratio is high.

Description

A kind of secondary cascade fusion method of data, system, mobile unit and storage medium
Technical field
The present embodiments relate to vehicle drive technical fields, and in particular to a kind of secondary cascade fusion method of data is System, mobile unit and storage medium.
Background technology
With the fast development of vehicle assistant drive technology and unmanned technology, the perception requirement to vehicle-surroundings environment Higher and higher, the data fusion scheme of low cost, high reliability and high suitability becomes vehicle assistant drive technology and nobody drives Sail technology quickly land it is basic.
Current vehicle auxiliary drives and unmanned master detecting sensor to be used includes:Imaging sensor and radar, Wherein, radar includes again:Millimetre-wave radar, ultrasonic radar and laser radar etc..Different detecting sensors has difference The characteristics of and different sensing ranges, therefore, the fusions of different detecting sensor data becomes vehicle assistant drive and nobody drives Important technology component part in sailing, by merging the detecting sensor data of different characteristics and different sensing ranges, Ke Yishi Existing bigger investigative range, more locating tab assembly precision, less context aware systems reported by mistake and failed to report.
For this purpose, there is an urgent need for a kind of Fusion scheme, the perception to vehicle-surroundings barrier is realized, be that vehicle is auxiliary Driving and unpiloted planning and control is helped to provide perception information.
Invention content
Of the existing technology in order to solve the problems, such as, at least one embodiment of the present invention provides a kind of data secondary stage Join fusion method, system, mobile unit and storage medium.
In a first aspect, the embodiment of the present invention proposes a kind of secondary cascade fusion method of data, including:
Forward direction Fusion Module obtains the first of multiple forward direction flight path measurement sensors and measures flight path and each described first Measure corresponding first measurement time of flight path;
Forward direction Fusion Module measures flight path to the first of the multiple forward direction flight path measurement sensor and carries out Single cell fusion, obtains To preceding to fusion results, the forward direction fusion results include:When the corresponding fusion of at least one fusion flight path, each fusion flight path The first measurement flight path that quarter, the first measurement flight path for meeting default reserve and each satisfaction preset reserve is corresponding First measurement time;
Global Fusion Module obtains the first measurement flight path of the forward direction fusion results, multiple front side flight path measurement sensors And corresponding first measurement time of each front side flight path measurement sensor;
Global Fusion Module is based on first merged in moment, the forward direction fusion results in the forward direction fusion results Measurement time, each corresponding first measurement time of the front side flight path measurement sensor, in the forward direction fusion results First merged in flight path, the forward direction fusion results measures the first of flight path and the multiple front side flight path measurement sensor It measures flight path and carries out secondary fusion.
In some embodiments, the forward direction Fusion Module is measured the first of the multiple forward direction flight path measurement sensor Flight path carries out Single cell fusion, including:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between exist The first of incidence relation measures flight path;
There will be the first measurement flight paths of incidence relation to be merged for the forward direction Fusion Module, obtains at least one fusion Flight path and each fusion flight path corresponding fusion moment.
In some embodiments, the forward direction Fusion Module is measured the first of the multiple forward direction flight path measurement sensor Flight path carries out Single cell fusion, further includes:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between do not deposit First in incidence relation measures flight path;
The forward direction Fusion Module is from there is no the first of incidence relation to measure the default reserve of selection satisfaction in flight path First measure flight path.
In some embodiments, the forward direction Fusion Module selects full from there is no the measurement flight path of the first of incidence relation The first of the default reserve of foot measures flight path, including:
The forward direction Fusion Module judges that there is no the first of incidence relation to measure the corresponding forward direction flight path measurement biography of flight path Whether sensor is preceding to imaging sensor;If so, selection described first measures flight path;If not, it is determined that described first measures The Threat of flight path, selection meet the first measurement flight path for presetting Threat condition.
In some embodiments, the global Fusion Module is based on fusion moment, described in the forward direction fusion results The first measurement time in forward direction fusion results, corresponding first measurement time of each front side flight path measurement sensor are right First in fusion flight path, the forward direction fusion results in the forward direction fusion results measures flight path and the multiple front side The first of flight path measurement sensor measures flight path and carries out secondary fusion, including:
To the fusion flight path in the forward direction fusion results, the first measurement flight path in the forward direction fusion results and institute It states the first of multiple front side flight path measurement sensors and measures the unification that flight path carries out data format, obtain corresponding second and measure boat Mark;
Based on fusion moment in the forward direction fusion results, the first measurement time in the forward direction fusion results, every Corresponding first measurement time of a front side flight path measurement sensor carries out time synchronization to each system flight path of storage, Obtain the corresponding prediction flight path of each system flight path;
Based on each prediction flight path, determine that each described second measures between flight path and each system flight path Incidence relation;
Based on the incidence relation, the system flight path that updates storage.
In some embodiments, described based on each prediction flight path, determine each described second measure flight path with it is every Incidence relation between a system flight path, including:
It is measured in flight path from all described second, searches and measure flight path with the second of the prediction track matching;
The corresponding system flight path of the prediction flight path is associated with the second measurement flight path found.
In some embodiments, the lookup measures flight path with the second of the prediction track matching, including:
Centered on the prediction flight path, searches and whether there is at least one the around the prediction flight path in preset range Two measure flight path;
If in the presence of the second measurement flight path nearest apart from the prediction flight path and the prediction track matching.
In some embodiments, the determination each described second measures the pass between flight path and each system flight path After connection relationship, the method further includes:
Storage second measures the incidence relation between flight path and system flight path;
Correspondingly, described based on each first measurement time, time synchronization is carried out to each system flight path of storage, After obtaining the corresponding prediction flight path of each system flight path, the method further includes:
Search whether the incidence relation being stored between the second measurement flight path and system flight path;
If not storing, execute it is described based on each prediction flight path, determine each described second measure flight path with it is every The step of incidence relation between a system flight path.
In some embodiments, the method further includes:
If being stored with the incidence relation between the second measurement flight path and system flight path, the second measurement in incidence relation is judged Whether flight path meets preset matching condition with system flight path;
If satisfied, then maintaining the incidence relation;
If not satisfied, then execute it is described based on each prediction flight path, determine each described second measure flight path with it is every The step of incidence relation between a system flight path.
In some embodiments, described based on the incidence relation, the system flight path updated storage, including:
Judge whether each system flight path of storage is system flight path in the incidence relation;
It navigates if so, measuring flight path using system flight path described in the incidence relation corresponding second and updating the system Mark;
If it is not, then updating the system flight path using the corresponding prediction flight path of the system flight path.
In some embodiments, after the system flight path updated storage, the method further includes:
Based on the update mode of system flight path, the confidence level of the system flight path after management update.
In some embodiments, the update mode based on system flight path, system flight path after management update it is credible Degree, including:
If the update mode of system flight path is to be updated using the second measurement flight path in the incidence relation, increase The confidence level of the system flight path.
In some embodiments, the update mode based on system flight path, system flight path after management update it is credible Degree, including:
If the update mode of system flight path is to be updated using prediction flight path, the corresponding boat of the update mode is obtained Mark measurement sensor;
Judge whether the system flight path is in the sensing range of the corresponding flight path measurement sensor of the update mode, If being in, the confidence level of the system flight path is reduced;If being not in, the confidence level of the system flight path is maintained.
In some embodiments, after the confidence level of the system flight path after the management update, the method further includes:
Judge whether the confidence level of the system flight path after management reaches default output thresholding, default output thresholding must be reached System flight path;
Reach the system flight path of default output thresholding described in output.
In some embodiments, after the confidence level for reducing the system flight path, the method further includes:
Judge the confidence level of the system flight path whether less than default elimination thresholding;
If being less than, the system flight path is eliminated.
In some embodiments, after the confidence level of the system flight path after the management update, the method further includes:
Do not used by the incidence relation in flight path second is measured to each first measurement flight path corresponding second It measures flight path and carries out initialization process.
In some embodiments, the initialization process, including:
Obtain this car state information;
Based on described car state information, this wheel paths is estimated;
Whether the second measurement flight path not used by the incidence relation described in judging is far from described wheel paths;
If so, the second measurement flight path not used by the incidence relation described in eliminating;
If it is not, then not turning to system flight path by the second measurement initial track that the incidence relation uses by described.
In some embodiments, the initialization process further includes:
It assigns and is initialized as the second of the system flight path confidence level for measuring flight path.
In some embodiments, the initialization process further includes:
Obtain the judgement information of multiple barrier judgment sensors;
According to the judgement information, it is determined whether there are barriers;
If there are barrier, judge that the barrier is initialized as whether the second of system flight path measure flight path with described Positioned at the homonymy of this vehicle;The confidence level of flight path is measured as the first confidence level if so, assigning and being initialized as the second of system flight path; The confidence level of flight path is measured as the second confidence level if it is not, then assigning and being initialized as the second of system flight path;
If barrier is not present, it is second credible to assign and be initialized as the confidence level that the second of system flight path measures flight path Degree;
Wherein, first confidence level is more than second confidence level.
In some embodiments, the multiple forward direction flight path measurement sensor includes:Forward direction imaging sensor and forward direction thunder It reaches;The multiple front side flight path measurement sensor includes:Front left side radar and forward right side radar.
In some embodiments, the multiple barrier judgment sensor includes:Left rear side radar and right lateral side radar.
Second aspect, the embodiment of the present invention also propose a kind of secondary cascade emerging system of data, the system comprises:
Forward direction Fusion Module measures flight path and each described for obtaining the first of multiple forward direction flight path measurement sensors First measures corresponding first measurement time of flight path;
The forward direction Fusion Module is additionally operable to measure the first of the multiple forward direction flight path measurement sensor flight path progress Single cell fusion, to fusion results before obtaining, the forward direction fusion results include:At least one fusion flight path each merges flight path Corresponding fusion moment, satisfaction preset the first measurement flight path of reserve and each meet the first of default reserve and survey Measure corresponding first measurement time of flight path;
Global Fusion Module, first for obtaining the forward direction fusion results, multiple front side flight path measurement sensors surveys Measure flight path and corresponding first measurement time of each front side flight path measurement sensor;
The overall situation Fusion Module is additionally operable to based on the fusion moment in the forward direction fusion results, forward direction fusion As a result the first measurement time in, corresponding first measurement time of each front side flight path measurement sensor, to the forward direction First in fusion flight path, the forward direction fusion results in fusion results measures flight path and the multiple front side flight path measures The first of sensor measures flight path and carries out secondary fusion.
In some embodiments, the forward direction Fusion Module is measured the first of the multiple forward direction flight path measurement sensor Flight path carries out Single cell fusion, including:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between exist The first of incidence relation measures flight path;
There will be the first measurement flight paths of incidence relation to be merged for the forward direction Fusion Module, obtains at least one fusion Flight path and each fusion flight path corresponding fusion moment.
In some embodiments, the forward direction Fusion Module is measured the first of the multiple forward direction flight path measurement sensor Flight path carries out Single cell fusion, further includes:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between do not deposit First in incidence relation measures flight path;
The forward direction Fusion Module is from there is no the first of incidence relation to measure the default reserve of selection satisfaction in flight path First measure flight path.
In some embodiments, the forward direction Fusion Module selects full from there is no the measurement flight path of the first of incidence relation The first of the default reserve of foot measures flight path, including:
The forward direction Fusion Module judges that there is no the first of incidence relation to measure the corresponding forward direction flight path measurement biography of flight path Whether sensor is preceding to imaging sensor;If so, selection described first measures flight path;If not, it is determined that described first measures The Threat of flight path, selection meet the first measurement flight path for presetting Threat condition.
In some embodiments, the system overall situation Fusion Module, including:
Acquiring unit, first for obtaining the forward direction fusion results, multiple front side flight path measurement sensors measures boat Mark and corresponding first measurement time of each front side flight path measurement sensor;
Unified Element, for first merged in flight path, the forward direction fusion results in the forward direction fusion results It measures the first of flight path and the multiple front side flight path measurement sensor and measures the unification that flight path carries out data format, obtain pair Second answered measures flight path;
Synchronization unit, for based on the fusion moment in the forward direction fusion results, the in the forward direction fusion results One measurement time, each corresponding first measurement time of the front side flight path measurement sensor, to each system flight path of storage Time synchronization is carried out, the corresponding prediction flight path of each system flight path is obtained;
Determination unit, for based on each prediction flight path, determine each described second measure flight path with it is each described Incidence relation between system flight path;
Updating unit, for being based on the incidence relation, the system flight path updated storage.
In some embodiments, the determination unit, including:
Subelement is searched, for being measured in flight path from all described second, searches second with the prediction track matching Measure flight path;
It is associated with subelement, for carrying out the corresponding system flight path of the prediction flight path and the second measurement flight path found Association.
In some embodiments, the lookup subelement, is used for:
Centered on the prediction flight path, searches and whether there is at least one the around the prediction flight path in preset range Two measure flight path;
If in the presence of the second measurement flight path nearest apart from the prediction flight path and the prediction track matching.
In some embodiments, the system also includes:
Storage unit, for the determination unit determine each described second measure flight path and each system flight path it Between incidence relation after, storage second measures the incidence relation between flight path and system flight path;
Searching unit after obtaining the corresponding prediction flight path of each system flight path for the synchronization unit, is searched The incidence relation whether being stored between the second measurement flight path and system flight path;
Correspondingly, the determination unit, after not stored for searching unit determination, based on each prediction boat Mark determines that each described second measures the incidence relation between flight path and each system flight path.
In some embodiments, the system also includes:
First judging unit determines the pass being stored between the second measurement flight path and system flight path for the searching unit After connection relationship, judge whether the second measurement flight path meets preset matching condition with system flight path in incidence relation;
Maintenance unit maintains the association after meeting preset matching condition for first judging unit judgement Relationship;
The determination unit, after being unsatisfactory for preset matching condition for first judging unit judgement, based on every A prediction flight path determines that each described second measures the incidence relation between flight path and each system flight path.
In some embodiments, the updating unit, including:
Judgment sub-unit, for judging whether each system flight path of storage is system flight path in the incidence relation;
First update subelement is the system boat in the incidence relation for the judgment sub-unit decision-making system flight path After mark, measures flight path using system flight path described in the incidence relation corresponding second and update the system flight path;
Second update subelement, is not the system in the incidence relation for the judgment sub-unit decision-making system flight path After flight path, the system flight path is updated using the corresponding prediction flight path of the system flight path.
In some embodiments, the system also includes:
Administrative unit, after the system flight path updated storage for the updating unit, the update side based on system flight path Formula, the confidence level of the system flight path after management update.
In some embodiments, the administrative unit, is used for:
If the update mode of system flight path is to be updated using the second measurement flight path in the incidence relation, increase The confidence level of the system flight path.
In some embodiments, the administrative unit, is used for:
If the update mode of system flight path is to be updated using prediction flight path, the corresponding boat of the update mode is obtained Mark measurement sensor;
Judge whether the system flight path is in the sensing range of the corresponding flight path measurement sensor of the update mode, If being in, the confidence level of the system flight path is reduced;If being not in, the confidence level of the system flight path is maintained.
In some embodiments, the system also includes:
Second judgment unit is used for after the confidence level of the system flight path after the administrative unit management update, judges to manage Whether the confidence level of the system flight path after reason reaches default output thresholding, must reach the system flight path of default output thresholding;
Output unit, for exporting the system flight path for reaching default output thresholding.
In some embodiments, the administrative unit is additionally operable to:
After the confidence level for reducing the system flight path, judge whether the confidence level of the system flight path is eliminated less than default Thresholding;
If eliminating thresholding less than default, the system flight path is eliminated.
In some embodiments, the system also includes:
Initialization unit is used for after the confidence level of the system flight path after the administrative unit management update, to each institute It states in the corresponding second measurement flight path of the first measurement flight path and is not carried out initially by the second measurement flight path that the incidence relation uses Change is handled.
In some embodiments, the initialization unit carries out initialization process, including:
Obtain this car state information;
Based on described car state information, this wheel paths is estimated;
Whether the second measurement flight path not used by the incidence relation described in judging is far from described wheel paths;
If so, the second measurement flight path not used by the incidence relation described in eliminating;
If it is not, then not turning to system flight path by the second measurement initial track that the incidence relation uses by described.
In some embodiments, the initialization unit carries out initialization process, further includes:
It assigns and is initialized as the second of the system flight path confidence level for measuring flight path.
In some embodiments, the initialization unit carries out initialization process, further includes:
Obtain the judgement information of multiple barrier judgment sensors;
According to the judgement information, it is determined whether there are barriers;
If there are barrier, judge that the barrier is initialized as whether the second of system flight path measure flight path with described Positioned at the homonymy of this vehicle;The confidence level of flight path is measured as the first confidence level if so, assigning and being initialized as the second of system flight path; The confidence level of flight path is measured as the second confidence level if it is not, then assigning and being initialized as the second of system flight path;
If barrier is not present, it is second credible to assign and be initialized as the confidence level that the second of system flight path measures flight path Degree;
Wherein, first confidence level is more than second confidence level.
In some embodiments, the multiple forward direction flight path measurement sensor includes:Forward direction imaging sensor and forward direction thunder It reaches;The multiple front side flight path measurement sensor includes:Front left side radar and forward right side radar.
In some embodiments, the multiple barrier judgment sensor includes:Left rear side radar and right lateral side radar.
The third aspect, the embodiment of the present invention also propose a kind of mobile unit, including:
Processor, memory, network interface and user interface;
The processor, memory, network interface and user interface are coupled by bus system;
The processor is by the program for calling the memory to store or instruction, for executing side as described in relation to the first aspect The step of method.
Fourth aspect, the embodiment of the present invention also propose a kind of non-transient computer readable storage medium, the non-transient meter Calculation machine readable storage medium storing program for executing stores computer instruction, and the computer instruction makes the computer execute side as described in relation to the first aspect The step of method.
As it can be seen that at least one embodiment of the embodiment of the present invention, by distributed data fusion mode, by sensor Inter-process is carried out to initial data, obtains the measurement flight path of barrier and corresponding measurement time, and is exported to mobile unit, The prediction flight path corresponding to the history flight path of barrier is obtained by measurement time of the mobile unit based on acquisition again, is set to vehicle-mounted It is standby to can determine whether the prediction flight path of barrier corresponds to the same barrier with the measurement flight path of barrier.And then mobile unit can The history flight path of the measurement flight path of barrier and barrier is associated, realizes that the flight path of the same barrier different moments closes Connection, is finally based on incidence relation, the history flight path of regeneration barrier object realizes Fusion.
Description of the drawings
In order to illustrate the technical solution of the embodiments of the present invention more clearly, below will be in embodiment or description of the prior art Required attached drawing is briefly described, it should be apparent that, the accompanying drawings in the following description is only some realities of the present invention Example is applied, it for those of ordinary skill in the art, without having to pay creative labor, can also be attached according to these Figure obtains other attached drawings.
Fig. 1 is a kind of mobile unit structure chart provided in an embodiment of the present invention;
Fig. 2 is a kind of secondary cascade fusion method flow chart of data provided in this embodiment;
Fig. 3 is the secondary cascade fusion method flow chart of another data provided in this embodiment;
Fig. 4 is the secondary cascade fusion method flow chart of another data provided in this embodiment;
Fig. 5 is the secondary cascade fusion method flow chart of another data provided in this embodiment;
Fig. 6 is a kind of work flow diagram of global Fusion Module provided in an embodiment of the present invention;
Fig. 7 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Fig. 8 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Fig. 9 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 10 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 11 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 12 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 13 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 14 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 15 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 16 is the work flow diagram of another global Fusion Module provided in an embodiment of the present invention;
Figure 17 is a kind of initialization process flow chart provided in an embodiment of the present invention;
Figure 18 is another initialization process flow chart provided in an embodiment of the present invention;
Figure 19 is another initialization process flow chart provided in an embodiment of the present invention;
Figure 20 is another initialization process flow chart provided in an embodiment of the present invention;
Figure 21 is a kind of schematic diagram for the sensor being installed on vehicle provided in an embodiment of the present invention;
Figure 22 is a kind of secondary cascade emerging system structural schematic diagram of data provided in an embodiment of the present invention;
Figure 23 is a kind of secondary cascade emerging system structural schematic diagram of data provided in an embodiment of the present invention;
Figure 24 is a kind of global Fusion Module block diagram provided in an embodiment of the present invention;
Figure 25 is another global Fusion Module block diagram provided in an embodiment of the present invention;
Figure 26 is another global Fusion Module block diagram provided in an embodiment of the present invention;
Figure 27 is another global Fusion Module block diagram provided in an embodiment of the present invention;
Figure 28 is another global Fusion Module block diagram provided in an embodiment of the present invention;
Figure 29 is another global Fusion Module block diagram provided in an embodiment of the present invention;
Figure 30 is another global Fusion Module block diagram provided in an embodiment of the present invention;
Figure 31 is another global Fusion Module block diagram provided in an embodiment of the present invention.
Specific implementation mode
In order to make the object, technical scheme and advantages of the embodiment of the invention clearer, below in conjunction with the embodiment of the present invention In attached drawing, technical scheme in the embodiment of the invention is clearly and completely described, it is clear that described embodiment is A part of the embodiment of the present invention, instead of all the embodiments.Based on the embodiments of the present invention, ordinary skill people The every other embodiment that member is obtained without making creative work, shall fall within the protection scope of the present invention.
It should be noted that herein, the relational terms of such as " first " and " second " or the like are used merely to one A entity or operation with another entity or operate distinguish, without necessarily requiring or implying these entities or operation it Between there are any actual relationship or orders.
Currently, the functional development of vehicle assistant drive includes:Forward direction functional development and multi-direction functional development, wherein preceding To functional development for example including:AEB (Autonomous Emergency Braking, automatic emergency brake) system, ACC (Adaptive Cruise Control, adaptive learning algorithms) system, FCW (Forward Collision Warning, Front collision warning) system and LKA (Lane Keeping Aid, track keep auxiliary) system etc.;Multi-direction functional development example Such as include:Automatic lane-change system.
As it can be seen that with the functional development of vehicle assistant drive, the allocation plan of detecting sensor is also by single forward direction figure To the scheme of imaging sensor and forward direction radar fusion, forward direction image sensing before being developed into as sensor and single forward direction radar Device is mounted on the front of vehicle, and for the image and video immediately ahead of collection vehicle, forward direction radar is mounted on the front of vehicle, uses In the barrier of detection right ahead.For multi-direction functional development, it is also necessary to the data of lateral sensor are merged, it is lateral to pass Sensor can be understood as the detecting sensor mounted on vehicle both sides, the barrier for detecting two side periphery of vehicle.
Fig. 1 is the structural schematic diagram of mobile unit provided in an embodiment of the present invention.Mobile unit shown in FIG. 1 includes:Extremely A few processor 901, at least one processor 902, at least one network interface 904 and other user interfaces 903.It is vehicle-mounted Various components in equipment are coupled by bus system 905.It is understood that bus system 905 is for realizing these components Between connection communication.Bus system 905 further includes power bus, controlling bus and state letter in addition to including data/address bus Number bus.But for the sake of clear explanation, various buses are all designated as bus system 905 in Fig. 1.
Wherein, user interface 903 may include display, keyboard or pointing device (for example, mouse, trace ball (trackball) or touch-sensitive plate etc..
It is appreciated that the memory 902 in the present embodiment can be volatile memory or nonvolatile memory, or can Including both volatile and non-volatile memories.Wherein, nonvolatile memory can be read-only memory (Read- OnlyMemory, ROM), programmable read only memory (ProgrammableROM, PROM), the read-only storage of erasable programmable Device (ErasablePROM, EPROM), electrically erasable programmable read-only memory (ElectricallyEPROM, EEPROM) dodge It deposits.Volatile memory can be random access memory (RandomAccessMemory, RAM), and it is slow to be used as external high speed It deposits.By exemplary but be not restricted explanation, the RAM of many forms is available, such as static RAM (StaticRAM, SRAM), dynamic random access memory (DynamicRAM, DRAM), Synchronous Dynamic Random Access Memory (SynchronousDRAM, SDRAM), double data speed synchronous dynamic RAM (DoubleDataRate SDRAM, DDRSDRAM), enhanced Synchronous Dynamic Random Access Memory (Enhanced SDRAM, ESDRAM), synchronized links Dynamic random access memory (SynchlinkDRAM, SLDRAM) and direct rambus random access memory (DirectRambusRAM, DRRAM).Memory 902 described herein be intended to including but not limited to these and it is any other be suitble to The memory of type.
In some embodiments, memory 902 stores following element, can perform unit or data structure, or Their subset of person or their superset:Operating system 9021 and application program 9022.
Wherein, operating system 9021, including various system programs, such as ccf layer, core library layer, driving layer etc., are used for Realize various basic businesses and the hardware based task of processing.Application program 9022, including various application programs, such as media Player (MediaPlayer), browser (Browser) etc., for realizing various applied business.Realize embodiment of the present invention side The program of method may be embodied in application program 9022.
In embodiments of the present invention, processor 901 is by the program for calling memory 902 to store or instruction, specifically, can To be the program stored in application program 9022 or instruction, processor 901 is for executing the method that each method embodiment is provided Step, such as including:
Forward direction Fusion Module obtains the first of multiple forward direction flight path measurement sensors and measures flight path and each described first Measure corresponding first measurement time of flight path;
Forward direction Fusion Module measures flight path to the first of the multiple forward direction flight path measurement sensor and carries out Single cell fusion, obtains To preceding to fusion results, the forward direction fusion results include:When the corresponding fusion of at least one fusion flight path, each fusion flight path The first measurement flight path that quarter, the first measurement flight path for meeting default reserve and each satisfaction preset reserve is corresponding First measurement time;
Global Fusion Module obtains the first measurement flight path of the forward direction fusion results, multiple front side flight path measurement sensors And corresponding first measurement time of each front side flight path measurement sensor;
Global Fusion Module is based on first merged in moment, the forward direction fusion results in the forward direction fusion results Measurement time, each corresponding first measurement time of the front side flight path measurement sensor, in the forward direction fusion results First merged in flight path, the forward direction fusion results measures the first of flight path and the multiple front side flight path measurement sensor It measures flight path and carries out secondary fusion.
The method that the embodiments of the present invention disclose can be applied in processor 901, or be realized by processor 901. Processor 901 may be a kind of IC chip, the processing capacity with signal.During realization, the above method it is each Step can be completed by the integrated logic circuit of the hardware in processor 901 or the instruction of software form.Above-mentioned processing Device 901 can be general processor, digital signal processor (DigitalSignalProcessor, DSP), special integrated electricity Road (ApplicationSpecific IntegratedCircuit, ASIC), ready-made programmable gate array (FieldProgrammableGateArray, FPGA) either other programmable logic device, discrete gate or transistor logic Device, discrete hardware components.It may be implemented or execute disclosed each method, step and the logical box in the embodiment of the present invention Figure.General processor can be microprocessor or the processor can also be any conventional processor etc..In conjunction with the present invention The step of method disclosed in embodiment, can be embodied directly in hardware decoding processor and execute completion, or use decoding processor In hardware and software unit combination execute completion.Software unit can be located at random access memory, and flash memory, read-only memory can In the storage medium of this fields such as program read-only memory or electrically erasable programmable memory, register maturation.The storage Medium is located at memory 902, and processor 901 reads the information in memory 902, and the step of the above method is completed in conjunction with its hardware Suddenly.
It is understood that embodiments described herein can use hardware, software, firmware, middleware, microcode or its It combines to realize.For hardware realization, processing unit may be implemented in one or more application-specific integrated circuits (ASIC), number letter Number processor (DSP), digital signal processing appts (DSPDevice, DSPD), programmable logic device (PLD), field-programmable Gate array (FPGA), general processor, controller, microcontroller, microprocessor, for executing the other of herein described function In electronic unit or combinations thereof.
For software implementations, the techniques described herein can be realized by executing the unit of function described herein.Software generation Code is storable in memory and is executed by processor.Memory can in the processor or portion realizes outside the processor.
Those of ordinary skill in the art may realize that lists described in conjunction with the examples disclosed in the embodiments of the present disclosure Member and algorithm steps can be realized with the combination of electronic hardware or computer software and electronic hardware.These functions are actually It is implemented in hardware or software, depends on the specific application and design constraint of technical solution.Professional technician Each specific application can be used different methods to achieve the described function, but this realization is it is not considered that exceed The scope of the present invention.
It is apparent to those skilled in the art that for convenience and simplicity of description, the system of foregoing description, The specific work process of device and unit, can refer to corresponding processes in the foregoing method embodiment, and details are not described herein.
In embodiment provided herein, it should be understood that unless existing clear between the step of embodiment of the method Sequencing, otherwise execution sequence can arbitrarily adjust.Disclosed device and method, may be implemented in other ways. For example, the apparatus embodiments described above are merely exemplary, for example, the division of the unit, only a kind of logic Function divides, and formula that in actual implementation, there may be another division manner, such as multiple units or component can combine or can collect At to another system, or some features can be ignored or not executed.Another point, shown or discussed mutual coupling Close or direct-coupling or communication connection can be by some interfaces, the INDIRECT COUPLING or communication connection of device or unit, can be with It is electrical, machinery or other forms.
The unit illustrated as separating component may or may not be physically separated, aobvious as unit The component shown may or may not be physical unit, you can be located at a place, or may be distributed over multiple In network element.Some or all of unit therein can be selected according to the actual needs to realize the mesh of this embodiment scheme 's.
In addition, each functional unit in each embodiment of the present invention can be integrated in a processing unit, it can also It is that each unit physically exists alone, it can also be during two or more units be integrated in one unit.
It, can be with if the function is realized in the form of SFU software functional unit and when sold or used as an independent product It is stored in a computer read/write memory medium.Based on this understanding, the technical solution of the embodiment of the present invention is substantially The part of the part that contributes to existing technology or the technical solution can embody in the form of software products in other words Come, which is stored in a storage medium, including some instructions are used so that a computer equipment (can To be personal computer, server or the network equipment etc.) execute all or part of each embodiment the method for the present invention Step.And storage medium above-mentioned includes:USB flash disk, mobile hard disk, ROM, RAM, magnetic disc or CD etc. are various can to store program The medium of code.
As shown in Fig. 2, the present embodiment discloses a kind of secondary cascade fusion method of data, multiple sensors are mounted on vehicle On, the executive agent of this method is mobile unit, and mobile unit is communicated to connect with each sensor, and this method may include following step Rapid A1 to A4:
A1, forward direction Fusion Module obtain the first of multiple forward direction flight path measurement sensors and measure flight path and each described the One measures corresponding first measurement time of flight path;
A2, forward direction Fusion Module once melt the first measurement flight path of the multiple forward direction flight path measurement sensor It closes, to fusion results before obtaining, the forward direction fusion results include:At least one fusion flight path, each fusion flight path are corresponding The moment is merged, the first measurement flight path of default reserve is met and each meets the first measurement flight path for presetting reserve Corresponding first measurement time;
A3, global Fusion Module obtain the first measurement of the forward direction fusion results, multiple front side flight path measurement sensors Flight path and corresponding first measurement time of each front side flight path measurement sensor;
A4, global Fusion Module based in the forward direction fusion results the fusion moment, in the forward direction fusion results First measurement time, each corresponding first measurement time of the front side flight path measurement sensor, to the forward direction fusion results In fusion flight path, first in the forward direction fusion results measure flight path and the multiple front side flight path measurement sensor First, which measures flight path, carries out secondary fusion.
In the present embodiment, forward direction flight path measurement sensor and front side flight path measurement sensor can be collectively referred to as flight path and measure biography Sensor belongs to intelligence sensor, has detection of obstacles and data processing function.Specifically, flight path measurement sensor can acquire Barrier data in detection range, the barrier data detected are known as initial data.Flight path measurement sensor can be to original Data are handled, and the corresponding flight path of barrier in detection range is obtained, and referred to as first measures flight path.First measures flight path packet It includes:The motion state of barrier, position and distance etc., wherein motion state includes:One in movement velocity and the direction of motion Or it is multiple.
In the present embodiment, forward direction flight path measurement sensor can export the obtain first measurement flight path to preceding to fusion mould Block.The mode that forward direction flight path measurement sensor output first measures flight path can be active or passive type.It is active i.e. before to Flight path measurement sensor obtains actively exporting to preceding to Fusion Module after the first measurement flight path.Passive type is i.e. preceding to be measured to flight path After the data requesting instructions that sensor is sent before receiving to Fusion Module, responds the data requesting instructions and export first Measure flight path.Similarly, flight path measurement sensor in front side can export the obtain first measurement flight path to global Fusion Module, output First mode for measuring flight path can be active or passive type.
In the present embodiment, corresponding first measurement time of the first measurement flight path can be regarded as preceding defeated to flight path measurement sensor At the time of going out the first measurement flight path, at the time of obtaining the first measurement flight path to flight path measurement sensor before also being understood as.Forward direction Also record sends the forward direction flight path measurement sensing of first measurement time to Fusion Module while getting the first measurement time The mark of device, namely it is to be sent by which forward direction flight path measurement sensor, and will record result to record first measurement time It is sent to global Fusion Module.
In the present embodiment, forward direction fusion results refer to after Single cell fusion as a result, merging including fusion flight path and not Flight path.Forward direction fusion results can be understood as preceding exporting to global Fusion Module after completing Single cell fusion to Fusion Module Data.
Existing data fusion mode is usually the data fusion of centralization, and initial data is sent to vehicle by each sensor Fusion center (namely processor with data fusion function), realize that data fusion, initial data are lost by fusion center It loses less, but data information amount is big.And the secondary cascade fusion method of data disclosed in the present embodiment, first by sensor to initial data Inter-process is carried out, obtains the measurement flight path (i.e. first measures flight path) of barrier, and the measurement flight path of barrier is sent to Forward direction Fusion Module or global Fusion Module, then by forward direction Fusion Module and global measurement time pair of the Fusion Module based on acquisition The measurement flight path of barrier is merged twice, and the fusion process of global Fusion Module needs the preceding fusion knot to Fusion Module Fruit belongs to distributed data fusion method.Compared to the data fusion of centralization, although distributed data fusion lost part Initial data, but traffic load is low, redundancy is high, computing resource is few and adaptation flexibility ratio is high.
In some embodiments, as shown in figure 3, other than including step A1, A3 and A4 shown in Fig. 2, emphasis describes step The specific implementation mode of rapid A2, forward direction Fusion Module described in step A2 are surveyed to the first of the multiple forward direction flight path measurement sensor It measures flight path and carries out Single cell fusion, it may include following steps B1 and B2:
B1, the forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between deposit First in incidence relation measures flight path;
There will be the first measurement flight paths of incidence relation to be merged for B2, the forward direction Fusion Module, obtains at least one Merge flight path and each fusion flight path corresponding fusion moment.
In the present embodiment, forward direction Fusion Module if it is determined that the multiple forward direction flight path measurement sensor first measure flight path Between there are incidence relation, illustrate there are incidence relation first measurement flight path corresponds to the same barrier, therefore, forward direction merge There will be the first measurement flight paths of incidence relation to be merged for module, generates the new flight path of the barrier, that is, merges flight path.
In the present embodiment, the first measurement flight path of different incidence relations corresponds to different barriers, therefore, if existing different Incidence relation, then produce multiple fusion flight paths, each flight path that merges corresponds to a barrier.
It is that a new flight path belongs to by the corresponding different first measurement Track Fusions of the same barrier in the present embodiment This field mature technology, for example, the center of two first measurement flight path lines can be taken as fusion flight path, fusion process is related to Coordinate transform, it is, of course, also possible to there is other modes, details are not described herein.
Based on a upper example, as shown in figure 4, in addition to including step shown in Fig. 3, forward direction Fusion Module described in step A2 Measure flight path to the first of the multiple forward direction flight path measurement sensor and carry out Single cell fusion, can also include the steps of C1 and C2:
C1, the forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measure flight path between not First there are incidence relation measures flight path;
C2, the forward direction Fusion Module are from there is no the first of incidence relation to measure the default reservation item of selection satisfaction in flight path The first of part measures flight path.
In the present embodiment, forward direction Fusion Module is determined there is no after the measurement flight path of the first of incidence relation, is not necessarily to these First, which measures flight path, carries out Single cell fusion, because not having correspond to the same barrier first to measure in these the first measurement flight paths Flight path.
In the present embodiment, after the determination of forward direction Fusion Module measures flight path there is no the first of incidence relation, not by these First measurement flight path is exported to global Fusion Module, but selectivity output, reduces the computational load of global Fusion Module.
In the present embodiment, reserve can be preset by setting to select the to be retained first measurement flight path and export to complete Office's Fusion Module, default reserve can be used to the flight path for excluding to calculate.
Based on a upper example, as shown in figure 5, in addition to including step shown in Fig. 4, emphasis describes the specific of step C2 Embodiment, forward direction Fusion Module described in step C2 measure selection in flight path and meet default protect from there is no the first of incidence relation The first of condition is stayed to measure flight path, it may include following steps D1 to D3:
D1, the forward direction Fusion Module judge that there is no the first of incidence relation to measure the corresponding forward direction flight path measurement of flight path Whether sensor is preceding to imaging sensor;If so, thening follow the steps D2;If it is not, thening follow the steps D3.
D2, selection described first measure flight path.
D3, determine that the described first Threat for measuring flight path, selection meet the first measurement flight path for presetting Threat condition.
In the present embodiment, forward direction flight path measurement sensor is preceding to imaging sensor (such as forward direction camera) or forward direction Radar.If the corresponding forward direction flight path measurement sensor of the first measurement flight path there is no incidence relation is not preceding to image sensing Device must be then preceding to radar.
In the present embodiment, it is contemplated that the first measurement flight path of forward direction imaging sensor is that the probability of barrier is higher than radar. Therefore, if being preceding to imaging sensor there is no the first corresponding forward direction flight path measurement sensor of measurement flight path of incidence relation, Then these the first measurement flight paths are selected.If measuring the corresponding forward direction flight path of flight path there is no the first of incidence relation measures biography Sensor is not preceding to imaging sensor, then these first measure flight path chosen parts, specifically, pass through and determine that first measures The Threat of flight path, and select meet default Threat first to measure flight path.
In the present embodiment, there are many modes that determine the Threat of the first measurement flight path, for example, measuring flight path according to first The distance between this wheel paths determine that the nearlyr Threat of distance is higher, and other modes can continue to use the prior art, herein no longer It repeats.
In the present embodiment, default Threat condition can be default Threat thresholding, and first higher than Threat thresholding surveys Amount flight path is selected, and presetting Threat thresholding can determines according to actual conditions, and the present embodiment does not limit specific value;Can also be According to the descending sequence of Threat by first measure flight path sequence, selection rank in the top (such as first 15) first survey Flight path is measured, remaining elimination reduces the computational load of global Fusion Module.
In some embodiments, Fig. 6 shows the workflow of the global Fusion Module, include the following steps 101 to 105:
101, global Fusion Module obtains the first measurement of the forward direction fusion results, multiple front side flight path measurement sensors Flight path and corresponding first measurement time of each front side flight path measurement sensor.
102, to the fusion flight path in the forward direction fusion results, first in the forward direction fusion results measure flight path with And the first of the multiple front side flight path measurement sensor measures the unification that flight path carries out data format, obtains corresponding second and surveys Measure flight path.
When 103, based on the fusion moment in the forward direction fusion results, the first measurement in the forward direction fusion results Quarter, each corresponding first measurement time of the front side flight path measurement sensor carry out the time to each system flight path of storage It is synchronous, obtain the corresponding prediction flight path of each system flight path.
104, it is based on each prediction flight path, determines being associated between each second measurement flight path and each system flight path System.
105, the incidence relation, the system flight path updated storage are based on.
In the present embodiment, it is contemplated that the format of different flight path measurement sensor output datas is different, for the ease of follow-up Data fusion needs the unification for carrying out data format, and unified approach can continue to use the prior art, such as define unified coordinate system, will Each flight path is converted into the data in unified coordinate system, and details are not described herein for specific unified approach.
In the present embodiment, after Uniform data format, you can obtain each each flight path corresponding second and measure flight path, own Second measures the data format all same of flight path.
It should be noted that hereinafter, state for convenience, by the fusion flight path, described in the forward direction fusion results First in forward direction fusion results measures the first measurement flight path general designation of flight path and the multiple front side flight path measurement sensor Flight path is measured for first.
In the present embodiment, each system flight path of storage can be regarded as the barrier history flight path stored in mobile unit. If global Fusion Module has got new barrier flight path, i.e., first measures flight path, in order to whether determine the first measurement flight path For the flight path after the corresponding barrier movement of system flight path, need system flight path and the first measurement flight path being associated, if Association, illustrate first measure flight path it is corresponding with system flight path be the same barrier.
In the present embodiment, in order to realize that system flight path is associated with the first measurement flight path, first by first measure flight path into Row Data Format Transform obtains the second measurement flight path.It is then based on each first measurement time, to each system flight path of storage It carries out time synchronization and obtains the corresponding prediction flight path of each system flight path so that predict that flight path and the second measurement flight path are with for the moment The data at quarter, are comparable.Difference lies in predict that flight path is that the overall situation merges mould between prediction flight path and the second measurement flight path The data that block calculates are virtual datas, and the first measurement flight path is original according to what is detected by flight path measurement sensor The data that data processing obtains are real data.It is finally based on prediction flight path, is determined between the second measurement flight path and system flight path Incidence relation, being equivalent to realizes system flight path is associated with the first measurement flight path.In order to reduce computational load, each second It measures flight path and is only associated with a system flight path.
In the present embodiment, the mode of time synchronization can continue to use existing way, and this embodiment is not repeated.
In the present embodiment, determine each second measure the incidence relation between flight path and each system flight path after, you can Fusion is realized by Kalman filtering algorithm more new system flight path based on the incidence relation.Wherein, lead to It crosses Kalman filtering algorithm more new system flight path and belongs to mature technology, details are not described herein.
Existing data fusion mode is usually the data fusion of centralization, and initial data is sent to vehicle by each sensor Fusion center (namely processor with data fusion function), realize that data fusion, initial data are lost by fusion center It loses less, but data information amount is big.And the secondary cascade fusion method of data disclosed in the present embodiment, first by sensor to initial data Inter-process is carried out, obtains the measurement flight path (i.e. first measures flight path) of barrier, and the measurement flight path of barrier is sent to Mobile unit, then the measurement flight path of barrier is merged by mobile unit, belong to distributed data fusion method.It compares The data fusion of centralization, although distributed data fusion lost part initial data, traffic load is low, redundancy is high, Computing resource is few and adaptation flexibility ratio is high.
As it can be seen that the secondary cascade fusion method of data disclosed in the present embodiment, by distributed data fusion mode, by passing Sensor to initial data carry out inter-process, obtain barrier measurement flight path and corresponding measurement time (i.e. first measurement when Carve), then the measurement flight path of barrier and corresponding measurement time are obtained by mobile unit, when measurement of the mobile unit based on acquisition It carves and obtains the prediction flight path corresponding to the history flight path (i.e. the system flight path of mobile unit storage) of barrier, to mobile unit It can determine whether the prediction flight path of barrier corresponds to the same barrier with the measurement flight path of barrier.And then mobile unit can incite somebody to action The measurement flight path of barrier and the system flight path of storage are associated, and realize the track association of the same barrier different moments, It is finally based on incidence relation, the history flight path of regeneration barrier object realizes Fusion.
In some embodiments, as shown in fig. 7, in addition to including step 101 shown in fig. 6,102,103 and 105, Fig. 7 weights Point describes the specific implementation mode of step 104 namely emphasis in Fig. 6 and describes how to determine that second measures flight path and system boat Incidence relation between mark.Based on each prediction flight path described in step 104, determine that each second measurement flight path navigates with each system Incidence relation between mark, it may include following steps 1041 and 1042:
1041, it is measured in flight path from all second, searches and measure flight path with the second of prediction track matching.
1042, it will predict that the corresponding system flight path of flight path is associated with the second measurement flight path found.
In the present embodiment, the incidence relation table of the second measurement flight path and system flight path can be established, is measured from all second It in flight path, searches and measures flight path with the second of prediction track matching, if matching, illustrate the find second measurement flight path and prediction Flight path corresponds to the same barrier.It will predict that the corresponding system flight path of flight path is associated with the second measurement flight path found, So that system flight path and the second measurement flight path associated there correspond to the same barrier, barrier is embodied in different moments Flight path variation.
Based on upper one embodiment, as shown in figure 8, with Fig. 7 difference lies in:Emphasis describes step in the present embodiment 1041 specific implementation mode.It is searched described in step 1041 and measures flight path, including following step with the second of prediction track matching Rapid 1041 ' and 1041 ":
1041 ', it centered on predicting flight path, searches and whether there is at least one second in preset range around prediction flight path Measure flight path;If in the presence of thening follow the steps 1041 ";
1041 ", the second nearest measurement flight path of range prediction flight path and prediction track matching.
In the present embodiment, it is contemplated that there are errors for the prediction flight path of the same barrier and the second measurement flight path, not complete It is exactly the same, therefore, by the way that preset range is rationally arranged so that it is negligible that prediction flight path and second in preset range measure flight path Error, it is believed that correspond to the same barrier.
In the present embodiment, preset range can be configured according to actual conditions, and the present embodiment does not limit the tool of preset range Body value.
In the present embodiment, it is contemplated that there may be multiple second in preset range around prediction flight path to measure flight path, according to Nearest principle predicts around flight path that range prediction flight path is nearest in preset range second measures flight path and prediction track matching, Matching can be understood as corresponding to the same barrier.
In some embodiments, it as shown in figure 9, other than including step shown in fig. 6, is determined described in step 104 every After a second measures the incidence relation between flight path and each system flight path, further comprising the steps of 105:
106, storage second measures the incidence relation between flight path and system flight path.
Correspondingly, each first measurement time is based on described in step 103, it is same to carry out the time to each system flight path of storage Step, after obtaining the corresponding prediction flight path of each system flight path, can also include the steps of 107:
107, search whether that the incidence relation being stored between the second measurement flight path and system flight path is held if not storing Based on each prediction flight path described in row step 104, being associated between each second measurement flight path and each system flight path is determined System.
In the present embodiment, determination when data fusion is carried out if non-data fusion for the first time, before this data fusion Incidence relation can be stored in mobile unit.Therefore, determine that second measures flight path and system in this data fusion process Before incidence relation between flight path, it should first search whether to be stored with being associated between the second measurement flight path and system flight path System.When not finding namely when mobile unit does not store incidence relation, it is determined that each second measure flight path with it is each Incidence relation between system flight path.
Further include step 108 other than including step shown in Fig. 9 as shown in Figure 10 based on upper one embodiment, tool Body, the incidence relation being stored between the second measurement flight path and system flight path is searched whether described in step 107, if being stored with Two measure the incidence relation between flight path and system flight path, then execute following steps 108:
108, judge whether the second measurement flight path and system flight path meet preset matching condition in incidence relation;If full Foot, then maintain the incidence relation;If not satisfied, determining each second based on each prediction flight path described in thening follow the steps 104 Measure the incidence relation between flight path and each system flight path.
In the present embodiment, determination when data fusion is carried out if non-data fusion for the first time, before this data fusion Incidence relation can be stored in mobile unit.Therefore, determine that second measures flight path and system in this data fusion process Before incidence relation between flight path, it should first search whether to be stored with being associated between the second measurement flight path and system flight path System.When finding namely when mobile unit storage incidence relation, then judge that the second measurement flight path navigates with system in incidence relation Whether mark meets preset matching condition.Matching condition for example including:In incidence relation second measure flight path motion state with The motion state of system flight path whether match and incidence relation in second measure flight path motion state and system flight path position It sets and one or more of whether matches.
In some embodiments, as shown in figure 11, other than including step 101 shown in fig. 6,102,103 and 104, figure 11 emphasis describe the specific implementation mode of step 105 in Fig. 6, are based on the incidence relation described in step 105, update storage System flight path, it may include following steps 1051 to 1053:
1051, judge whether each system flight path of storage is system flight path in the incidence relation;If so, executing Step 1052;If it is not, thening follow the steps 1053.
1052, flight path more new system flight path is measured using system flight path in the incidence relation corresponding second.
1053, using the corresponding prediction flight path of system flight path more new system flight path.
In the present embodiment, if the system flight path of storage is the system flight path in incidence relation, illustrate the system flight path of storage Corresponding barrier in this data fusion process still in the detection range of the flight path measurement sensor of this vehicle, this number Therefore make according to the corresponding second measurement flight path of the system flight path in new flight path, that is, incidence relation of the barrier in fusion process Flight path more new system flight path is measured with system flight path in incidence relation corresponding second, realizes the flight path update of the barrier.
In the present embodiment, if the system flight path of storage is not the system flight path in incidence relation, illustrate the system boat of storage The corresponding barrier of mark is not in this data fusion process in the detection range of flight path measurement sensor of this vehicle, because This realizes the flight path update of the barrier using the corresponding prediction flight path of system flight path more new system flight path.
In some embodiments, as shown in figure 12, other than including step shown in fig. 6, the system updated storage Further comprising the steps of 109 after flight path:
109, the update mode based on system flight path, the confidence level of the system flight path after management update.
In the present embodiment, it is contemplated that after using different update modes more new system flight path, new system flight path and obstacle There are deviations for the true flight path of object, and the big system flight path of deviation may be wrong flight path, and deviation is bigger, and system flight path more can not Letter.Therefore, whether credible in order to embody system flight path, introducing confidence level concept, the confidence level of the system flight path after management update, To determine whether updated system flight path is wrong flight path according to confidence level.
Based on upper one embodiment, as shown in figure 13, difference lies in emphasis describes the implementation of step 109 with Figure 12 Mode, the update mode based on system flight path described in step 109, the confidence level of the system flight path after management update, including it is following Step 1091 is to 1095:
If 1091, the update mode of system flight path is to be updated using the second measurement flight path in the incidence relation, Then increase the confidence level of system flight path.
If 1092, the update mode of system flight path is to be updated using prediction flight path, it is corresponding to obtain update mode Flight path measurement sensor.
1093, judge whether system flight path is in the sensing range of the corresponding flight path measurement sensor of update mode, if It is in, thens follow the steps 1094;If being not in, 1095 are thened follow the steps.
1094, the confidence level of system flight path is reduced.
1095, the confidence level of system flight path is maintained.
In the present embodiment, if the update mode of system flight path is to measure flight path using second in incidence relation to carry out more Newly, illustrating that newer system flight path is that the data based on flight path measurement sensor are updated, the possibility of mistake is relatively low, because This, can increase the confidence level of the system flight path.
In the present embodiment, if the update mode of system flight path is to be updated using prediction flight path, illustrate newer system Flight path is the flight path calculated, and the possibility of mistake is higher, and the confidence level of the system flight path can be reduced or be remained unchanged.
In the present embodiment, for update mode be using prediction flight path be updated system flight path, the system flight path can Reliability is that reduction can be by judging whether system flight path is in the corresponding flight path measurement sensor of update mode or remain unchanged Sensing range in determine, if being in, illustrate that flight path measurement sensor should can detect the flight path, but really flight path is surveyed The flight path is not detected in quantity sensor, and therefore, the confidence level of the system flight path should reduce;If being not in, illustrate that the system is navigated There is not apparent error in mark, does not belong to normal condition by sensor perception, can temporarily keep confidence level constant.
The corresponding flight path measurement sensor of update mode is obtained in the present embodiment, described in step 1092, specially:It determines Prediction flight path is obtained based on which the first measurement time, since mobile unit record has the first measurement time is navigated by which What mark measurement sensor was sent, therefore, after determining the first measurement time, so that it may to determine that the corresponding flight path of update mode measures Sensor is the flight path measurement sensor for sending first measurement time.
In some embodiments, as shown in figure 14, it in addition to including method and step shown in Figure 12, is managed described in step 109 After the confidence level for managing updated system flight path, further comprising the steps of 110 and 111:
110, judge whether the confidence level of the system flight path after management reaches default output thresholding, default output must be reached The system flight path of thresholding.
111, reach the system flight path of default output thresholding described in output.
In the present embodiment, the purpose of confidence level management is to determine which system flight path is believable, convenient for follow-up different Function system (such as one or more of AEB systems, ACC system, LKA systems, FCW systems and automatic lane-change system etc. are System) it uses.
In the present embodiment, the setting for presetting output thresholding is convenient for determining which system flight path is believable, when system flight path Confidence level reach default output thresholding, illustrate that the system flight path is credible, which can be added in output listing, and After the confidence level of all system flight paths is performed both by step 110, final output listing is obtained.
In the present embodiment, presetting output thresholding can determines according to actual conditions, and the present embodiment does not limit default output thresholding Specific value.
In some embodiments, as shown in figure 15, it other than including the step shown in Figure 13, is reduced described in step 1094 After the confidence level of system flight path, step 109 further comprising the steps of 1096 and 1097:
1096, judge the confidence level of system flight path whether less than default elimination thresholding;If being less than, 1097 are thened follow the steps; If being not less than, the step 110 and 111 shown in Figure 14 can perform.
1097, the system flight path is eliminated.
In the present embodiment, after the confidence level that system flight path is maintained described in step 1095, the step shown in Figure 14 can perform 110 and 111.
In the present embodiment, it is contemplated that after the confidence level of system flight path reduces to a certain extent, the system flight path, that is, insincere, It is wrong flight path.Mistake flight path may not be the flight path of barrier, for instance it can be possible that the object of the fixed positions such as the trees on road side Flight path of the body relative to this vehicle, should be eliminated.
In the present embodiment, default elimination thresholding is set, with a low credibility when system flight path eliminates thresholding, the system in default Flight path, that is, insincere.Default thresholding of eliminating can determines according to actual conditions, and the present embodiment does not limit the specific of default elimination thresholding Value.
In the present embodiment, the system flight path with a low credibility in default elimination thresholding is eliminated, barrier judgment error can be reduced Probability, meanwhile, the computational load of follow-up data fusion can be reduced, the real-time of data fusion is improved.
In some embodiments, as shown in figure 16, it other than including the step shown in Figure 12, is managed described in step 109 After the confidence level of updated system flight path, it can also include the steps of 112:
112, it measures not associated relationship in the corresponding second measurement flight path of each first measurement flight path uses second Flight path carries out initialization process.
In the present embodiment, the second measurement flight path that not associated relationship uses is likely to be one that appears in the new obstacle on this vehicle periphery The flight path of object, passes through initialization process so that onboard system can record the flight path of new barrier, be convenient for subsequent data fusion.
In some embodiments, as shown in figure 17, initialization process described in step 112 is described, it may include following steps 1121,1122,1122 ', 1125 and 1126:
1121, this car state information is obtained.
1122, it is based on this car state information, estimates this wheel paths.
1122 ', judge the second measurement flight path not used by the incidence relation whether far from this wheel paths;If so, Execute step 1125;If it is not, thening follow the steps 1126.
1125, the second measurement flight path not used by the incidence relation is eliminated.
1126, will system flight path not turned to by the second measurement initial track that the incidence relation uses.
In the present embodiment, step 1122 ' specific implementation mode, such as including such as under type one and mode two:
Mode one:Judge the extended line and this vehicle of the direction of motion for the second measurement flight path not used by the incidence relation Whether the extended line of the direction of motion of track intersects, if non-intersecting, judges far from this wheel paths.
Mode two:As shown in figure 18, step 1122 ' include the following steps 1123 and 1124.
1123, determine that not associated relationship uses second measures the lateral distance between flight path and this wheel paths;It is described Lateral distance is the projector distance of opposite this vehicle direction of motion.
1124, judge whether lateral distance is more than pre-determined distance threshold value;If more than thening follow the steps 1125;If being not more than, Then follow the steps 1126.
In mode two, if lateral distance is more than pre-determined distance threshold value, judge far from this wheel paths.Pre-determined distance threshold value can Determines according to actual conditions, the present embodiment does not limit the specific value of pre-determined distance threshold value.
Based on a upper example, as shown in figure 19, initialization process described in step 112 is in addition to including the step shown in Figure 17 1121 to 1126, step 112 may also include the steps of 1127:
1127, it assigns and is initialized as the second of the system flight path confidence level for measuring flight path.
In the present embodiment, the identical default confidence level of the second measurement flight path for being initialized as system flight path can be assigned.For The corresponding second measurement flight path of different flight path measurement sensors can assign different confidence levels, for example, for imaging sensor Corresponding second measurement flight path can assign higher confidence level, and the measurement flight path of radar corresponding second can be assigned lower Confidence level.By measuring flight path imparting confidence level to being initialized as the second of system flight path, convenient for data fusion process next time The confidence level of the middle updated system flight path of management.
In some embodiments, as shown in figure 20, initialization process described in step 112 is in addition to including the step shown in Figure 17 1121 to 1126, step 112 may also include the steps of 1128 to 1132:
1128, the judgement information of multiple barrier judgment sensors is obtained;
1129, according to the judgement information, it is determined whether there are barriers;If there are barrier, 1130 are thened follow the steps; If barrier is not present, 1131 are thened follow the steps;
1130, whether disturbance in judgement object is located at the homonymy of this vehicle with the second measurement flight path for being initialized as system flight path;If It is to then follow the steps 1132;If it is not, thening follow the steps 1131;
1131, it is the second confidence level to assign and be initialized as the confidence level that the second of system flight path measures flight path;
1132:It is the first confidence level to assign and be initialized as the confidence level that the second of system flight path measures flight path;
Wherein, first confidence level is more than second confidence level.
In the present embodiment, barrier judgment sensor belongs to intelligence sensor, has detection of obstacles and data processing work( Energy.Specifically, the barrier data that barrier judgment sensor can be within the scope of acquisition testing, the barrier data detected are known as Initial data.Barrier judgment sensor can be handled initial data, judged whether there are obstacles in detection range, obtained To judging information.Judge that information is used to indicate whether that there are barriers.
In the present embodiment, if barrier judgment sensor judges there are barrier, further disturbance in judgement object with it is initial It turns to the second of system flight path and measures the homonymy whether flight path is located at this vehicle.If so, explanation is initialized as the second of system flight path Measure flight path be barrier flight path possibility it is higher, therefore, assign this second measure flight path confidence level be it is higher can Reliability, i.e. the first confidence level;If it is not, the second measurement flight path that explanation is initialized as system flight path is the possibility of the flight path of barrier Property it is relatively low, therefore, assign this second measure flight path confidence level be lower confidence level, i.e. the second confidence level.
In the present embodiment, if barrier judgment sensor judges that barrier is not present, illustrate to be initialized as system flight path Second measurement flight path is that the possibility of the flight path of barrier is relatively low, and therefore, it is relatively low to assign second confidence level for measuring flight path Confidence level, i.e. the second confidence level.
Difference lies in the present embodiment, judge whether to deposit according to barrier judgment sensor with embodiment illustrated in fig. 19 In barrier, assigns and be initialized as the second of the system flight path different confidence levels for measuring flight path, convenient for data fusion next time The confidence level of system flight path after management update in the process quickly determines the system flight path for needing to eliminate.
In some embodiments, as shown in figure 21, compared with prior art, the sensing in the present embodiment to being installed on vehicle The quantity of device and position are adjusted, and are described in detail below:
One remote radar of forward direction (Front Long Range Radar) is mounted on the front of vehicle, and detection vehicle is just The barrier of first sector region in front;
One forward direction camera is mounted on the front of vehicle, the image of the second sector region immediately ahead of collection vehicle and regards Frequently;
One front left side radar (Left Front Side Radar) and a forward right side radar (Right Front Side Radar) it is separately mounted to the front left side and forward right side of vehicle, the barrier of vehicle left front and right front is detected respectively;
One left rear side radar (Left Rear Side Radar) and a right lateral side radar (Right Rear Side Radar it) is separately mounted to the left rear side and right lateral side of vehicle, detects the barrier of vehicle left back and right back respectively.
Based on described in detail above, the remote radar of forward direction, forward direction camera, front left side radar and forward right side radar are Flight path measurement sensor, output is flight trajectory measure data (i.e. previously mentioned first measures flight path).For example, front left side thunder Up to the barrier of detection vehicle left front, the barrier data detected are handled, the corresponding flight path of barrier is obtained and surveys Data are measured, and export flight trajectory measure data.In the present embodiment, radar is millimetre-wave radar.
Based on described in detail above, left rear side radar and right lateral side radar are barrier judgment sensor, output it is equal It is to judge information, which is used to indicate whether that there are barriers.For example, the barrier of left rear side detections of radar vehicle left back Hinder object, the barrier data detected are handled, judge vehicle left back whether there are obstacles, and then obtains judging letter Breath, and export judgement information.
In the present embodiment, as can be seen from Figure 21, the sensing range of adjacent sensors has certain overlapping, on the one hand may be used To ensure that overlapping region perceives the raising of confidence level, when on the other hand ensureing that barrier is walked from the sensing range of different sensors Data coherency.As can be seen from Figure 21, there is high reliability, the remote thunder of forward direction for the mostly important vehicle front of guarantee Reach, forward direction camera, front left side radar and forward right side radar have more overlapping sensing region, advantageously reduce flase drop and leakage Inspection, while front left side radar and forward right side radar have perception vehicle left front and the large range of ability in right front.In addition, left Rear side radar and right lateral side radar have small range blind area, but the barrier for there is certain relative velocity, are kept by flight path And fusion, still sustainable tracking.
Based on the sensor being installed on vehicle shown in Figure 21, Fusion flow following steps are described (1) to (7):
(1) it is exported to remote radar, forward direction camera, front left side radar and forward right side radar before mobile unit obtains Flight trajectory measure data and the corresponding measurement time of flight trajectory measure data (namely first measurement time being mentioned above), and obtain The judgement information for taking left rear side radar and right lateral side radar to export.
(2) mobile unit carries out the flight trajectory measure data of acquisition the unification of data format.Since different sensors export Flight trajectory measure data format it is different, merged for the ease of follow-up data, need the unification for carrying out data format, unified approach The prior art can be continued to use, details are not described herein.
(3) mobile unit is based on the corresponding measurement time of flight trajectory measure data, and it is same to carry out the time to the system flight path of storage Step, obtains the corresponding prediction flight path of each system flight path.System flight path can be regarded as the history flight path of barrier.
(4) mobile unit will predict that flight path is matched with flight trajectory measure data, if matching, illustrate to predict flight path and flight path Measurement data is flight path of the same barrier in synchronization, and the corresponding system flight path of the prediction flight path is measured with the flight path Data are flight path of the same barrier in different moments.Therefore, if matching, by the system flight path and the flight trajectory measure data It is associated.
(5) mobile unit updates associated system flight path using flight trajectory measure data, is updated using prediction flight path not associated System flight path.Since vehicle is moving, barrier relative vehicle is also moving, in order to embody the boat of different moments barrier Mark, therefore, it is necessary to more new system flight paths.
(6) mobile unit is after updating all system flight paths, the confidence level of the system flight path after management update, with true Whether fixed updated system flight path is directed to same barrier with the system flight path before update.
(7) after the confidence level of system flight path of the mobile unit after management update, the higher system boat of output confidence level Mark and maintenance system flight path list, and the left rear side radar based on acquisition and the judgement information of right lateral side radar output assign Confidence level.
In the present embodiment, each step detail can refer to embodiment shown in Fig. 6 to Figure 20, and details are not described herein.
In some embodiments, as shown in figure 22, the secondary cascade emerging system of data, the system are that soft or hard combination is System, hereinafter referred to as emerging system, including consisting of part:Sense (Perception), state estimation (State Estimate (Fusion), situation assessment (Situation Assess) and major function (Feature), are merged Function).Wherein, in addition to sensing (Perception), the executive agent of other components can be mobile unit.Each group At being partly described as follows:
Sensing (Perception) includes:Map (MAP) module, forward direction camera (Front Camera), forward direction long distance From radar (Front Long Range Radar), Vehicular system (Vehicle System), front left side radar (Left Front Side Radar), forward right side radar (Right Front Side Radar), left rear side radar (Left Rear Side ) and right lateral side radar (Right Rear Side Radar) Radar.Wherein, map (MAP) module can provide vehicle current institute Positioning function, such as GPS functions can also be provided in the Environmental Map Information at place.Vehicular system (Vehicle System) can provide Car status information, including the whole vehicle informations such as car speed and Vehicular turn angle.
State estimation (State Estimate) includes:This vehicle positions (Ego Vehicle Locate) and vehicle-state is estimated It counts (Vehicle State Estimate).Wherein, the positioning of this vehicle can be regarded as (MAP) module, forward direction camera shooting according to the map The data of head, the remote radar of forward direction and Vehicular system determine the position of this vehicle.Vehicle state estimation can be regarded as according to vehicle The car status information that system provides estimates the state of this vehicle.
Merging (Fusion) includes:Forward direction merges (Front Fusion) and global fusion (Global Fusion).Its In, forward direction fusion can be regarded as according to it is preceding carried out to the data of camera, the remote radar of forward direction and vehicle state estimation before to Data fusion.Overall situation fusion can be regarded as according to it is preceding to the result of fusion, front left side radar, forward right side radar, left rear side radar, The data of right lateral side radar and vehicle state estimation carry out global data fusion.
Situation assessment (Situation Assess) includes:Forward direction target selection (Front Object Selection) With backward or lateral target selection (Rear or Side Object Selection).Wherein, target can be regarded as barrier. Forward direction target selection can be regarded as corresponding with the data selection highest system flight path of confidence level of overall situation fusion to fusion according to preceding Barrier as preceding to target, while forward direction target selection can be positioned according to this vehicle and the data of vehicle state estimation assist To target before selection, exclusion is clearly not the forward direction target of barrier.Backward or lateral target selection can be regarded as according to the overall situation The data of fusion select the corresponding backward barrier of the highest system flight path of confidence level or lateral barrier as backward or lateral Target, at the same backward or lateral target selection can be positioned according to this vehicle and the data of vehicle state estimation come assisted Selection it is backward or Lateral target, exclusion are clearly not the backward or lateral target of barrier.
Major function (Feature Function) includes:AEB (Autonomous Emergency Braking, automatically Emergency braking) system, ACC (Adaptive Cruise Control, adaptive learning algorithms) system, FCW (Forward Collision Warning, front collision warning) function systems such as system and automatic lane-change system.Each work(in major function It can the preceding execution that corresponding function is carried out to the data of target selection and backward or lateral target selection of system acquisition.
In the present embodiment, forward direction fusion can be used as separate modular, to remote radar, the number of forward direction camera before fusion According to, while it being sent to global fusion using fusion results as output, it is merged by the overall situation and carries out secondary data fusion, before no To the system of fusion, overall situation fusion can also realize data fusion.Emerging system can be arranged by the data of map (MAP) module Except some it is not possible that existing target, reduces calculating and mistake, while the car status information by receiving Vehicular system offer, The target that need not be calculated is excluded, further including the whole vehicle informations such as car speed and Vehicular turn angle to estimate this wheel paths Reduce computational load.
The secondary cascade emerging system of data provided in this embodiment, is convenient for module segmentation, improves adaptation ability, can To be adapted to DAS (Driver Assistant System) and the Unmanned Systems of different requirements.
In addition, the secondary cascade emerging system of data provided in this embodiment, can be adapted to the only biography with Detection of Existence The emerging system of sensor can also be adapted to the emerging system of the sensor with detection of obstacles.
As shown in figure 23, the present embodiment discloses a kind of secondary cascade emerging system of data, it may include with lower module:Forward direction melts Mold block and global Fusion Module.It is described as follows:
Forward direction Fusion Module measures flight path and each described for obtaining the first of multiple forward direction flight path measurement sensors First measures corresponding first measurement time of flight path;
The forward direction Fusion Module is additionally operable to measure the first of the multiple forward direction flight path measurement sensor flight path progress Single cell fusion, to fusion results before obtaining, the forward direction fusion results include:At least one fusion flight path each merges flight path Corresponding fusion moment, satisfaction preset the first measurement flight path of reserve and each meet the first of default reserve and survey Measure corresponding first measurement time of flight path;
Global Fusion Module, first for obtaining the forward direction fusion results, multiple front side flight path measurement sensors surveys Measure flight path and corresponding first measurement time of each front side flight path measurement sensor;
The overall situation Fusion Module is additionally operable to based on the fusion moment in the forward direction fusion results, forward direction fusion As a result the first measurement time in, corresponding first measurement time of each front side flight path measurement sensor, to the forward direction First in fusion flight path, the forward direction fusion results in fusion results measures flight path and the multiple front side flight path measures The first of sensor measures flight path and carries out secondary fusion.
The secondary cascade emerging system of data disclosed in the present embodiment corresponds to the secondary cascade fusion method of data shown in Fig. 2, It illustrates and can be found in embodiment of the method shown in Fig. 2 with effect, to avoid repeating, details are not described herein.
In addition, the secondary cascade emerging system of data disclosed in the present embodiment is by the blending algorithm of integral type, based on function into Row modularization is segmented, to fusion and global fusion before splitting into.Difference, which may be implemented, in the secondary cascade emerging system of the data has The vehicle of the adaptation of different function automobile type configuration, such as configuration such as ACC, AEB function need to only retain preceding to fusion and the choosing of forward direction target It selects, and for having the vehicle of automatic lane-change function, then to fusion and global fusion before needing;Meanwhile the algorithm frame can be with For different safe designs, algorithm is split and is arranged into the different calculating cores of different chips or chip, reduction monokaryon/ Chip computational load, and improve the redundancy of module.
Based on a upper example, in the present embodiment, the forward direction Fusion Module measures the multiple forward direction flight path and senses The first of device measures flight path and carries out Single cell fusion, including:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between exist The first of incidence relation measures flight path;
There will be the first measurement flight paths of incidence relation to be merged for the forward direction Fusion Module, obtains at least one fusion Flight path and each fusion flight path corresponding fusion moment.
The secondary cascade emerging system of data disclosed in the present embodiment corresponds to the secondary cascade fusion method of data shown in Fig. 3, It illustrates and can be found in embodiment of the method shown in Fig. 3 with effect, to avoid repeating, details are not described herein.
In some embodiments, the forward direction Fusion Module is measured the first of the multiple forward direction flight path measurement sensor Flight path carries out Single cell fusion, further includes:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between do not deposit First in incidence relation measures flight path;
The forward direction Fusion Module is from there is no the first of incidence relation to measure the default reserve of selection satisfaction in flight path First measure flight path.
The secondary cascade emerging system of data disclosed in the present embodiment corresponds to the secondary cascade fusion method of data shown in Fig. 4, It illustrates and can be found in embodiment of the method shown in Fig. 4 with effect, to avoid repeating, details are not described herein.
In some embodiments, the forward direction Fusion Module selects full from there is no the measurement flight path of the first of incidence relation The first of the default reserve of foot measures flight path, including:
The forward direction Fusion Module judges that there is no the first of incidence relation to measure the corresponding forward direction flight path measurement biography of flight path Whether sensor is preceding to imaging sensor;If so, selection described first measures flight path;If not, it is determined that described first measures The Threat of flight path, selection meet the first measurement flight path for presetting Threat condition.
The secondary cascade emerging system of data disclosed in the present embodiment corresponds to the secondary cascade fusion method of data shown in fig. 5, It illustrates and can be found in embodiment of the method shown in fig. 5 with effect, to avoid repeating, details are not described herein.
In some embodiments, Figure 24 shows a kind of global Fusion Module, it may include with lower unit:Acquiring unit 1, system One unit 2, synchronization unit 3, determination unit 4 and updating unit 5.Each unit is described as follows:
Acquiring unit 1, first for obtaining the forward direction fusion results, multiple front side flight path measurement sensors measures boat Mark and corresponding first measurement time of each front side flight path measurement sensor;
Unified Element 2, for first merged in flight path, the forward direction fusion results in the forward direction fusion results It measures the first of flight path and the multiple front side flight path measurement sensor and measures the unification that flight path carries out data format, obtain pair Second answered measures flight path;
Synchronization unit 3, for based on the fusion moment in the forward direction fusion results, the in the forward direction fusion results One measurement time, each corresponding first measurement time of the front side flight path measurement sensor, to each system flight path of storage Time synchronization is carried out, the corresponding prediction flight path of each system flight path is obtained;
Determination unit 4, for based on each prediction flight path, determine each described second measure flight path with it is each described Incidence relation between system flight path;
Updating unit 5, for being based on the incidence relation, the system flight path updated storage.
Global Fusion Module disclosed in the present embodiment corresponds to the workflow of global Fusion Module shown in fig. 6, specifically Bright and effect can be found in embodiment of the method shown in fig. 6, and to avoid repeating, details are not described herein.
In some embodiments, as shown in figure 25, other than including unit shown in Figure 24, emphasis describes determination unit 4 specific implementation mode, determination unit 4 may include searching subelement 41 and be associated with subelement 42.It is described as follows:
Subelement 41 is searched, for being measured in flight paths from all described second, searches the with the prediction track matching Two measure flight path;
Be associated with subelement 42, for by the corresponding system flight path of the prediction flight path and find second measure flight path into Row association.
Global Fusion Module disclosed in the present embodiment corresponds to the workflow of global Fusion Module shown in Fig. 7, specifically Bright and effect can be found in embodiment of the method shown in Fig. 7, and to avoid repeating, details are not described herein.
Based on a upper example, emphasis describes to search the specific implementation mode of subelement 41 in the present embodiment, and it is single to search son Member 41 is specifically used for executing following steps A and B:
A, centered on the prediction flight path, it is interior with the presence or absence of at least one to search preset range around the prediction flight path Second measures flight path;If in the presence of B is thened follow the steps;
B, the second measurement flight path nearest apart from the prediction flight path and the prediction track matching.
Global Fusion Module disclosed in the present embodiment corresponds to the workflow of global Fusion Module shown in Fig. 8, specifically Bright and effect can be found in embodiment of the method shown in Fig. 8, and to avoid repeating, details are not described herein.
In some embodiments, as shown in figure 26, in addition to including unit shown in Figure 24, it may also include 6 He of storage unit Searching unit 7.It is described as follows:
Storage unit 6 determines that each described second measures flight path and each system flight path for the determination unit 4 Between incidence relation after, storage second measures the incidence relation between flight path and system flight path;
Searching unit 7 is looked into after obtaining the corresponding prediction flight path of each system flight path for the synchronization unit 3 The incidence relation whether being stored between the second measurement flight path and system flight path looked for;
Correspondingly, the determination unit 4, after not stored for the determination of the searching unit 7, based on each prediction Flight path determines that each described second measures the incidence relation between flight path and each system flight path.
Global Fusion Module disclosed in the present embodiment corresponds to the workflow of global Fusion Module shown in Fig. 9, specifically Bright and effect can be found in embodiment of the method shown in Fig. 9, and to avoid repeating, details are not described herein.
Based on a upper example, as shown in figure 27, other than including unit shown in Figure 26, it may also include the first judgement list Member 8 and maintenance unit 9.It is described as follows:
First judging unit 8 is stored with for the determination of the searching unit 7 between the second measurement flight path and system flight path After incidence relation, judge whether the second measurement flight path meets preset matching condition with system flight path in incidence relation;
Maintenance unit 9 maintains the pass after meeting preset matching condition for first judging unit 8 judgement Connection relationship;
The determination unit 4 is based on after being unsatisfactory for preset matching condition for first judging unit 8 judgement Each prediction flight path determines that each described second measures the incidence relation between flight path and each system flight path.
Global Fusion Module disclosed in the present embodiment corresponds to the workflow of global Fusion Module shown in Fig. 10, specifically Bright and effect can be found in embodiment of the method shown in Fig. 10, and to avoid repeating, details are not described herein.
In some embodiments, as shown in figure 28, other than including unit shown in Figure 24, emphasis describes updating unit 5 specific implementation mode, updating unit 5 include:Judgment sub-unit 51, first updates subelement 52 and second and updates subelement 53.It is described as follows:
Judgment sub-unit 51, for judge storage each system flight path whether be in the incidence relation system boat Mark;
First update subelement 52, for 51 decision-making system flight path of the judgment sub-unit being in the incidence relation is It unites after flight path, measures flight path using system flight path described in the incidence relation corresponding second and update the system flight path;
Second update subelement 53, is not in the incidence relation for 52 decision-making system flight path of the judgment sub-unit After system flight path, the system flight path is updated using the corresponding prediction flight path of the system flight path.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 11 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 11, and to avoid repeating, details are not described herein.
In some embodiments, as shown in figure 29, other than including unit shown in Figure 24, it may also include administrative unit 10:
Administrative unit 10, after the system flight path updated storage for the updating unit 5, the update based on system flight path Mode, the confidence level of the system flight path after management update.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 12 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 12, and to avoid repeating, details are not described herein.
Based on a upper example, emphasis describes the specific implementation mode of administrative unit 10 in the present embodiment, administrative unit 10, Specifically for executing following steps C, D and E:
If C, the update mode of system flight path is to be updated using the second measurement flight path in the incidence relation, increase Add the confidence level of the system flight path.
If D, the update mode of system flight path is to be updated using prediction flight path, it is corresponding to obtain the update mode Flight path measurement sensor.
E, after step D obtains the corresponding flight path measurement sensor of the update mode, judge that the system flight path is In the no sensing range in the corresponding flight path measurement sensor of the update mode, if being in, the system flight path is reduced Confidence level;If being not in, the confidence level of the system flight path is maintained.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 13 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 13, and to avoid repeating, details are not described herein.
Based on a upper example, administrative unit 10 is additionally operable to execute following steps F and G:
F:After the confidence level that step E reduces the system flight path, judge whether the confidence level of the system flight path is low Thresholding is eliminated in default;If eliminating thresholding less than default, G is thened follow the steps;
G:Eliminate the system flight path.
Global Fusion Module disclosed in the present embodiment corresponds to the workflow of global Fusion Module shown in figure 15, specifically Bright and effect can be found in embodiment of the method shown in figure 15, and to avoid repeating, details are not described herein.
In some embodiments, as shown in figure 30, in addition to including unit shown in Figure 29, it may also include second judgment unit 11 and output unit 12.It is described as follows:
Second judgment unit 11 is used for after the confidence level of the system flight path after 10 management update of the administrative unit, sentences Whether the confidence level of the system flight path after disconnected management reaches default output thresholding, must reach the system boat of default output thresholding Mark;
Output unit 12, for exporting the system flight path for reaching default output thresholding.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 14 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 14, and to avoid repeating, details are not described herein.
In some embodiments, as shown in figure 31, other than including unit shown in Figure 29, it may also include initialization unit 13:
Initialization unit 13 is used for after the confidence level of the system flight path after 10 management update of the administrative unit, to every A first measurement flight path corresponding second, which measures in flight path, not to be carried out by the second measurement flight path that the incidence relation uses Initialization process.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 16 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 16, and to avoid repeating, details are not described herein.
Based on a upper example, initialization unit 13 carries out initialization process, specifically include following steps 1121 to 1126:
1121, this car state information is obtained.
1122, it is based on this car state information, estimates this wheel paths.
1123, determine that not associated relationship uses second measures the lateral distance between flight path and this wheel paths;It is described Lateral distance is the projector distance of opposite this vehicle direction of motion.
1124, judge whether lateral distance is more than pre-determined distance threshold value;If more than thening follow the steps 1125;If being not more than, Then follow the steps 1126.
1125, the second measurement flight path not used by the incidence relation is eliminated.
1126, will system flight path not turned to by the second measurement initial track that the incidence relation uses.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 17 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 17, and to avoid repeating, details are not described herein.
Based on a upper example, initialization unit 13 carries out initialization process, in addition to including step 1121 to 1126, also It may include following steps 1127:
1127, it assigns and is initialized as the second of the system flight path confidence level for measuring flight path.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 19 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 19, and to avoid repeating, details are not described herein.
In some embodiments, initialization unit 13 carries out initialization process, in addition to including step 1121 to 1126, also It may include following steps 1128 to 1132:
1128, the judgement information of multiple barrier judgment sensors is obtained;
1129, according to the judgement information, it is determined whether there are barriers;If there are barrier, 1130 are thened follow the steps; If barrier is not present, 1131 are thened follow the steps;
1130, whether disturbance in judgement object is located at the homonymy of this vehicle with the second measurement flight path for being initialized as system flight path;If It is to then follow the steps 1132;If it is not, thening follow the steps 1131;
1131, it is the second confidence level to assign and be initialized as the confidence level that the second of system flight path measures flight path;
1132:It is the first confidence level to assign and be initialized as the confidence level that the second of system flight path measures flight path;
Wherein, first confidence level is more than second confidence level.
The workflow of global Fusion Module shown in global Fusion Module corresponding diagram 20 disclosed in the present embodiment, specifically Bright and effect can be found in embodiment of the method shown in Figure 20, and to avoid repeating, details are not described herein.
The embodiment of the present invention also proposes a kind of non-transient computer readable storage medium, and the non-transient computer is readable to deposit Storage media stores computer instruction, and the computer instruction makes the computer execution first aspect each method embodiment be provided Method and step, such as including:
Forward direction Fusion Module obtains the first of multiple forward direction flight path measurement sensors and measures flight path and each described first Measure corresponding first measurement time of flight path;
Forward direction Fusion Module measures flight path to the first of the multiple forward direction flight path measurement sensor and carries out Single cell fusion, obtains To preceding to fusion results, the forward direction fusion results include:When the corresponding fusion of at least one fusion flight path, each fusion flight path The first measurement flight path that quarter, the first measurement flight path for meeting default reserve and each satisfaction preset reserve is corresponding First measurement time;
Global Fusion Module obtains the first measurement flight path of the forward direction fusion results, multiple front side flight path measurement sensors And corresponding first measurement time of each front side flight path measurement sensor;
Global Fusion Module is based on first merged in moment, the forward direction fusion results in the forward direction fusion results Measurement time, each corresponding first measurement time of the front side flight path measurement sensor, in the forward direction fusion results First merged in flight path, the forward direction fusion results measures the first of flight path and the multiple front side flight path measurement sensor It measures flight path and carries out secondary fusion.
The embodiment of the present invention also proposes:
The secondary cascade fusion method of A1, a kind of data, the method includes:
Forward direction Fusion Module obtains the first of multiple forward direction flight path measurement sensors and measures flight path and each described first Measure corresponding first measurement time of flight path;
Forward direction Fusion Module measures flight path to the first of the multiple forward direction flight path measurement sensor and carries out Single cell fusion, obtains To preceding to fusion results, the forward direction fusion results include:When the corresponding fusion of at least one fusion flight path, each fusion flight path The first measurement flight path that quarter, the first measurement flight path for meeting default reserve and each satisfaction preset reserve is corresponding First measurement time;
Global Fusion Module obtains the first measurement flight path of the forward direction fusion results, multiple front side flight path measurement sensors And corresponding first measurement time of each front side flight path measurement sensor;
Global Fusion Module is based on first merged in moment, the forward direction fusion results in the forward direction fusion results Measurement time, each corresponding first measurement time of the front side flight path measurement sensor, in the forward direction fusion results First merged in flight path, the forward direction fusion results measures the first of flight path and the multiple front side flight path measurement sensor It measures flight path and carries out secondary fusion.
A2, the method according to A1, the forward direction Fusion Module to the multiple forward direction flight path measurement sensor One, which measures flight path, carries out Single cell fusion, including:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between exist The first of incidence relation measures flight path;
There will be the first measurement flight paths of incidence relation to be merged for the forward direction Fusion Module, obtains at least one fusion Flight path and each fusion flight path corresponding fusion moment.
A3, the method according to A1 or A2, the forward direction Fusion Module is to the multiple forward direction flight path measurement sensor First measure flight path carry out Single cell fusion, further include:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between do not deposit First in incidence relation measures flight path;
The forward direction Fusion Module is from there is no the first of incidence relation to measure the default reserve of selection satisfaction in flight path First measure flight path.
A4, the method according to A3, the forward direction Fusion Module is from there is no the first of incidence relation to measure in flight path Selection meets the first measurement flight path for presetting reserve, including:
The forward direction Fusion Module judges that there is no the first of incidence relation to measure the corresponding forward direction flight path measurement biography of flight path Whether sensor is preceding to imaging sensor;If so, selection described first measures flight path;If not, it is determined that described first measures The Threat of flight path, selection meet the first measurement flight path for presetting Threat condition.
A5, the method according to A1, it is described the overall situation Fusion Module based in the forward direction fusion results the fusion moment, When the first measurement time, each front side flight path measurement sensor corresponding first in the forward direction fusion results measure It carves, flight path and described is measured to the fusion flight path in the forward direction fusion results, first in the forward direction fusion results more The first of a front side flight path measurement sensor measures flight path and carries out secondary fusion, including:
To the fusion flight path in the forward direction fusion results, the first measurement flight path in the forward direction fusion results and institute It states the first of multiple front side flight path measurement sensors and measures the unification that flight path carries out data format, obtain corresponding second and measure boat Mark;
Based on fusion moment in the forward direction fusion results, the first measurement time in the forward direction fusion results, every Corresponding first measurement time of a front side flight path measurement sensor carries out time synchronization to each system flight path of storage, Obtain the corresponding prediction flight path of each system flight path;
Based on each prediction flight path, determine that each described second measures between flight path and each system flight path Incidence relation;
Based on the incidence relation, the system flight path that updates storage.
A6, the method according to A5, it is described based on each prediction flight path, determine that each described second measures flight path With the incidence relation between each system flight path, including:
It is measured in flight path from all described second, searches and measure flight path with the second of the prediction track matching;
The corresponding system flight path of the prediction flight path is associated with the second measurement flight path found.
A7, the method according to A6, the lookup measure flight path with the second of the prediction track matching, including:
Centered on the prediction flight path, searches and whether there is at least one the around the prediction flight path in preset range Two measure flight path;
If in the presence of the second measurement flight path nearest apart from the prediction flight path and the prediction track matching.
A8, the method according to A5, the determination each described second measure flight path and each system flight path it Between incidence relation after, the method further includes:
Storage second measures the incidence relation between flight path and system flight path;
Correspondingly, described based on each first measurement time, time synchronization is carried out to each system flight path of storage, After obtaining the corresponding prediction flight path of each system flight path, the method further includes:
Search whether the incidence relation being stored between the second measurement flight path and system flight path;
If not storing, execute it is described based on each prediction flight path, determine each described second measure flight path with it is every The step of incidence relation between a system flight path.
A9, the method according to A8, the method further include:
If being stored with the incidence relation between the second measurement flight path and system flight path, the second measurement in incidence relation is judged Whether flight path meets preset matching condition with system flight path;
If satisfied, then maintaining the incidence relation;
If not satisfied, then execute it is described based on each prediction flight path, determine each described second measure flight path with it is every The step of incidence relation between a system flight path.
A10, the method according to A5, described based on the incidence relation, the system flight path updated storage, including:
Judge whether each system flight path of storage is system flight path in the incidence relation;
It navigates if so, measuring flight path using system flight path described in the incidence relation corresponding second and updating the system Mark;
If it is not, then updating the system flight path using the corresponding prediction flight path of the system flight path.
A11, the method according to A5, after the system flight path updated storage, the method further includes:
Based on the update mode of system flight path, the confidence level of the system flight path after management update.
A12, the method according to A11, the update mode based on system flight path, the system flight path after management update Confidence level, including:
If the update mode of system flight path is to be updated using the second measurement flight path in the incidence relation, increase The confidence level of the system flight path.
A13, the method according to A12, the update mode based on system flight path, the system flight path after management update Confidence level, including:
If the update mode of system flight path is to be updated using prediction flight path, the corresponding boat of the update mode is obtained Mark measurement sensor;
Judge whether the system flight path is in the sensing range of the corresponding flight path measurement sensor of the update mode, If being in, the confidence level of the system flight path is reduced;If being not in, the confidence level of the system flight path is maintained.
A14, the method according to A11, after the confidence level of the system flight path after the management update, the method is also Including:
Judge whether the confidence level of the system flight path after management reaches default output thresholding, default output thresholding must be reached System flight path;
Reach the system flight path of default output thresholding described in output.
A15, the method according to A13, after the confidence level for reducing the system flight path, the method is also wrapped It includes:
Judge the confidence level of the system flight path whether less than default elimination thresholding;
If being less than, the system flight path is eliminated.
A16, the method according to A11, after the confidence level of the system flight path after the management update, the method is also Including:
Do not used by the incidence relation in flight path second is measured to each first measurement flight path corresponding second It measures flight path and carries out initialization process.
A17, the method according to A16, the initialization process, including:
Obtain this car state information;
Based on described car state information, this wheel paths is estimated;
Whether the second measurement flight path not used by the incidence relation described in judging is far from described wheel paths;
If so, the second measurement flight path not used by the incidence relation described in eliminating;
If it is not, then not turning to system flight path by the second measurement initial track that the incidence relation uses by described.
A18, the method according to A17, the initialization process further include:
It assigns and is initialized as the second of the system flight path confidence level for measuring flight path.
A19, the method according to A17, the initialization process further include:
Obtain the judgement information of multiple barrier judgment sensors;
According to the judgement information, it is determined whether there are barriers;
If there are barrier, judge that the barrier is initialized as whether the second of system flight path measure flight path with described Positioned at the homonymy of this vehicle;The confidence level of flight path is measured as the first confidence level if so, assigning and being initialized as the second of system flight path; The confidence level of flight path is measured as the second confidence level if it is not, then assigning and being initialized as the second of system flight path;
If barrier is not present, it is second credible to assign and be initialized as the confidence level that the second of system flight path measures flight path Degree;
Wherein, first confidence level is more than second confidence level.
A20, according to A1 to A19 any one of them methods, the multiple forward direction flight path measurement sensor includes:Forward direction figure As sensor and forward direction radar;The multiple front side flight path measurement sensor includes:Front left side radar and forward right side radar.
A21, the method according to A19, the multiple barrier judgment sensor include:Left rear side radar and right lateral side Radar.
The secondary cascade emerging system of A22, a kind of data, the system comprises:
Forward direction Fusion Module measures flight path and each described for obtaining the first of multiple forward direction flight path measurement sensors First measures corresponding first measurement time of flight path;
The forward direction Fusion Module is additionally operable to measure the first of the multiple forward direction flight path measurement sensor flight path progress Single cell fusion, to fusion results before obtaining, the forward direction fusion results include:At least one fusion flight path each merges flight path Corresponding fusion moment, satisfaction preset the first measurement flight path of reserve and each meet the first of default reserve and survey Measure corresponding first measurement time of flight path;
Global Fusion Module, first for obtaining the forward direction fusion results, multiple front side flight path measurement sensors surveys Measure flight path and corresponding first measurement time of each front side flight path measurement sensor;
The overall situation Fusion Module is additionally operable to based on the fusion moment in the forward direction fusion results, forward direction fusion As a result the first measurement time in, corresponding first measurement time of each front side flight path measurement sensor, to the forward direction First in fusion flight path, the forward direction fusion results in fusion results measures flight path and the multiple front side flight path measures The first of sensor measures flight path and carries out secondary fusion.
A23, the system according to A22, the forward direction Fusion Module is to the multiple forward direction flight path measurement sensor First, which measures flight path, carries out Single cell fusion, including:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between exist The first of incidence relation measures flight path;
There will be the first measurement flight paths of incidence relation to be merged for the forward direction Fusion Module, obtains at least one fusion Flight path and each fusion flight path corresponding fusion moment.
A24, the system according to A22 or A23, the forward direction Fusion Module measure the multiple forward direction flight path and sense The first of device measures flight path and carries out Single cell fusion, further includes:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measurement flight path between do not deposit First in incidence relation measures flight path;
The forward direction Fusion Module is from there is no the first of incidence relation to measure the default reserve of selection satisfaction in flight path First measure flight path.
A25, the system according to A24, the forward direction Fusion Module is from there is no the first of incidence relation to measure flight path Middle selection meets the first measurement flight path for presetting reserve, including:
The forward direction Fusion Module judges that there is no the first of incidence relation to measure the corresponding forward direction flight path measurement biography of flight path Whether sensor is preceding to imaging sensor;If so, selection described first measures flight path;If not, it is determined that described first measures The Threat of flight path, selection meet the first measurement flight path for presetting Threat condition.
A26, the system according to A22, the overall situation Fusion Module, including:
Acquiring unit, first for obtaining the forward direction fusion results, multiple front side flight path measurement sensors measures boat Mark and corresponding first measurement time of each front side flight path measurement sensor;
Unified Element, for first merged in flight path, the forward direction fusion results in the forward direction fusion results It measures the first of flight path and the multiple front side flight path measurement sensor and measures the unification that flight path carries out data format, obtain pair Second answered measures flight path;
Synchronization unit, for based on the fusion moment in the forward direction fusion results, the in the forward direction fusion results One measurement time, each corresponding first measurement time of the front side flight path measurement sensor, to each system flight path of storage Time synchronization is carried out, the corresponding prediction flight path of each system flight path is obtained;
Determination unit, for based on each prediction flight path, determine each described second measure flight path with it is each described Incidence relation between system flight path;
Updating unit, for being based on the incidence relation, the system flight path updated storage.
A27, the system according to A26, the determination unit, including:
Subelement is searched, for being measured in flight path from all described second, searches second with the prediction track matching Measure flight path;
It is associated with subelement, for carrying out the corresponding system flight path of the prediction flight path and the second measurement flight path found Association.
A28, the system according to A27, the lookup subelement, are used for:
Centered on the prediction flight path, searches and whether there is at least one the around the prediction flight path in preset range Two measure flight path;
If in the presence of the second measurement flight path nearest apart from the prediction flight path and the prediction track matching.
A29, the system according to A26, the system also includes:
Storage unit, for the determination unit determine each described second measure flight path and each system flight path it Between incidence relation after, storage second measures the incidence relation between flight path and system flight path;
Searching unit after obtaining the corresponding prediction flight path of each system flight path for the synchronization unit, is searched The incidence relation whether being stored between the second measurement flight path and system flight path;
Correspondingly, the determination unit, after not stored for searching unit determination, based on each prediction boat Mark determines that each described second measures the incidence relation between flight path and each system flight path.
A30, the system according to A29, the system also includes:
First judging unit determines the pass being stored between the second measurement flight path and system flight path for the searching unit After connection relationship, judge whether the second measurement flight path meets preset matching condition with system flight path in incidence relation;
Maintenance unit maintains the association after meeting preset matching condition for first judging unit judgement Relationship;
The determination unit, after being unsatisfactory for preset matching condition for first judging unit judgement, based on every A prediction flight path determines that each described second measures the incidence relation between flight path and each system flight path.
A31, the system according to A26, the updating unit, including:
Judgment sub-unit, for judging whether each system flight path of storage is system flight path in the incidence relation;
First update subelement is the system boat in the incidence relation for the judgment sub-unit decision-making system flight path After mark, measures flight path using system flight path described in the incidence relation corresponding second and update the system flight path;
Second update subelement, is not the system in the incidence relation for the judgment sub-unit decision-making system flight path After flight path, the system flight path is updated using the corresponding prediction flight path of the system flight path.
A32, the system according to A26, the system also includes:
Administrative unit, after the system flight path updated storage for the updating unit, the update side based on system flight path Formula, the confidence level of the system flight path after management update.
A33, the system according to A32, the administrative unit are used for:
If the update mode of system flight path is to be updated using the second measurement flight path in the incidence relation, increase The confidence level of the system flight path.
A34, the system according to A33, the administrative unit are used for:
If the update mode of system flight path is to be updated using prediction flight path, the corresponding boat of the update mode is obtained Mark measurement sensor;
Judge whether the system flight path is in the sensing range of the corresponding flight path measurement sensor of the update mode, If being in, the confidence level of the system flight path is reduced;If being not in, the confidence level of the system flight path is maintained.
A35, the system according to A32, the system also includes:
Second judgment unit is used for after the confidence level of the system flight path after the administrative unit management update, judges to manage Whether the confidence level of the system flight path after reason reaches default output thresholding, must reach the system flight path of default output thresholding;
Output unit, for exporting the system flight path for reaching default output thresholding.
A36, the system according to A34, the administrative unit are additionally operable to:
After the confidence level for reducing the system flight path, judge whether the confidence level of the system flight path is eliminated less than default Thresholding;
If eliminating thresholding less than default, the system flight path is eliminated.
A37, the system according to A32, the system also includes:
Initialization unit is used for after the confidence level of the system flight path after the administrative unit management update, to each institute It states in the corresponding second measurement flight path of the first measurement flight path and is not carried out initially by the second measurement flight path that the incidence relation uses Change is handled.
A38, the system according to A37, the initialization unit carry out initialization process, including:
Obtain this car state information;
Based on described car state information, this wheel paths is estimated;
Whether the second measurement flight path not used by the incidence relation described in judging is far from described wheel paths;
If so, the second measurement flight path not used by the incidence relation described in eliminating;
If it is not, then not turning to system flight path by the second measurement initial track that the incidence relation uses by described.
A39, the system according to A38, the initialization unit carry out initialization process, further include:
It assigns and is initialized as the second of the system flight path confidence level for measuring flight path.
A40, the system according to A38, the initialization unit carry out initialization process, further include:
Obtain the judgement information of multiple barrier judgment sensors;
According to the judgement information, it is determined whether there are barriers;
If there are barrier, judge that the barrier is initialized as whether the second of system flight path measure flight path with described Positioned at the homonymy of this vehicle;The confidence level of flight path is measured as the first confidence level if so, assigning and being initialized as the second of system flight path; The confidence level of flight path is measured as the second confidence level if it is not, then assigning and being initialized as the second of system flight path;
If barrier is not present, it is second credible to assign and be initialized as the confidence level that the second of system flight path measures flight path Degree;
Wherein, first confidence level is more than second confidence level.
A41, according to A26 to A40 any one of them systems, the multiple forward direction flight path measurement sensor includes:Forward direction Imaging sensor and forward direction radar;The multiple front side flight path measurement sensor includes:Front left side radar and forward right side radar.
A42, the system according to A40, the multiple barrier judgment sensor include:Left rear side radar and right lateral side Radar.
A43, a kind of mobile unit, including:
Processor, memory, network interface and user interface;
The processor, memory, network interface and user interface are coupled by bus system;
The processor is by the program for calling the memory to store or instruction, for executing such as any one of A1 to A21 The step of the method.
A44, a kind of non-transient computer readable storage medium, the non-transient computer readable storage medium storage calculate Machine instructs, and the computer instruction makes the computer execute such as the step of any one of A1 to A21 the method.
It should be noted that herein, the terms "include", "comprise" or its any other variant are intended to non-row His property includes, so that process, method, article or device including a series of elements include not only those elements, and And further include other elements that are not explicitly listed, or further include for this process, method, article or device institute it is intrinsic Element.In the absence of more restrictions, the element limited by sentence "including a ...", it is not excluded that including this There is also other identical elements in the process of element, method, article or device.
It will be appreciated by those of skill in the art that although some embodiments described herein include being wrapped in other embodiments Certain features for including rather than other feature, but the combination of the feature of different embodiments mean in the scope of the present invention it It is interior and form different embodiments.
Although the embodiments of the invention are described in conjunction with the attached drawings, but those skilled in the art can not depart from this hair Various modifications and variations are made in the case of bright spirit and scope, such modifications and variations are each fallen within by appended claims Within limited range.

Claims (10)

1. a kind of secondary cascade fusion method of data, which is characterized in that the method includes:
Forward direction Fusion Module obtains the first of multiple forward direction flight path measurement sensors and measures flight path and each first measurement Corresponding first measurement time of flight path;
Forward direction Fusion Module measures flight path to the first of the multiple forward direction flight path measurement sensor and carries out Single cell fusion, before obtaining To fusion results, the forward direction fusion results include:At least one fusion flight path, each fusion flight path corresponding fusion moment, Meet preset the first of reserve measure flight path and it is each meet preset the first of reserve and measure flight path corresponding the One measurement time;
Global Fusion Module obtain the forward direction fusion results, multiple front side flight path measurement sensors first measure flight path and Each corresponding first measurement time of the front side flight path measurement sensor;
Global Fusion Module is based on the fusion moment in the forward direction fusion results, the first measurement in the forward direction fusion results Moment, each corresponding first measurement time of the front side flight path measurement sensor, to the fusion in the forward direction fusion results First in flight path, the forward direction fusion results measures the first measurement of flight path and the multiple front side flight path measurement sensor Flight path carries out secondary fusion.
2. according to the method described in claim 1, it is characterized in that, the forward direction Fusion Module surveys the multiple forward direction flight path The first of quantity sensor measures flight path and carries out Single cell fusion, including:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measure flight path between exist association The first of relationship measures flight path;
There will be the first measurement flight paths of incidence relation to be merged for the forward direction Fusion Module, obtains at least one fusion flight path And each merge the flight path corresponding fusion moment.
3. method according to claim 1 or 2, which is characterized in that the forward direction Fusion Module navigates to the multiple forward direction The first of mark measurement sensor measures flight path and carries out Single cell fusion, further includes:
The forward direction Fusion Module determine the multiple forward direction flight path measurement sensor first measure flight path between there is no close The first of connection relationship measures flight path;
The forward direction Fusion Module measures selection in flight path and meets and preset the of reserve from there is no the first of incidence relation One measures flight path.
4. according to the method described in claim 3, it is characterized in that, the forward direction Fusion Module is from there is no the of incidence relation One, which measures selection in flight path, meets the first measurement flight path for presetting reserve, including:
The forward direction Fusion Module judges that there is no the first of incidence relation to measure the corresponding forward direction flight path measurement sensor of flight path Whether be before to imaging sensor;If so, selection described first measures flight path;If not, it is determined that described first measures flight path Threat, selection, which meets, to be preset the first of Threat condition and measures flight path.
5. according to the method described in claim 1, it is characterized in that, the overall situation Fusion Module is based on the forward direction fusion results In the fusion moment, the first measurement time in the forward direction fusion results, each front side flight path measurement sensor correspond to The first measurement time, the fusion flight path in the forward direction fusion results, first in the forward direction fusion results are measured and navigated Mark and the first measurement flight path of the multiple front side flight path measurement sensor carry out secondary fusion, including:
Flight path and described is measured more to the fusion flight path in the forward direction fusion results, first in the forward direction fusion results The first of a front side flight path measurement sensor measures the unification that flight path carries out data format, obtains corresponding second and measures flight path;
Based on the fusion moment in the forward direction fusion results, the first measurement time in the forward direction fusion results, Mei Gesuo Corresponding first measurement time of front side flight path measurement sensor is stated, time synchronization is carried out to each system flight path of storage, is obtained Each corresponding prediction flight path of the system flight path;
Based on each prediction flight path, being associated between each second measurement flight path and each system flight path is determined Relationship;
Based on the incidence relation, the system flight path that updates storage.
6. according to the method described in claim 5, it is characterized in that, described based on each prediction flight path, each institute is determined The incidence relation between the second measurement flight path and each system flight path is stated, including:
It is measured in flight path from all described second, searches and measure flight path with the second of the prediction track matching;
The corresponding system flight path of the prediction flight path is associated with the second measurement flight path found.
7. according to the method described in claim 6, it is characterized in that, the lookup is measured with the second of the prediction track matching Flight path, including:
Centered on the prediction flight path, searches and surveyed with the presence or absence of at least one second in preset range around the prediction flight path Measure flight path;
If in the presence of the second measurement flight path nearest apart from the prediction flight path and the prediction track matching.
8. a kind of secondary cascade emerging system of data, which is characterized in that the system comprises:
Forward direction Fusion Module measures flight path and each described first for obtaining the first of multiple forward direction flight path measurement sensors Measure corresponding first measurement time of flight path;
The forward direction Fusion Module is additionally operable to measure flight path progress once to the first of the multiple forward direction flight path measurement sensor Fusion, to fusion results before obtaining, the forward direction fusion results include:At least one fusion flight path, each fusion flight path correspond to The fusion moment, meet preset the first of reserve measure flight path and it is each meet preset the first of reserve and measure boat Corresponding first measurement time of mark;
Global Fusion Module, first for obtaining the forward direction fusion results, multiple front side flight path measurement sensors measures boat Mark and corresponding first measurement time of each front side flight path measurement sensor;
The overall situation Fusion Module, is additionally operable to based on the fusion moment in the forward direction fusion results, the forward direction fusion results In the first measurement time, corresponding first measurement time of each front side flight path measurement sensor, the forward direction is merged As a result first in fusion flight path, the forward direction fusion results in measures flight path and the multiple front side flight path measures sensing The first of device measures flight path and carries out secondary fusion.
9. a kind of mobile unit, which is characterized in that including:
Processor, memory, network interface and user interface;
The processor, memory, network interface and user interface are coupled by bus system;
The processor is by the program for calling the memory to store or instruction, for executing such as any one of claim 1 to 7 The step of the method.
10. a kind of non-transient computer readable storage medium, which is characterized in that the non-transient computer readable storage medium is deposited Computer instruction is stored up, the computer instruction makes the computer execute the step such as any one of claim 1 to 7 the method Suddenly.
CN201810632460.4A 2018-06-19 2018-06-19 Data secondary cascade fusion method and system, vehicle-mounted equipment and storage medium Active CN108776333B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810632460.4A CN108776333B (en) 2018-06-19 2018-06-19 Data secondary cascade fusion method and system, vehicle-mounted equipment and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810632460.4A CN108776333B (en) 2018-06-19 2018-06-19 Data secondary cascade fusion method and system, vehicle-mounted equipment and storage medium

Publications (2)

Publication Number Publication Date
CN108776333A true CN108776333A (en) 2018-11-09
CN108776333B CN108776333B (en) 2021-04-16

Family

ID=64025214

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810632460.4A Active CN108776333B (en) 2018-06-19 2018-06-19 Data secondary cascade fusion method and system, vehicle-mounted equipment and storage medium

Country Status (1)

Country Link
CN (1) CN108776333B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110304064A (en) * 2019-07-15 2019-10-08 广州小鹏汽车科技有限公司 A kind of control method and vehicle control system, vehicle of vehicle lane change
CN110879598A (en) * 2019-12-11 2020-03-13 北京踏歌智行科技有限公司 Information fusion method and device of multiple sensors for vehicle

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030179084A1 (en) * 2002-03-21 2003-09-25 Ford Global Technologies, Inc. Sensor fusion system architecture
CN1940591A (en) * 2005-09-26 2007-04-04 通用汽车环球科技运作公司 System and method of target tracking using sensor fusion
CN103576154A (en) * 2012-08-01 2014-02-12 通用汽车环球科技运作有限责任公司 Fusion of obstacle detection using radar and camera
CN105216792A (en) * 2014-06-12 2016-01-06 株式会社日立制作所 Obstacle target in surrounding environment is carried out to the method and apparatus of recognition and tracking
CN105866769A (en) * 2016-05-19 2016-08-17 哈尔滨工业大学 Multi-target TBD (track-before-detect) method for parallel computation
CN106585623A (en) * 2016-12-21 2017-04-26 驭势科技(北京)有限公司 Detection system for detecting targets around vehicle and application of detection system
CN107192998A (en) * 2017-04-06 2017-09-22 中国电子科技集团公司第二十八研究所 A kind of adapter distribution track data fusion method based on covariance target function

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030179084A1 (en) * 2002-03-21 2003-09-25 Ford Global Technologies, Inc. Sensor fusion system architecture
CN1940591A (en) * 2005-09-26 2007-04-04 通用汽车环球科技运作公司 System and method of target tracking using sensor fusion
CN103576154A (en) * 2012-08-01 2014-02-12 通用汽车环球科技运作有限责任公司 Fusion of obstacle detection using radar and camera
CN105216792A (en) * 2014-06-12 2016-01-06 株式会社日立制作所 Obstacle target in surrounding environment is carried out to the method and apparatus of recognition and tracking
CN105866769A (en) * 2016-05-19 2016-08-17 哈尔滨工业大学 Multi-target TBD (track-before-detect) method for parallel computation
CN106585623A (en) * 2016-12-21 2017-04-26 驭势科技(北京)有限公司 Detection system for detecting targets around vehicle and application of detection system
CN107192998A (en) * 2017-04-06 2017-09-22 中国电子科技集团公司第二十八研究所 A kind of adapter distribution track data fusion method based on covariance target function

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
黄如林: "无人驾驶汽车动态障碍物避撞关键技术研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110304064A (en) * 2019-07-15 2019-10-08 广州小鹏汽车科技有限公司 A kind of control method and vehicle control system, vehicle of vehicle lane change
CN110304064B (en) * 2019-07-15 2020-09-11 广州小鹏汽车科技有限公司 Control method for vehicle lane change, vehicle control system and vehicle
CN110879598A (en) * 2019-12-11 2020-03-13 北京踏歌智行科技有限公司 Information fusion method and device of multiple sensors for vehicle

Also Published As

Publication number Publication date
CN108776333B (en) 2021-04-16

Similar Documents

Publication Publication Date Title
CN108828527A (en) A kind of multi-Sensor Information Fusion Approach, device, mobile unit and storage medium
Kunz et al. Autonomous driving at Ulm University: A modular, robust, and sensor-independent fusion approach
US20220080961A1 (en) Control system and control method for sampling based planning of possible trajectories for motor vehicles
CN111144432B (en) Method for eliminating fuzzy detection in sensor fusion system
CN106842184B (en) Multi-target detection and tracking method based on beam scheduling
US11789141B2 (en) Omnidirectional sensor fusion system and method and vehicle including the same
US11436815B2 (en) Method for limiting object detection area in a mobile system equipped with a rotation sensor or a position sensor with an image sensor, and apparatus for performing the same
CN112154455A (en) Data processing method, equipment and movable platform
US11763576B2 (en) Method for determining a drivable area
CN113759906B (en) Vehicle alignment method and device, computer equipment and storage medium
JP6951728B2 (en) Object tracking device
CN108776333A (en) A kind of secondary cascade fusion method of data, system, mobile unit and storage medium
Weiss et al. Multiple-model tracking for the detection of lane change maneuvers
Sandblom et al. Sensor data fusion for multiple configurations
CN114265080A (en) Object tracking method and apparatus using LIDAR sensor, vehicle, and recording medium
US20220262129A1 (en) Multiple Hypothesis-Based Fusion of Sensor Data
EP4217251A2 (en) Multi-layer autonomous vehicle control architecture
CN116481541A (en) Vehicle autonomous return control method, device and medium without satellite navigation
KR20200133122A (en) Apparatus and method for preventing vehicle collision
CN115097826A (en) Vehicle turning track planning method and device
US11142212B2 (en) Safety-aware comparator for redundant subsystems in autonomous vehicles
US11587331B2 (en) Lane keeping for autonomous vehicles
US11555913B2 (en) Object recognition device and object recognition method
US20230266468A1 (en) Track Association Method and System for Tracking Objects
WO2009083967A2 (en) Tracking coordinator for air-to-air and air-to- ground tracking

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