WO2018220048A1 - Apparatus, method and computer program for computer vision - Google Patents

Apparatus, method and computer program for computer vision Download PDF

Info

Publication number
WO2018220048A1
WO2018220048A1 PCT/EP2018/064246 EP2018064246W WO2018220048A1 WO 2018220048 A1 WO2018220048 A1 WO 2018220048A1 EP 2018064246 W EP2018064246 W EP 2018064246W WO 2018220048 A1 WO2018220048 A1 WO 2018220048A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
motion
circuitry
data
velocity
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.)
Ceased
Application number
PCT/EP2018/064246
Other languages
French (fr)
Inventor
Florian Becker
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.)
Sony Europe BV United Kingdom Branch
Sony Corp
Original Assignee
Sony Europe Ltd
Sony Corp
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 Sony Europe Ltd, Sony Corp filed Critical Sony Europe Ltd
Priority to CN201880036346.3A priority Critical patent/CN110691986B/en
Priority to US16/610,911 priority patent/US11255959B2/en
Publication of WO2018220048A1 publication Critical patent/WO2018220048A1/en
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • 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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/505Systems of measurement based on relative movement of target using Doppler effect for determining closest range to a target or corresponding time, e.g. miss-distance indicator
    • 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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/585Velocity or trajectory determination systems; Sense-of-movement determination systems processing the video signal in order to evaluate or display the velocity value
    • 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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/589Velocity or trajectory determination systems; Sense-of-movement determination systems measuring the velocity vector
    • 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
    • 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/933Radar or analogous systems specially adapted for specific applications for anti-collision purposes of aircraft or spacecraft
    • 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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/581Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of interrupted pulse modulated waves and based upon the Doppler effect resulting from movement of targets
    • G01S13/582Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of interrupted pulse modulated waves and based upon the Doppler effect resulting from movement of targets adapted for simultaneous range and velocity measurements
    • 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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/583Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of continuous unmodulated waves, amplitude-, frequency-, or phase-modulated waves and based upon the Doppler effect resulting from movement of targets
    • G01S13/584Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of continuous unmodulated waves, amplitude-, frequency-, or phase-modulated waves and based upon the Doppler effect resulting from movement of targets adapted for simultaneous range and velocity measurements
    • 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/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional [2D] tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional [2D] tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • G01S13/726Multiple target tracking
    • 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
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/86Combinations of sonar systems with lidar systems; Combinations of sonar systems with systems not using wave reflection
    • 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
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • 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
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • 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
    • G01S2013/9323Alternative operation using light waves
    • 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
    • G01S2013/9324Alternative operation using ultrasonic waves

Definitions

  • the present disclosure generally pertains to the field of computer vision, in particular to camera and radar-based measurement systems. Such technology can for example be used in applications for automotive driving.
  • the surrounding scenery is typically described as a small number of unextended contacts, each being described by a state with at least 2d position and 2d velocity that represents motion.
  • a number of sensors such as cameras, radar and LiDAR are used to provide the information necessary for self-driving without direct contact.
  • modern self- driving cars rely on techniques such as stereo cameras, Doppler radar and/ or LiDAR (Light Detection and Ranging) to estimate motion.
  • Stereo cameras provide high resolution information and they can see color which makes them very efficient in the classification of objects and texture interpretation. Stereo cameras can also be efficiently used for motion estimation. Estimating the dense non-rigid three-dimensional motion field of a scene is known as scene flow estimation. Scene flow estimation (in short "scene flow”) shows the three-dimensional displacement vector of each surface point between two frames.
  • scene flow estimation typically provides motion information with less accuracy in the radial direction than in the angular direction.
  • Doppler radar is a sensor system that uses radio waves to determine the velocity, range and angle of objects.
  • the radar technology is very efficient in motion measurement. Radar velocity measurements provide good accuracy in the radial direction but less or even no accuracy in the angular direction.
  • Camera and radar based measurement systems thus provide information on motion in an environment with complementary precision and in very different data representations.
  • the disclosure provides an apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
  • the disclosure provides a method comprising transferring motion information obtained from a plurality of sensors of different or similar type to a common representation.
  • the disclosure provides a computer program comprising instructions which, when carried out on a processor, cause the processor to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
  • Fig.l schematically describes the generation of a fused motion map by fusing data of a Doppler radar and data obtained from scene flow estimation based on images of a stereo camera;
  • Fig. 2 shows in more detail the alignment of the processed data from the Doppler radar in order to generate a motion map
  • Fig. 3 shows in more detail the alignment of the processed data from the stereo camera in order to generate a motion map
  • Fig. 4 shows in more detail the process of fusing the motion map obtained from data of a Doppler radar and the motion map obtained from data of a stereo camera in order to obtain a fused motion map
  • Fig. 5a schematically shows the uncertainty of a single velocity measurement as seen by a scene flow analysis (stereo camera);
  • Fig. 5b schematically shows the uncertainty of a single velocity measurement as seen by a Doppler radar
  • Fig 5c shows the reduced velocity measurement uncertainty in a fused motion map generated by fusing the aligned data of a Doppler radar and a stereo camera;
  • Fig. 6 shows an example of a motion map derived from Doppler radar measurements
  • Fig. 7 shows an example of a motion map derived from scene flow measurements based on images captured by a stereo camera
  • Fig. 8 shows an example of a fused motion map that combines the motion map derived from Doppler radar measurements with the motion map derived from scene flow measurements based on images captured by a stereo camera;
  • Fig. 9 is a block diagram depicting an example of schematic configuration of a vehicle control system.
  • Fig. 10 is a diagram of assistance in explaining an example of installation positions of an outside- vehicle information detecting section and an imaging section.
  • the embodiments described below disclose an apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
  • the plurality of sensors may be of different type or of similar type.
  • the apparatus may for example comprise an integrated control unit that controls general operation within a vehicle control system in accordance with various kinds of programs.
  • An integrated control unit may include a microcomputer, a general-purpose communication I/F, a dedicated communication, a positioning section, a beacon receiving section, an in- vehicle device, a sound/image output section, a vehicle-mounted network I/F, a storage section, or the like.
  • the apparatus may for example be used in a vehicle control system, in an advanced driver assistance system, in a controller for autonomous driving, or the like.
  • the apparatus may be applied as a vehicle control system or advanced driver assistance system in motor vehicle such a car, a motor cycle, a truck, or the like.
  • the apparatus may also be applied as a vehicle control system or advanced driver assistance system in an electric vehicle or in a hybrid vehicle.
  • the apparatus may also be applied in other scenarios, e.g. as controller for autonomous robots or drone products, or, in general, for any movable apparatus.
  • the disclosed technology is applied to automotive systems, the obtained increase in the accuracy of the position and velocity information in measurements of objects is highly required.
  • Circuitry may include a processor, a memory (RAM, ROM or the like), a storage, input means (mouse, keyboard, camera, etc.), output means (display (e.g. liquid crystal, (organic) light emitting diode, etc.), loudspeakers, etc., a (wireless) interface, etc.), as it is generally known for electronic devices (computers, smartp hones, etc.). Moreover, it may include sensors for sensing still image or video image data (image sensor, camera sensor, video sensor, etc.), for sensing a fingerprint, for sensing environmental parameters (e.g. radar, humidity, light, temperature), etc.
  • environmental parameters e.g. radar, humidity, light, temperature
  • Sensors of different types may for example be of anyone of the following types: a stereo camera, an ultrasonic sensor, a radar device, or a LiDAR device (Light detection and Ranging device, or Laser imaging detection and ranging device).
  • a stereo camera an ultrasonic sensor
  • a radar device or a LiDAR device (Light detection and Ranging device, or Laser imaging detection and ranging device).
  • LiDAR device Light detection and Ranging device, or Laser imaging detection and ranging device
  • the circuitry may also be configured to transfer motion information obtained from a plurality of sensors of similar type to a common representation.
  • the circuitry may be configured to fuse information from several cameras or radars of similar type complementing each other, e.g. due to different viewing angles.
  • the common representation to which motion information obtained from the plurality of sensors is transferred may for example be a motion map.
  • a motion map may also be seen as a "dynamic occupancy map”.
  • a motion map may for example be a 2d data array that represents data in the "bird's eye perspective”.
  • a motion map may for example be a 2d grid representation of motion data.
  • a grid representation of a motion map may be based on a regular or irregular grid, i.e. the cells do not necessarily have to be square, but can also change their size, shape etc. In the embodiments, the cells of the grid cover the whole map domain.
  • a motion map may for example store velocity data in dependence of generic x, z coordinates.
  • Data association may be given by the assignment of data to cells of the motion map.
  • Each cell may be defined by a specific x, z coordinate pair.
  • the circuitry may be configured to fuse the data of a Doppler radar and a stereo camera into a common representation.
  • the apparatus may however not only be applied for the combination of Doppler radar and scene flow (stereo camera), but also for a ultrasound or LiDAR sensor and stereo camera, or other combinations, if they can be configured to provide motion information for the environment..
  • the circuitry may be configured to transfer to the common representation motion information obtained from a Doppler radar.
  • Motion information obtained from the Doppler radar may comprise polar coordinates of a cell in the polar coordinate space and angular and radial components of the velocity attributed to the cell.
  • the circuitry may be configured to transfer to the common representation motion information obtained by scene flow estimation on images captured by a stereo camera.
  • Motion information obtained from scene flow estimation may comprise image positions, disparity data and displacement data.
  • the circuitry may be configured to reconstruct position and velocity from sensor data to obtain a motion map of the sensor data.
  • the circuitry may be configured to apply an error model for motion on the processed data to obtain a motion map of the sensor data.
  • An error model may for example determine mean and covariance of sensor measurements.
  • the circuitry may for example be configured to represent the motion map by
  • X, z are 2d Cartesian coordinates in the motion map, are the mean values of a normal distribution describing a velocity estimate is the covariance matrix that repre
  • the circuitry may be configured to fuse sensor data cell-wise by determining for each cell a joint probability for the velocity.
  • the circuitry may be configured to assume, for every grid cell of a motion map, that the velocity V of contacts in this cell follows a normal distribution.
  • the circuitry may be configured to transform parameters of an error model into an auxiliary representation.
  • This auxiliary representation may for example be used in implementations to speed up or otherwise simplify the processing.
  • the circuitry may be configured to fuse information from sensors “a” and “b” given velocity distributions in the same cell.
  • Sensors "a” and “b” may be of any one of the sensor types described above or in the embodiments described below in more detail. This can be extended to any finite number of sensors of any kind that provide motion information that can be converted to a motion map.
  • the embodiments also disclose a method comprising transferring motion information obtained from a plurality of sensors to a common representation.
  • the method may comprise anyone of the processing steps described above or in the embodiments described below in more detail.
  • the embodiments also disclose a computer program comprising instructions which when, carried out on a processor, cause the processor to transfer motion information obtained from a plurality of sensors to a common representation.
  • the computer program may comprise instructions to perform any one of the processing steps described above or in the embodiments described below in more detail.
  • the embodiments also disclose a tangible computer-readable medium that stores a computer program comprising instructions which, when carried out on a processor, cause the processor to transfer motion information obtained from a plurality of sensors to a common representation.
  • the tangible computer-readable medium may store a computer program comprising instructions to perform anyone of the processing steps described above or in the embodiments described below in more detail.
  • Fig. 1 schematically describes the generation of a fused motion map by fusing data of a Doppler radar and data obtained from scene flow estimation based on images of a stereo camera.
  • a Doppler radar generates raw data 111.
  • the raw data is processed to produce processed data 112 such as range, angle and speed data by calibration, FFT, beam- forming, etc.
  • the processed data 112 may for example be a two-dimensional array in polar coordinates r, ⁇ , or a three-dimensional array with axes related to polar position coordinates r and ⁇ as well as radial velocity v r .
  • the processed data 112 is aligned to a motion map 113.
  • This alignment transfers the motion information contained in the processed data to a common representation.
  • a stereo camera produces raw images 211.
  • the raw images 211 are processed by calibration, stereo & motion estimation (scene flow estimation), etc. whereby processed data 212 in the form of 3d points and 3d velocities are produced.
  • the processed data 212 are aligned to generate a motion map 204.
  • This alignment transfers the motion information obtained from camera images to a common representation.
  • Both motion maps 104 and 204 are fused in 301 to create a fused motion map 302 in which both data are combined. Data association is given by the assignment of data to cells of the motion map during data alignment in 103 and 203.
  • Fig. 2 shows in more detail the alignment 103 of the processed data 112 from the Doppler radar in order to generate motion map 104.
  • the processed data 112 is represented as
  • V denote the polar coordinates of a cell in the polar coordinate space
  • the component can be modelled to be zero and to have an
  • the alignment process 103 a position/velocity reconstruction and an error model for motion is applied to the processed data 112 to obtain the motion map 104.
  • the motion map space is represented by spatial coordinates (x, z).
  • Data in the motion map is represented by
  • X, z are 2d Cartesian coordinates in the motion map, are the mean values of a normal distribution describing a velocity estimate and z is the respective covariance matrix that represents the uncertainty of the motion measurement obtained from a sensor-specific error model.
  • X, z are 2d Cartesian coordinates in the motion map, are the mean values of a normal distribution describing a velocity estimate and z is the respective covariance matrix that represents the uncertainty of the motion measurement obtained from a sensor-specific error model.
  • 105 in Fig. 2 with a Doppler radar, the error ⁇ in the radial direction
  • Fig. 3 shows in more detail the alignment 203 of the processed data 212 from the stereo camera in order to generate motion map 204.
  • the processed data 212 is represented as
  • a 3d position/velocity reconstruction a projection to motion map coordinates, and an error model for motion is applied to the processed data 212 to obtain the motion map 204.
  • the motion map space is represented by spatial coordinates (x, z) .
  • data in the motion map is represented by where X, z are 2d Cartesian coordinates in the motion map,
  • a re the mean values of a normal distribution describing a velocity estimate ( and is the covariance matrix that represents the uncertainty of the motion measurement obtained from a sensor-specific error model.
  • the uncertainty of the velocity is typically smaller in the angular direction compared to the radial direction in the velocity space.
  • Fig. 4 shows in more detail the process 301 of fusing the motion map 104 obtained from data of a Doppler radar and the motion map 204 obtained from data of a scene flow analysis of stereo camera images in order to obtain a fused motion map 302.
  • the motion map 104 is a 2d grid representation in spatial coordinates ⁇ x, z) of the processed data 212 after alignment
  • the motion map 204 is a 2d grid representation in spatial coordinates ⁇ x, z) of the processed data 212 after alignment.
  • Fusion 301 merges the information cell-wise by determining for each cell a joint probability for the velocity .
  • the fused motion map 302 is, again, a 2d grid representation in
  • Fig. 5a schematically shows the uncertainty of a single velocity measurement as seen by a scene flow analysis (stereo camera).
  • the figure shows the spatial resolution uncertainty of the observed velocity of the stereo camera in the associated motion map.
  • the motion map stores in cell 214 the 2d mean value and the uncertainty of the z velocity vector, indicated by a probability distribution 215.
  • the probability distribution 215 represents a sensor-specific error model that encodes 2d velocity uncertainty as a covariance matrix
  • the actual velocity of an object in cell 214 is indicated by
  • a velocity measurement of the stereo camera is indicated as a measured radial velocity component 212 and a measured angular velocity component 213.
  • the stereo camera-based scene flow analysis has a better velocity precision in angular direction than in radial direction so that the uncertainty in the radial direction is larger than in the angular direction. Accordingly, the probability distribution 215 is represented in Fig. 5a by an ellipse that is narrower in radial direction than in angular direction.
  • Fig. 5b schematically shows the uncertainty of a single velocity measurement as seen by a Doppler radar.
  • the figure shows the spatial resolution uncertainty of the Doppler radar in the associated motion map.
  • the motion map stores in cell 114 an x-z velocity vector and its respective uncertainty, indicated by a probability distribution 115.
  • the probability distribution 115 represents a sensor- specific error model that encodes 2d velocity uncertainty as a covariance matrix ⁇ Vx Vz .
  • the actual velocity of an object in cell 114 is indicated by velocity vector 111.
  • a velocity measurement of the Doppler radar is indicated as a measured radial velocity component 112.
  • the Doppler radar has a good velocity resolution in radial direction but the angular velocity component is typically not observable. Accordingly, the probability distribution 215 is represented in Fig. 5b by an ellipse that is narrow in radial direction but very large in angular direction.
  • Fig 5c shows the reduced velocity measurement uncertainty in a fused motion map generated by fusing the aligned data of a Doppler radar and a stereo camera.
  • the figure shows the uncertainty of the spatial resolution of the fused data in the fused motion map.
  • the fused motion map stores in cell 314 an x-z velocity vector and its respective uncertainty, indicated by a probability distribution 315.
  • the actual velocity of an object in cell 314 is indicated by velocity vector 311.
  • a fused velocity measurement of the stereo camera is indicated as a radial velocity component 312 and an angular velocity component 313.
  • the fused data has a good velocity resolution in radial direction and in axial direction.
  • the probability distribution 315 of the fused measurement is represented in Fig. 5c by an ellipse that is narrow in radial direction and narrow in angular direction.
  • the result is (under ideal conditions) a measurement with low uncertainty in both radial and angular direction.
  • Fig. 6 shows an example of a motion map derived from Doppler radar measurements.
  • the brightness indicates velocity value.
  • the Doppler radar has a good velocity resolution in radial direction but the angular velocity component is not observable.
  • Fig. 7 shows an example of a motion map derived from scene flow measurements based on images captured by a stereo camera.
  • Fig. 8 shows an example of a fused motion map that combines the motion map of Fig. 6 obtained by a Doppler radar with the motion map of Fig. 7 obtained by scene flow analysis based on images captured by a stereo camera. The result is a measurement with low uncertainty in both radial and angular direction.
  • a scene flow speed estimate as described above may possibly be fused from several scene flow measurements, and that a Doppler radar estimate as described above may possibly be fused from several Doppler radar measurements.
  • the covariance matrix is represented by a precision which is positive
  • ⁇ ⁇ , ⁇ 3 ⁇ 4 are the respective mean values of the normal distribution N and are the
  • the fusing reads as:
  • This information is encoded in a range-angle-
  • the radial velocity v r is computed as q-weighted average along the speed-dimensions, and there is computed a precision estimate ⁇ of this information as RMS of q along the speed information.
  • the radial velocity and precision from the range-angle- map are interpolated, and the speed information is encoded as a 2d normal distribution with mean ⁇ ⁇ : speed v r in radial direction, speed 0 in angular direction and covariance ⁇ v : eigenvalues: Oy r in radial direction, « ⁇ in angular direction.
  • a motion model may be defined as follows:
  • any other definition may be used that represents the capabilities of the sensor in a better way.
  • A is a predefined correction matrix and is a predefined correction vector that correct for the relative sensor alignment.
  • a weight To iteratively accumulate information from multiple measurements for each cell a joint probability is computed by updating the velocity estimate (Pj, bi) in cell i with the new information
  • a position (x, z) in the coordinate system of the motion map is determined, e.g. by assuming a street plane and projecting the model to 2x3 matrix A, 2x1 vector b as
  • A, b also correct for the relative sensor alignment.
  • the measurements in combination with a 3d error model for position and speed also provide ⁇ P and ⁇ v , both 3x3 covariance matrices, which represent sensor-specific precision.
  • each measurement is encoded using a normal distribution.
  • the mean ⁇ is given by the measurement.
  • the covariance ⁇ is given by the error model.
  • ⁇ P and ⁇ v both 3x3 covariance matrices, represent the sensor-specific precision:
  • a joint probability is computed by updating the velocity estimate ( in cell i with the new information
  • An image is obtained from a first (e.g. left) camera view C L and an image is obtained from a second (e.g. right) camera view C R at their position at a time t. Still further, an image is obtained from a first camera view C and from a second camera
  • the data from camera pairs ⁇ is calibrated and rectified such that the baselines b (between and C R ) and b' (between and are known, and the intrinsic calibration K (valid for and and K' (valid for and are known.
  • a re determined e.g. from experimental measurements.
  • the point X is reconstructed in the coordinate system of the first camera, such that X
  • the Jacobian matrix is given by (first order component-wise derivatives)
  • ⁇ , ⁇ returned by f can now be used in the transformation of scene flow information to a motion map as described above.
  • the technology according to the embodiments of the present disclosure is applicable to various products.
  • the technology according to an embodiment of the present disclosure may be implemented as a device included in a mobile body that is any of kinds of automobiles, electric vehicles, hybrid electric vehicles, motorcycles, bicycles, personal mobility vehicles, airplanes, drones, ships, robots, construction machinery, agricultural machinery (tractors), and the like.
  • Fig. 9 is a block diagram depicting an example of schematic configuration of a vehicle control system 7000 as an example of a mobile body control system to which the technology according to an embodiment of the present disclosure can be applied.
  • the vehicle control system 7000 includes a plurality of electronic control units connected to each other via a communication network 7010.
  • the vehicle control system 7000 includes a driving system control unit 7100, a body system control unit 7200, a battery control unit 7300, an outside-vehicle information detecting unit 7400, an in-vehicle information detecting unit 7500, and an integrated control unit 7600.
  • the communication network 7010 connecting the plurality of control units to each other may, for example, be a vehicle-mounted communication network compliant with an arbitrary standard such as controller area network (CAN), local interconnect network (LIN), local area network (LAN), FlexRay (registered trademark), or the like.
  • CAN controller area network
  • LIN local interconnect network
  • LAN local area network
  • FlexRay registered trademark
  • Each of the control units includes: a microcomputer that performs arithmetic processing according to various kinds of programs; a storage section that stores the programs executed by the microcomputer, parameters used for various kinds of operations, or the like; and a driving circuit that drives various kinds of control target devices.
  • Each of the control units further includes: a network interface (I/F) for performing communication with other control units via the communication network 7010; and a communication I/F for performing communication with a device, a sensor, or the like within and without the vehicle by wire communication or radio communication.
  • I/F network interface
  • microcomputer 9 includes a microcomputer 7610, a general-purpose communication I/F 7620, a dedicated communication I/F 7630, a positioning section 7640, a beacon receiving section 7650, an in-vehicle device I/F 7660, a sound/image output section 7670, a vehicle-mounted network I/F 7680, and a storage section 7690.
  • the other control units similarly include a microcomputer, a communication I/F, a storage section, and the like.
  • the driving system control unit 7100 controls the operation of devices related to the driving system of the vehicle in accordance with various kinds of programs.
  • the driving system control unit 7100 functions as a control device for a driving force generating device for generating the driving force of the vehicle, such as an internal combustion engine, a driving motor, or the like, a driving force transmitting mechanism for transmitting the driving force to wheels, a steering mechanism for adjusting the steering angle of the vehicle, a braking device for generating the braking force of the vehicle, and the like.
  • the driving system control unit 7100 may have a function as a control device of an antilock brake system (ABS), electronic stability control (ESC), or the like.
  • ABS antilock brake system
  • ESC electronic stability control
  • the driving system control unit 7100 is connected with a vehicle state detecting section 7110.
  • the vehicle state detecting section 7110 includes at least one of a gyro sensor that detects the angular velocity of axial rotational movement of a vehicle body, an acceleration sensor that detects the acceleration of the vehicle, and sensors for detecting an amount of operation of an accelerator pedal, an amount of operation of a brake pedal, the steering angle of a steering wheel, an engine speed or the rotational speed of wheels, and the like.
  • the driving system control unit 7100 performs arithmetic processing using a signal input from the vehicle state detecting section 7110, and controls the internal combustion engine, the driving motor, an electric power steering device, the brake device, and the like.
  • the body system control unit 7200 controls the operation of various kinds of devices provided to the vehicle body in accordance with various kinds of programs.
  • the body system control unit 7200 functions as a control device for a keyless entry system, a smart key system, a power window device, or various kinds of lamps such as a headlamp, a backup lamp, a brake lamp, a turn signal, a fog lamp, or the like.
  • radio waves transmitted from a mobile device as an alternative to a key or signals of various kinds of switches can be input to the body system control unit 7200.
  • the body system control unit 7200 receives these input radio waves or signals, and controls a door lock device, the power window device, the lamps, or the like of the vehicle.
  • the battery control unit 7300 controls a secondary battery 7310, which is a power supply source for the driving motor, in accordance with various kinds of programs.
  • the battery control unit 7300 is supplied with information about a battery temperature, a battery output voltage, an amount of charge remaining in the battery, or the like from a battery device including the secondary battery 7310.
  • the battery control unit 7300 performs arithmetic processing using these signals, and performs control for regulating the temperature of the secondary battery 7310 or controls a cooling device provided to the battery device or the like.
  • the outside-vehicle information detecting unit 7400 detects information about the outside of the vehicle including the vehicle control system 7000.
  • the outside-vehicle information detecting unit 7400 is connected with at least one of an imaging section 7410 and an outside-vehicle information detecting section 7420.
  • the imaging section 7410 includes at least one of a time-of- flight (ToF) camera, a stereo camera, a monocular camera, an infrared camera, and other cameras.
  • ToF time-of- flight
  • the outside-vehicle information detecting section 7420 includes at least one of an environmental sensor for detecting current atmospheric conditions or weather conditions and a peripheral information detecting sensor for detecting another vehicle, an obstacle, a pedestrian, or the like on the periphery of the vehicle including the vehicle control system 7000.
  • the environmental sensor may be at least one of a rain drop sensor detecting rain, a fog sensor detecting fog, a sunshine sensor detecting a degree of sunshine, and a snow sensor detecting snowfall.
  • the peripheral information detecting sensor may be at least one of an ultrasonic sensor, a radar device, and a LiDAR device (Light Detection and Ranging device, or Laser imaging detection and ranging device).
  • Each of the imaging section 7410 and the outside-vehicle information detecting section 7420 may be provided as an independent sensor or device, or may be provided as a device in which a plurality of sensors or devices are integrated.
  • Fig. 10 depicts an example of installation positions of the imaging section 7410 and the outside- vehicle information detecting section 7420.
  • Imaging sections 7910, 7912, 7914, 7916, and 7918 are, for example, disposed at at least one of positions on a front nose, sideview mirrors, a rear bumper, and a back door of the vehicle 7900 and a position on an upper portion of a windshield within the interior of the vehicle.
  • the imaging section 7910 provided at the front nose and the imaging section 7918 provided at the upper portion of the windshield within the interior of the vehicle obtain mainly an image of the front of the vehicle 7900.
  • the imaging sections 7912 and 7914 provided at the sideview mirrors obtain mainly an image of the sides of the vehicle 7900.
  • the imaging section 7916 provided at the rear bumper or the back door obtains mainly an image of the rear of the vehicle 7900.
  • the imaging section 7918 provided at the upper portion of the windshield within the interior of the vehicle is used mainly to detect a preceding vehicle, a pedestrian, an obstacle, a signal, a traffic sign, a lane, or the like.
  • Fig. 10 depicts an example of photographing ranges of the respective imaging sections 7910, 7912, 7914, and 7916.
  • An imaging range a represents the imaging range of the imaging section 7910 provided at the front nose.
  • Imaging ranges b and c respectively represent the imaging ranges of the imaging sections 7912 and 7914 provided at the sideview mirrors.
  • An imaging range d represents the imaging range of the imaging section 7916 provided at the rear bumper or the back door.
  • a bird's-eye image of the vehicle 7900 as viewed from above can be obtained by superimposing image data imaged by the imaging sections 7910, 7912, 7914, and 7916, for example.
  • Outside-vehicle information detecting sections 7920, 7922, 7924, 7926, 7928, and 7930 provided at the front, rear, sides, and corners of the vehicle 7900 and the upper portion of the windshield within the interior of the vehicle may be, for example, an ultrasonic sensor or a radar device.
  • the outside- vehicle information detecting sections 7920, 7926, and 7930 provided at the front nose of the vehicle 7900, the rear bumper, the back door of the vehicle 7900, and the upper portion of the windshield within the interior of the vehicle may be a LiDAR device, for example.
  • These outside- vehicle information detecting sections 7920 to 7930 are used mainly to detect a preceding vehicle, a pedestrian, an obstacle, or the like.
  • the outside-vehicle information detecting unit 7400 causes the imaging section 7410 to produce an image of the outside of the vehicle, and receives produced image data.
  • the outside-vehicle information detecting unit 7400 receives detection information from the outside-vehicle information detecting section 7420 connected to the outside-vehicle information detecting unit 7400.
  • the outside-vehicle information detecting section 7420 is an ultrasonic sensor, a radar device, or a LIDAR device
  • the outside-vehicle information detecting unit 7400 transmits an ultrasonic wave, an electromagnetic wave, or the like, and receives information of a received reflected wave.
  • the outside-vehicle information detecting unit 7400 may perform processing of detecting an object such as a human, a vehicle, an obstacle, a sign, a character on a road surface, or the like, or processing of detecting a distance thereto.
  • the outside-vehicle information detecting unit 7400 may perform environment recognition processing of recognizing rain, fog, road surface conditions, or the like on the basis of the received information.
  • the outside-vehicle information detecting unit 7400 may calculate a distance to an object outside the vehicle on the basis of the received information.
  • the outside-vehicle information detecting unit 7400 may perform image recognition processing of recognizing a human, a vehicle, an obstacle, a sign, a character on a road surface, or the like, or processing of detecting a distance thereto.
  • the outside-vehicle information detecting unit 7400 may subject the received image data to processing such as distortion correction, alignment, or the like, and combine the image data imaged by a plurality of different imaging sections 7410 to generate a bird's-eye image or a panoramic image.
  • the outside-vehicle information detecting unit 7400 may perform viewpoint conversion processing using the image data imaged by the imaging section 7410 including the different imaging parts.
  • the in- vehicle information detecting unit 7500 detects information about the inside of the vehicle.
  • the in- vehicle information detecting unit 7500 is, for example, connected with a driver state detecting section 7510 that detects the state of a driver.
  • the driver state detecting section 7510 may include a camera that images the driver, a biosensor that detects biological information on the driver, a microphone that collects sound within the interior of the vehicle, or the like.
  • the biosensor is, for example, disposed in a seat surface, the steering wheel, or the like, and detects biological information on an occupant sitting in a seat or the driver holding the steering wheel.
  • the in-vehicle information detecting unit 7500 may calculate a degree of fatigue of the driver or a degree of concentration of the driver, or may determine whether the driver is dozing.
  • the in-vehicle information detecting unit 7500 may subject an audio signal obtained by the collection of the sound to processing such as noise canceling processing or the like.
  • the integrated control unit 7600 controls general operation within the vehicle control system 7000 in accordance with various kinds of programs.
  • the integrated control unit 7600 is connected with an input section 7800.
  • the input section 7800 is implemented by a device capable of input operation by an occupant, such, for example, as a touch panel, a button, a microphone, a switch, a lever, or the like.
  • the integrated control unit 7600 may be supplied with data obtained by voice recognition of voice input through the microphone.
  • the input section 7800 may, for example, be a remote control device using infrared rays or other radio waves, or an external connecting device such as a mobile telephone, a personal digital assistant (PDA), or the like that supports operation of the vehicle control system 7000.
  • the input section 7800 may be, for example, a camera.
  • an occupant can input information by gesture.
  • data may be input which is obtained by detecting the movement of a wearable device that an occupant wears.
  • the input section 7800 may, for example, include an input control circuit or the like that generates an input signal on the basis of information input by an occupant or the like using the above-described input section 7800, and which outputs the generated input signal to the integrated control unit 7600.
  • An occupant or the like inputs various kinds of data or gives an instruction for processing operation to the vehicle control system 7000 by operating the input section 7800.
  • the storage section 7690 may include a read only memory (ROM) that stores various kinds of programs executed by the microcomputer and a random access memory (RAM) that stores various kinds of parameters, operation results, sensor values, or the like.
  • ROM read only memory
  • RAM random access memory
  • the storage section 7690 may be implemented by a magnetic storage device such as a hard disc drive (HDD) or the like, a semiconductor storage device, an optical storage device, a magneto-optical storage device, or the like.
  • the general-purpose communication I/F 7620 is a communication I/F used widely, which communication I/F mediates communication with various apparatuses present in an external environment 7750.
  • the general-purpose communication I/F 7620 may implement a cellular communication protocol such as global system for mobile communications (GSM (registered trademark)), worldwide interoperability for microwave access (WiMAX (registered trademark)), long term evolution (LTE (registered trademark)), LTE-advanced (LTE-A), or the like, or another wireless communication protocol such as wireless LAN (referred to also as wireless fidelity (Wi-Fi (registered trade- mark)), Bluetooth (registered trademark), or the like.
  • GSM global system for mobile communications
  • WiMAX worldwide interoperability for microwave access
  • LTE registered trademark
  • LTE-advanced LTE-advanced
  • WiFi wireless fidelity
  • Bluetooth registered trademark
  • the general-purpose communication I/F 7620 may, for example, connect to an apparatus (for example, an application server or a control server) present on an external network (for example, the Internet, a cloud network, or a company-specific network) via a base station or an access point.
  • the general-purpose communication I/F 7620 may connect to a terminal present in the vicinity of the vehicle (which terminal is, for example, a terminal of the driver, a pedestrian, or a store, or a machine type communication (MTC) terminal) using a peer to peer (P2P) technology, for example.
  • an apparatus for example, an application server or a control server
  • an external network for example, the Internet, a cloud network, or a company-specific network
  • MTC machine type communication
  • P2P peer to peer
  • the dedicated communication I/F 7630 is a communication I/F that supports a communication protocol developed for use in vehicles.
  • the dedicated communication I/F 7630 may implement a standard protocol such as, for example, wireless access in vehicle environment (WAVE), which is a combination of institute of electrical and electronic engineers ( ⁇ ) 802.1 lp as a lower layer and IEEE 1609 as a higher layer, dedicated short range communications (DSRC), or a cellular communication protocol.
  • WAVE wireless access in vehicle environment
  • institute of electrical and electronic engineers
  • DSRC dedicated short range communications
  • the dedicated communication I/F 7630 typically carries out V2X communication as a concept including one or more of communication between a vehicle and a vehicle (Vehicle to Vehicle), communication between a road and a vehicle (Vehicle to Infrastructure), communication between a vehicle and a home (V ehicle to Home), and communication between a pedestrian and a vehicle (Vehicle to Pedestrian).
  • the positioning section 7640 performs positioning by receiving a global navigation satellite system (GNSS) signal from a GNSS satellite (for example, a GPS signal from a global positioning system (GPS) satellite), and generates positional information including the latitude, longitude, and altitude of the vehicle.
  • GNSS global navigation satellite system
  • GPS global positioning system
  • the positioning section 7640 may identify a current position by exchanging signals with a wireless access point, or may obtain the positional information from a terminal such as a mobile telephone, a personal Handy-phone system (PHS), or a smart phone that has a positioning function.
  • GNSS global navigation satellite system
  • PHS personal Handy-phone system
  • the beacon receiving section 7650 receives a radio wave or an electromagnetic wave transmitted from a radio station installed on a road or the like, and thereby obtains information about the current position, congestion, a closed road, a necessary time, or the like.
  • the function of the beacon receiving section 7650 may be included in the dedicated communication I/F 7630 described above.
  • the in-vehicle device I/F 7660 is a communication interface that mediates connection between the microcomputer 7610 and various in-vehicle devices 7760 present within the vehicle.
  • the in-vehicle device I/F 7660 may establish wireless connection using a wireless communication protocol such as wireless LAN, Bluetooth (registered trademark), near field communication (NFC), or wireless universal serial bus (WUSB).
  • a wireless communication protocol such as wireless LAN, Bluetooth (registered trademark), near field communication (NFC), or wireless universal serial bus (WUSB).
  • WUSB wireless universal serial bus
  • the in-vehicle device I/F 7660 may establish wired connection by universal serial bus (USB), high-definition multimedia interface (HDMI (registered trademark)), mobile high-definition link (MHL), or the like via a connection terminal (and a cable if necessary) not depicted in the figures.
  • USB universal serial bus
  • HDMI high-definition multimedia interface
  • MHL mobile high-definition link
  • the in-vehicle devices 7760 may, for example, include at least one of a mobile device and a wearable device possessed by an occupant and an information device carried into or attached to the vehicle.
  • the in-vehicle devices 7760 may also include a navigation device that searches for a path to an arbitrary destination.
  • the in-vehicle device I/F 7660 exchanges control signals or data signals with these in-vehicle devices 7760.
  • the vehicle-mounted network I/F 7680 is an interface that mediates communication between the microcomputer 7610 and the communication network 7010.
  • the vehicle-mounted network I/F 7680 transmits and receives signals or the like in conformity with a predetermined protocol supported by the communication network 7010.
  • the microcomputer 7610 of the integrated control unit 7600 controls the vehicle control system 7000 in accordance with various kinds of programs on the basis of information obtained via at least one of the general-purpose communication I/F 7620, the dedicated communication I/F 7630, the positioning section 7640, the beacon receiving section 7650, the in-vehicle device I/F 7660, and the vehicle-mounted network I/F 7680.
  • the microcomputer 7610 may calculate a control target value for the driving force generating device, the steering mechanism, or the braking device on the basis of the obtained information about the inside and outside of the vehicle, and output a control command to the driving system control unit 7100.
  • the microcomputer 7610 may perform cooperative control intended to implement functions of an advanced driver assistance system (ADAS) which functions include collision avoidance or shock mitigation for the vehicle, following driving based on a following distance, vehicle speed maintaining driving, a warning of collision of the vehicle, a warning of deviation of the vehicle from a lane, or the like.
  • ADAS advanced driver assistance system
  • the microcomputer 7610 may perform cooperative control intended for automatic driving, which causes the vehicle to travel autonomously without depending on the operation of the driver, or the like, by controlling the driving force generating device, the steering mechanism, the braking device, or the like on the basis of the obtained information about the surroundings of the vehicle.
  • the microcomputer 7610 may generate three-dimensional distance information between the vehicle and an object such as a surrounding structure, a person, or the like, and generate local map information including information about the surroundings of the current position of the vehicle, on the basis of information obtained via at least one of the general-purpose communication I/F 7620, the dedicated communication I/F 7630, the positioning section 7640, the beacon receiving section 7650, the in-vehicle device I/F 7660, and the vehicle-mounted network I/F 7680.
  • the microcomputer 7610 may predict danger such as collision of the vehicle, approaching of a pedestri- an or the like, an entry to a closed road, or the like on the basis of the obtained information, and generate a warning signal.
  • the warning signal may, for example, be a signal for producing a warning sound or lighting a warning lamp.
  • the sound/image output section 7670 transmits an output signal of at least one of a sound and an image to an output device capable of visually or acoustically notifying an occupant of the vehicle or the outside of the vehicle.
  • an audio speaker 7710, a display section 7720, and an instrument panel 7730 are illustrated as the output device.
  • the display section 7720 may, for example, include at least one of an on-board display and a head-up display.
  • the display section 7720 may have an augmented reality (AR) display function.
  • the output device may be other than these devices, and may be another device such as headphones, a wearable device such as an eyeglass type display worn by an occupant or the like, a projector, a lamp, or the like.
  • the output device is a display device
  • the display device visually displays results obtained by various kinds of processing performed by the microcomputer 7610 or information received from another control unit in various forms such as text, an image, a table, a graph, or the like.
  • the audio output device converts an audio signal constituted of reproduced audio data or sound data or the like into an analog signal, and acoustically outputs the analog signal.
  • At least two control units connected to each other via the communication network 7010 in the example depicted in Fig. 9 may be integrated into one control unit.
  • each individual control unit may include a plurality of control units.
  • the vehicle control system 7000 may include another control unit not depicted in the figures.
  • part of or all the functions performed by one of the control units in the above description may be assigned to another control unit. That is, predetermined arithmetic processing may be performed by any of the control units as long as information is transmitted and received via the communication network 7010.
  • a sensor or a device connected to one of the control units may be connected to another control unit, and a plurality of control units may mutually transmit and receive detection information via the communication network 7010.
  • a computer program for realizing the functions described in this disclosure can be implemented in integrated control unit 7600, or the like.
  • a computer readable recording medium storing such a computer program can also be provided.
  • the recording medium is, for example, a magnetic disk, an optical disk, a magneto-optical disk, a flash memory, or the like.
  • the above-described computer program may be distributed via a network, for example, without the recording medium being used.
  • the constituent elements of the integrated control unit 7600 described with reference to Fig. 9 may be implemented in a module (for example, an integrated circuit module formed with a single die) for the integrated control unit 7600 depicted in Fig. 9.
  • the integrated control unit 7600 described with reference to Fig. 9 may be implemented by a plurality of control units of a vehicle control system as depicted in Fig. 9.
  • the methods as described herein are also implemented in some embodiments as a computer program causing a computer and/ or a processor and/ or a circuitry to perform the method, when being carried out on the computer and/ or processor and/ or circuitry.
  • a non-transitory computer-readable recording medium is provided that stores therein a computer program product, which, when executed by a processor/ circuitry, such as the processor/ circuitry described above, causes the methods described herein to be performed.
  • An apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
  • circuitry is configured to transfer to the common representation motion information obtained from a Doppler radar.
  • the apparatus of (4) or (5) wherein the motion information obtained from the Doppler radar comprises polar coordinates of a cell in the polar coordinate space and angular and radial components of the velocity attributed to the cell.
  • circuitry is configured to transfer to the common representation motion information obtained by scene flow estimation on images captured by a stereo camera.
  • the apparatus of (4) or (7) wherein the motion information obtained from scene flow estimation comprises image positions, disparity data and displacement data.
  • circuitry configured to fuse sensor data cell-wise by determining for each cell a joint probability for the velocity.
  • circuitry is configured to assume, for every grid cell of a motion map, that the velocity V of contacts in this cell follow a normal distribution.
  • circuitry configured to transform parameters of an error model into an auxiliary representation P , b according to:
  • is a mean value and ⁇ is a covariance matrix.
  • Vehicle control system comprising the apparatus of anyone of (1) to (15).
  • Advanced driver assistance system comprising the apparatus of anyone of (1) to (15).
  • a computer program comprising instructions which when carried out on a processor cause the processor to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
  • a tangible and readable storage medium storing a computer program comprising instructions which when carried out on a processor cause the processor to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Multimedia (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

An apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.

Description

APPARATUS, METHOD AND COMPUTER PROGRAM FOR
COMPUTER VISION
TECHNICAL FIELD
The present disclosure generally pertains to the field of computer vision, in particular to camera and radar-based measurement systems. Such technology can for example be used in applications for automotive driving.
TECHNICAL BACKGROUND
In autonomous driving and in the field of advanced driver assistance systems the surrounding scenery is typically described as a small number of unextended contacts, each being described by a state with at least 2d position and 2d velocity that represents motion.
In designing autonomous cars, a number of sensors such as cameras, radar and LiDAR are used to provide the information necessary for self-driving without direct contact. For example, modern self- driving cars rely on techniques such as stereo cameras, Doppler radar and/ or LiDAR (Light Detection and Ranging) to estimate motion.
Stereo cameras provide high resolution information and they can see color which makes them very efficient in the classification of objects and texture interpretation. Stereo cameras can also be efficiently used for motion estimation. Estimating the dense non-rigid three-dimensional motion field of a scene is known as scene flow estimation. Scene flow estimation (in short "scene flow") shows the three-dimensional displacement vector of each surface point between two frames.
However, scene flow estimation typically provides motion information with less accuracy in the radial direction than in the angular direction.
Doppler radar is a sensor system that uses radio waves to determine the velocity, range and angle of objects. The radar technology is very efficient in motion measurement. Radar velocity measurements provide good accuracy in the radial direction but less or even no accuracy in the angular direction.
Camera and radar based measurement systems thus provide information on motion in an environment with complementary precision and in very different data representations.
There are already existing technologies and methods for motion measuring of distant objects without direct contact, but all of them suffer uncertainties and they lack comparability between each other. SUMMARY
According to a first aspect, the disclosure provides an apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
According to a further aspect, the disclosure provides a method comprising transferring motion information obtained from a plurality of sensors of different or similar type to a common representation.
According to a yet further aspect the disclosure provides a computer program comprising instructions which, when carried out on a processor, cause the processor to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
Further aspects are set forth in the dependent claims, the following description and the drawings.
BRIEF DESCRIPTION OF THE DRAWINGS
Embodiments are explained by way of example with respect to the accompanying drawings, in which:
Fig.l schematically describes the generation of a fused motion map by fusing data of a Doppler radar and data obtained from scene flow estimation based on images of a stereo camera;
Fig. 2 shows in more detail the alignment of the processed data from the Doppler radar in order to generate a motion map;
Fig. 3 shows in more detail the alignment of the processed data from the stereo camera in order to generate a motion map;
Fig. 4 shows in more detail the process of fusing the motion map obtained from data of a Doppler radar and the motion map obtained from data of a stereo camera in order to obtain a fused motion map;
Fig. 5a schematically shows the uncertainty of a single velocity measurement as seen by a scene flow analysis (stereo camera);
Fig. 5b schematically shows the uncertainty of a single velocity measurement as seen by a Doppler radar;
Fig 5c shows the reduced velocity measurement uncertainty in a fused motion map generated by fusing the aligned data of a Doppler radar and a stereo camera;
Fig. 6 shows an example of a motion map derived from Doppler radar measurements; Fig. 7 shows an example of a motion map derived from scene flow measurements based on images captured by a stereo camera;
Fig. 8 shows an example of a fused motion map that combines the motion map derived from Doppler radar measurements with the motion map derived from scene flow measurements based on images captured by a stereo camera;
Fig. 9 is a block diagram depicting an example of schematic configuration of a vehicle control system; and
Fig. 10 is a diagram of assistance in explaining an example of installation positions of an outside- vehicle information detecting section and an imaging section.
DETAILED DESCRIPTION OF EMBODIMENTS
Before a detailed description of the embodiments under reference of Fig. 1, some general explanations are made.
The embodiments described below disclose an apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation. The plurality of sensors may be of different type or of similar type.
The apparatus may for example comprise an integrated control unit that controls general operation within a vehicle control system in accordance with various kinds of programs. An integrated control unit may include a microcomputer, a general-purpose communication I/F, a dedicated communication, a positioning section, a beacon receiving section, an in- vehicle device, a sound/image output section, a vehicle-mounted network I/F, a storage section, or the like.
The apparatus may for example be used in a vehicle control system, in an advanced driver assistance system, in a controller for autonomous driving, or the like. For example, the apparatus may be applied as a vehicle control system or advanced driver assistance system in motor vehicle such a car, a motor cycle, a truck, or the like. Alternatively, the apparatus may also be applied as a vehicle control system or advanced driver assistance system in an electric vehicle or in a hybrid vehicle. The apparatus may also be applied in other scenarios, e.g. as controller for autonomous robots or drone products, or, in general, for any movable apparatus. In particular, in the case that the disclosed technology is applied to automotive systems, the obtained increase in the accuracy of the position and velocity information in measurements of objects is highly required.
Circuitry may include a processor, a memory (RAM, ROM or the like), a storage, input means (mouse, keyboard, camera, etc.), output means (display (e.g. liquid crystal, (organic) light emitting diode, etc.), loudspeakers, etc., a (wireless) interface, etc.), as it is generally known for electronic devices (computers, smartp hones, etc.). Moreover, it may include sensors for sensing still image or video image data (image sensor, camera sensor, video sensor, etc.), for sensing a fingerprint, for sensing environmental parameters (e.g. radar, humidity, light, temperature), etc.
Sensors of different types may for example be of anyone of the following types: a stereo camera, an ultrasonic sensor, a radar device, or a LiDAR device (Light detection and Ranging device, or Laser imaging detection and ranging device).
The circuitry may also be configured to transfer motion information obtained from a plurality of sensors of similar type to a common representation. For example, the circuitry may be configured to fuse information from several cameras or radars of similar type complementing each other, e.g. due to different viewing angles.
The common representation to which motion information obtained from the plurality of sensors is transferred may for example be a motion map. A motion map may also be seen as a "dynamic occupancy map". A motion map may for example be a 2d data array that represents data in the "bird's eye perspective". A motion map may for example be a 2d grid representation of motion data. A grid representation of a motion map may be based on a regular or irregular grid, i.e. the cells do not necessarily have to be square, but can also change their size, shape etc. In the embodiments, the cells of the grid cover the whole map domain. A motion map may for example store velocity data in dependence of generic x, z coordinates.
Data association may be given by the assignment of data to cells of the motion map. Each cell may be defined by a specific x, z coordinate pair.
The circuitry may be configured to fuse the data of a Doppler radar and a stereo camera into a common representation. The apparatus may however not only be applied for the combination of Doppler radar and scene flow (stereo camera), but also for a ultrasound or LiDAR sensor and stereo camera, or other combinations, if they can be configured to provide motion information for the environment..
The circuitry may be configured to transfer to the common representation motion information obtained from a Doppler radar.
Motion information obtained from the Doppler radar may comprise polar coordinates of a cell in the polar coordinate space and angular and radial components of the velocity attributed to the cell.
The circuitry may be configured to transfer to the common representation motion information obtained by scene flow estimation on images captured by a stereo camera. Motion information obtained from scene flow estimation may comprise image positions, disparity data and displacement data.
The circuitry may be configured to reconstruct position and velocity from sensor data to obtain a motion map of the sensor data.
The circuitry may be configured to apply an error model for motion on the processed data to obtain a motion map of the sensor data. An error model may for example determine mean and covariance of sensor measurements.
The circuitry may for example be configured to represent the motion map by
Figure imgf000006_0001
where X, z are 2d Cartesian coordinates in the motion map,
Figure imgf000006_0003
are the mean values of a normal distribution describing a velocity estimate is the covariance matrix that repre
Figure imgf000006_0002
sents the uncertainty of the motion measurement obtained from a sensor-specific error model.
The circuitry may be configured to fuse sensor data cell-wise by determining for each cell a joint probability for the velocity.
The circuitry may be configured to assume, for every grid cell of a motion map, that the velocity V of contacts in this cell follows a normal distribution.
The circuitry may be configured to transform parameters of an error model into an auxiliary representation. This auxiliary representation may for example be used in implementations to speed up or otherwise simplify the processing.
In general, the circuitry may be configured to fuse information from sensors "a" and "b" given velocity distributions in the same cell. Sensors "a" and "b" may be of any one of the sensor types described above or in the embodiments described below in more detail. This can be extended to any finite number of sensors of any kind that provide motion information that can be converted to a motion map.
The embodiments also disclose a method comprising transferring motion information obtained from a plurality of sensors to a common representation. The method may comprise anyone of the processing steps described above or in the embodiments described below in more detail.
The embodiments also disclose a computer program comprising instructions which when, carried out on a processor, cause the processor to transfer motion information obtained from a plurality of sensors to a common representation. The computer program may comprise instructions to perform any one of the processing steps described above or in the embodiments described below in more detail. The embodiments also disclose a tangible computer-readable medium that stores a computer program comprising instructions which, when carried out on a processor, cause the processor to transfer motion information obtained from a plurality of sensors to a common representation. The tangible computer-readable medium may store a computer program comprising instructions to perform anyone of the processing steps described above or in the embodiments described below in more detail.
The embodiments are now described in more detail with reference to the accompanying drawings.
Fig. 1 schematically describes the generation of a fused motion map by fusing data of a Doppler radar and data obtained from scene flow estimation based on images of a stereo camera. At 101, a Doppler radar generates raw data 111. At 102, the raw data is processed to produce processed data 112 such as range, angle and speed data by calibration, FFT, beam- forming, etc. The processed data 112 may for example be a two-dimensional array in polar coordinates r, φ, or a three-dimensional array with axes related to polar position coordinates r and φ as well as radial velocity vr. At 103, the processed data 112 is aligned to a motion map 113. This alignment transfers the motion information contained in the processed data to a common representation. At 201, a stereo camera produces raw images 211. At 202, the raw images 211 are processed by calibration, stereo & motion estimation (scene flow estimation), etc. whereby processed data 212 in the form of 3d points and 3d velocities are produced. At 203, the processed data 212 are aligned to generate a motion map 204. This alignment transfers the motion information obtained from camera images to a common representation. Both motion maps 104 and 204 are fused in 301 to create a fused motion map 302 in which both data are combined. Data association is given by the assignment of data to cells of the motion map during data alignment in 103 and 203.
Fig. 2 shows in more detail the alignment 103 of the processed data 112 from the Doppler radar in order to generate motion map 104. The processed data 112 is represented as
Figure imgf000007_0005
where V denote the polar coordinates of a cell in the polar coordinate space ( and V are
Figure imgf000007_0007
Figure imgf000007_0006
the angular and radial component of the velocity attributed to the cell. As state-of-the-art radars do not provide information on
Figure imgf000007_0008
, the component can be modelled to be zero and to have an
Figure imgf000007_0009
infinite uncertainty. Alternatively, for Doppler radar, could also be removed from the model. In
Figure imgf000007_0010
the alignment process 103 a position/velocity reconstruction and an error model for motion is applied to the processed data 112 to obtain the motion map 104. The motion map space is represented by spatial coordinates (x, z). Data in the motion map is represented by
Figure imgf000007_0004
where X, z are 2d Cartesian coordinates in the motion map,
Figure imgf000007_0003
are the mean values of a normal distribution describing a velocity estimate and z is the respective covariance matrix
Figure imgf000007_0001
Figure imgf000007_0002
that represents the uncertainty of the motion measurement obtained from a sensor-specific error model. As represented by 105 in Fig. 2, with a Doppler radar, the error \ in the radial direction
Figure imgf000008_0006
of the velocity space is smaller than the error∑ in the angular direction of the velocity
Figure imgf000008_0005
Figure imgf000008_0004
space
Figure imgf000008_0003
Fig. 3 shows in more detail the alignment 203 of the processed data 212 from the stereo camera in order to generate motion map 204. The processed data 212 is represented as
Figure imgf000008_0007
where px, py are image positions (pixel coordinates) in the image space , and D represents
Figure imgf000008_0008
disparity data at a first point in time, D' represents disparity data at a second point in time, and ux, Uy represents the displacement of a point in a camera view (e.g. left camera). In the alignment process 203 a 3d position/velocity reconstruction, a projection to motion map coordinates, and an error model for motion is applied to the processed data 212 to obtain the motion map 204. The motion map space is represented by spatial coordinates (x, z) . Again, data in the motion map is represented by where X, z are 2d Cartesian coordinates in the motion map,
Figure imgf000008_0001
are the mean values of a normal distribution describing a velocity estimate ( and
Figure imgf000008_0002
Figure imgf000008_0009
Figure imgf000008_0010
is the covariance matrix that represents the uncertainty of the motion measurement obtained from a sensor-specific error model. As represented by 205 in Fig. 3, with a stereo camera, the uncertainty of the velocity is typically smaller in the angular direction compared to the radial direction in the velocity space.
Fig. 4 shows in more detail the process 301 of fusing the motion map 104 obtained from data of a Doppler radar and the motion map 204 obtained from data of a scene flow analysis of stereo camera images in order to obtain a fused motion map 302. According to this example, the motion map 104 is a 2d grid representation in spatial coordinates {x, z) of the processed data 212 after alignment and the motion map 204 is a 2d grid representation in spatial coordinates {x, z) of the processed data 212 after alignment. Fusion 301 merges the information cell-wise by determining for each cell a joint probability for the velocity . The fused motion map 302 is, again, a 2d grid representation in
Figure imgf000008_0011
spatial coordinates
Figure imgf000008_0012
Fig. 5a schematically shows the uncertainty of a single velocity measurement as seen by a scene flow analysis (stereo camera). The figure shows the spatial resolution uncertainty of the observed velocity of the stereo camera in the associated motion map. The motion map stores in cell 214 the 2d mean value and the uncertainty of the z velocity vector, indicated by a probability distribution 215. The probability distribution 215 represents a sensor-specific error model that encodes 2d velocity uncertainty as a covariance matrix The actual velocity of an object in cell 214 is indicated by
Figure imgf000008_0013
velocity vector 211. A velocity measurement of the stereo camera is indicated as a measured radial velocity component 212 and a measured angular velocity component 213. The stereo camera-based scene flow analysis has a better velocity precision in angular direction than in radial direction so that the uncertainty in the radial direction is larger than in the angular direction. Accordingly, the probability distribution 215 is represented in Fig. 5a by an ellipse that is narrower in radial direction than in angular direction.
Fig. 5b schematically shows the uncertainty of a single velocity measurement as seen by a Doppler radar. The figure shows the spatial resolution uncertainty of the Doppler radar in the associated motion map. The motion map stores in cell 114 an x-z velocity vector and its respective uncertainty, indicated by a probability distribution 115. The probability distribution 115 represents a sensor- specific error model that encodes 2d velocity uncertainty as a covariance matrix∑Vx Vz. The actual velocity of an object in cell 114 is indicated by velocity vector 111. A velocity measurement of the Doppler radar is indicated as a measured radial velocity component 112. The Doppler radar has a good velocity resolution in radial direction but the angular velocity component is typically not observable. Accordingly, the probability distribution 215 is represented in Fig. 5b by an ellipse that is narrow in radial direction but very large in angular direction.
Fig 5c shows the reduced velocity measurement uncertainty in a fused motion map generated by fusing the aligned data of a Doppler radar and a stereo camera. The figure shows the uncertainty of the spatial resolution of the fused data in the fused motion map. The fused motion map stores in cell 314 an x-z velocity vector and its respective uncertainty, indicated by a probability distribution 315. The actual velocity of an object in cell 314 is indicated by velocity vector 311. A fused velocity measurement of the stereo camera is indicated as a radial velocity component 312 and an angular velocity component 313. As the camera and radar based measurements provide information on motion with complementary precision, the fused data has a good velocity resolution in radial direction and in axial direction. Accordingly, the probability distribution 315 of the fused measurement is represented in Fig. 5c by an ellipse that is narrow in radial direction and narrow in angular direction. The result is (under ideal conditions) a measurement with low uncertainty in both radial and angular direction.
Fig. 6 shows an example of a motion map derived from Doppler radar measurements. In this visualization the brightness indicates velocity value. In alternative visualizations of a motion map, the information stored for each cell might be color-encoded as following: color saturation indicates the precision (unsaturated = zero precision), and brightness and hue indicate velocity value (black = zero speed) and direction (blue=up, yellow=down, magenta=left, green=right), respectively. The Doppler radar has a good velocity resolution in radial direction but the angular velocity component is not observable. Fig. 7 shows an example of a motion map derived from scene flow measurements based on images captured by a stereo camera. The scene flow analysis has a better velocity resolution in angular direction than in radial direction, so that the uncertainty in the radial direction is larger than in the angular direction. Fig. 8 shows an example of a fused motion map that combines the motion map of Fig. 6 obtained by a Doppler radar with the motion map of Fig. 7 obtained by scene flow analysis based on images captured by a stereo camera. The result is a measurement with low uncertainty in both radial and angular direction.
Motion map representation For every grid cell we assume that the velocities V of contacts in this cell follow a normal distribution:
Figure imgf000010_0001
That is, for each cell of the motion map we have one speed estimate from scene flow (s) and Doppler radar (r) each, encoded as 2d normal distribution:
Figure imgf000010_0007
It should be noted here that a scene flow speed estimate as described above may possibly be fused from several scene flow measurements, and that a Doppler radar estimate as described above may possibly be fused from several Doppler radar measurements.
"Auxiliary" representation of motion map
According to an alternative representation which is, in implementation, more efficient for fusion (in the following called "auxiliary" representation) the parameters μ of the normal distribution are
Figure imgf000010_0006
represented as follows:
Figure imgf000010_0002
Accordingly, the covariance matrix is represented by a precision which is positive
Figure imgf000010_0005
ly semidefinite and by
Figure imgf000010_0004
The conversion from the "auxiliary" representation to the normal representation is performed by:
Figure imgf000010_0003
Motion map fusion
Assuming two motion maps comprising information from sensors "a" and "b", given two distributions for V in the same cell:
Figure imgf000011_0002
where μα, μ¾ are the respective mean values of the normal distribution N and are the
Figure imgf000011_0003
respective covariance matrices of the normal distribution N.
These distributions are fused as
with
Figure imgf000011_0001
In the auxiliary representation, these distributions are represented by:
Figure imgf000011_0004
and using the auxiliary representation, the fusing reads as:
Figure imgf000011_0005
Transformation of Doppler radar information to motion map
In the following, the process of aligning (103 in Fig. 1) the processed data (112 in Fig. 1) of the Doppler radar to obtain a motion map (104 in Fig. 1) of the Doppler radar data is explained in more detail.
For a given radar position in polar coordinates all considered radial velocities are provided
Figure imgf000011_0006
with a weight derived from the detection power. This information is encoded in a range-angle-
Figure imgf000011_0007
speed cube and during the aligning process, for each range-angle-pair, the radial velocity vr is computed as q-weighted average along the speed-dimensions, and there is computed a precision estimate σ of this information as RMS of q along the speed information.
Then, for each x-z-cell of the motion map the radial velocity and precision from the range-angle- map are interpolated, and the speed information is encoded as a 2d normal distribution with mean μν: speed vr in radial direction, speed 0 in angular direction and covariance∑v: eigenvalues: Oyr in radial direction, «∞ in angular direction.
For example, a motion model may be defined as follows:
Figure imgf000012_0002
Here, are parameters that define the precision of the position measurement and σγγ is
Figure imgf000012_0009
a parameter that defines the precision of the velocity measurements and is derived from q as described above. These precisions may be defined by the model according to the capabilities of the sensor. Here, we assume for simplicity:
Figure imgf000012_0003
However, in practice, any other definition may be used that represents the capabilities of the sensor in a better way.
After that, a position (x, z) in the coordinate system of the motion map is determined and the mean value and covariance for the normal distribution that define the speed are calculated as follows:
Figure imgf000012_0001
Here, A
Figure imgf000012_0006
is a predefined correction matrix and
Figure imgf000012_0007
is a predefined correction vector that correct for the relative sensor alignment.
Next, μν and∑v are converted to the auxiliary representation:
Figure imgf000012_0004
Finally, for each cell i with center position in the motion map coordinate system, there is
Figure imgf000012_0008
computed a weight
Figure imgf000012_0005
To iteratively accumulate information from multiple measurements for each cell a joint probability is computed by updating the velocity estimate (Pj, bi) in cell i with the new information
Figure imgf000013_0007
which is the information derived from the currently considered measurement associated to cell i. This amounts to computing the joint probability as
Figure imgf000013_0001
The information in cell i is then replaced by
Figure imgf000013_0002
Here, and may be initialized as (0,0) and
Figure imgf000013_0003
Transformation of scene flow information to motion map
In the following, the process of aligning (203 in Fig. 1) the processed data (212 in Fig. 1) of the scene flow (stereo camera) measurements to obtain a motion map (204 in Fig. 1) of the scene flow data is explained in more detail.
Given an image position in the image domain of the camera, measurements in this
Figure imgf000013_0005
position comprise:
Figure imgf000013_0004
All this information is given in a camera coordinate system, e.g. the left camera.
Based on this information, irrelevant contacts (road surface, sufficient headroom) are removed from the data. Only measurements for example 0 to 3m above road level are kept and a simple road model (pre-defined 3d plane) is used. To this end, the height of a point above the street is determined. If the point is on or below the street surface, then this measurement is ignored. If the point is above a safety headroom height, then the measurement is ignored. Otherwise, the measurement is maintained.
Then, 3d position and velocity measurements are projected to the 2d motion map using a simple road model. Also, alignment between camera and radar is corrected. A position (x, z) in the coordinate system of the motion map is determined, e.g. by assuming a street plane and projecting the model to 2x3 matrix A, 2x1 vector b as
Figure imgf000013_0006
Figure imgf000014_0003
Here, A, b also correct for the relative sensor alignment.
The measurements in combination with a 3d error model for position and speed (see section "Error Model for Scene Flow" below) also provide∑P and∑v, both 3x3 covariance matrices, which represent sensor-specific precision. For example, each measurement is encoded using a normal distribution. The mean μ is given by the measurement. The covariance∑ is given by the error model.∑P and∑v, both 3x3 covariance matrices, represent the sensor-specific precision:
Figure imgf000014_0001
Then μν and∑v are converted to the auxiliary representation:
Figure imgf000014_0004
Finally, for each cell i with center position the motion map coordinate system, it is computed a weight
Figure imgf000014_0012
Figure imgf000014_0005
To iteratively accumulate information from multiple measurements for each cell a joint probability is computed by updating the velocity estimate (
Figure imgf000014_0009
in cell i with the new information
Figure imgf000014_0010
which is the information derived from the currently considered measurement associated to cell
Figure imgf000014_0013
This amounts to computing the joint probability as
Figure imgf000014_0002
The information in cell /' is then replaced by ( .Here, b^ and P^ are initialized as
Figure imgf000014_0007
Figure imgf000014_0008
and
Figure imgf000014_0006
Error Model for Scene Flow
For the 3d error model used in the transformation of scene flow information to a motion map as described above, the computation of normal distributions for 3d position and 3d velocity
Figure imgf000014_0014
Figure imgf000014_0011
assumptions is as follows:
Information is recorded from four camera views: An image is obtained from a first (e.g. left) camera view CL and an image is obtained from a second (e.g. right) camera view CR at their position at a time t. Still further, an image is obtained from a first camera view C and from a second camera
Figure imgf000015_0002
view C R at their position at a time
Figure imgf000015_0001
, where T is the time difference between the camera views.
Then, the data from camera pairs {
Figure imgf000015_0003
is calibrated and rectified such that the baselines b (between
Figure imgf000015_0031
and CR) and b' (between
Figure imgf000015_0027
and
Figure imgf000015_0028
are known, and the intrinsic calibration K (valid for
Figure imgf000015_0029
and and K' (valid for and are known.
Figure imgf000015_0030
Figure imgf000015_0025
Figure imgf000015_0026
Given an image position in the image domain of the camera and measurements in this
Figure imgf000015_0004
position, a 3d position and a 3 are obtained
Figure imgf000015_0005
Figure imgf000015_0006
for every image position.
From the measurements, per pixel at position in camera the following information is
Figure imgf000015_0007
Figure imgf000015_0008
given:
• disparity D between a point in C and corresponding position
Figure imgf000015_0010
Figure imgf000015_0011
Figure imgf000015_0009
Figure imgf000015_0012
• displacement ( ) between a point in and the corresponding posi
Figure imgf000015_0035
Figure imgf000015_0014
Figure imgf000015_0015
tion
Figure imgf000015_0013
• disparity D' between a point and the corresponding point
Figure imgf000015_0017
Figure imgf000015_0016
Still further, covariance estimates and for measurement errors for
Figure imgf000015_0033
Figure imgf000015_0032
Figure imgf000015_0019
are determined, e.g. from experimental measurements.
Figure imgf000015_0018
Based on this information the following computations are performed:
There is computed (using as defined below) and returned a distribution for 3d position P, given
Figure imgf000015_0034
by
Figure imgf000015_0020
where (
Figure imgf000015_0021
Still further, there is computed a distribution for P
Figure imgf000015_0023
given by
Figure imgf000015_0022
And there is computed a distribution of the 3d velocity , given by
Figure imgf000015_0024
(linear combination of random variables):
Figure imgf000016_0001
• The previous computations utilize an auxiliary function which is
Figure imgf000016_0004
computed as follows. Given:the pixel position in the first camera,
Figure imgf000016_0005
• the disparity D between a point in the first camera and corresponding position
Figure imgf000016_0006
in a second camera,
Figure imgf000016_0007
• 3x3 matrix K, describing the intrinsic camera parameters of both the first and second camera,
• baseline b describing the distance between the origins of the coordinate systems of the first and second camera, and
• 3x3 covariance matrix describing an estimate of the errors in D
Figure imgf000016_0014
Figure imgf000016_0015
there is computed the parameters of an approximate normal distribution of a point
Figure imgf000016_0017
reconstructed via triangulation between the first and second camera.
The point X is reconstructed in the coordinate system of the first camera, such that X
Figure imgf000016_0016
with parameters computed as follows:
We introduce an auxiliary function: X (stereo reconstruc
Figure imgf000016_0002
tion via triangulation)
Then assuming to be normally distributed with we get (error propaga
Figure imgf000016_0009
Figure imgf000016_0010
tion):
Figure imgf000016_0008
where is the 3x3 Jacobian matrix of X(d, X, y) evaluated at position
Figure imgf000016_0012
Figure imgf000016_0011
Here, the Jacobian matrix
Figure imgf000016_0013
is given by (first order component-wise derivatives)
Figure imgf000016_0003
The thus obtained parameters μ,∑ returned by f can now be used in the transformation of scene flow information to a motion map as described above.
Implementation
The technology according to the embodiments of the present disclosure is applicable to various products. For example, the technology according to an embodiment of the present disclosure may be implemented as a device included in a mobile body that is any of kinds of automobiles, electric vehicles, hybrid electric vehicles, motorcycles, bicycles, personal mobility vehicles, airplanes, drones, ships, robots, construction machinery, agricultural machinery (tractors), and the like.
Fig. 9 is a block diagram depicting an example of schematic configuration of a vehicle control system 7000 as an example of a mobile body control system to which the technology according to an embodiment of the present disclosure can be applied. The vehicle control system 7000 includes a plurality of electronic control units connected to each other via a communication network 7010. In the example depicted in Fig. 9, the vehicle control system 7000 includes a driving system control unit 7100, a body system control unit 7200, a battery control unit 7300, an outside-vehicle information detecting unit 7400, an in-vehicle information detecting unit 7500, and an integrated control unit 7600. The communication network 7010 connecting the plurality of control units to each other may, for example, be a vehicle-mounted communication network compliant with an arbitrary standard such as controller area network (CAN), local interconnect network (LIN), local area network (LAN), FlexRay (registered trademark), or the like.
Each of the control units includes: a microcomputer that performs arithmetic processing according to various kinds of programs; a storage section that stores the programs executed by the microcomputer, parameters used for various kinds of operations, or the like; and a driving circuit that drives various kinds of control target devices. Each of the control units further includes: a network interface (I/F) for performing communication with other control units via the communication network 7010; and a communication I/F for performing communication with a device, a sensor, or the like within and without the vehicle by wire communication or radio communication. A functional configuration of the integrated control unit 7600 illustrated in Fig. 9 includes a microcomputer 7610, a general-purpose communication I/F 7620, a dedicated communication I/F 7630, a positioning section 7640, a beacon receiving section 7650, an in-vehicle device I/F 7660, a sound/image output section 7670, a vehicle-mounted network I/F 7680, and a storage section 7690. The other control units similarly include a microcomputer, a communication I/F, a storage section, and the like.
The driving system control unit 7100 controls the operation of devices related to the driving system of the vehicle in accordance with various kinds of programs. For example, the driving system control unit 7100 functions as a control device for a driving force generating device for generating the driving force of the vehicle, such as an internal combustion engine, a driving motor, or the like, a driving force transmitting mechanism for transmitting the driving force to wheels, a steering mechanism for adjusting the steering angle of the vehicle, a braking device for generating the braking force of the vehicle, and the like. The driving system control unit 7100 may have a function as a control device of an antilock brake system (ABS), electronic stability control (ESC), or the like.
The driving system control unit 7100 is connected with a vehicle state detecting section 7110. The vehicle state detecting section 7110, for example, includes at least one of a gyro sensor that detects the angular velocity of axial rotational movement of a vehicle body, an acceleration sensor that detects the acceleration of the vehicle, and sensors for detecting an amount of operation of an accelerator pedal, an amount of operation of a brake pedal, the steering angle of a steering wheel, an engine speed or the rotational speed of wheels, and the like. The driving system control unit 7100 performs arithmetic processing using a signal input from the vehicle state detecting section 7110, and controls the internal combustion engine, the driving motor, an electric power steering device, the brake device, and the like.
The body system control unit 7200 controls the operation of various kinds of devices provided to the vehicle body in accordance with various kinds of programs. For example, the body system control unit 7200 functions as a control device for a keyless entry system, a smart key system, a power window device, or various kinds of lamps such as a headlamp, a backup lamp, a brake lamp, a turn signal, a fog lamp, or the like. In this case, radio waves transmitted from a mobile device as an alternative to a key or signals of various kinds of switches can be input to the body system control unit 7200. The body system control unit 7200 receives these input radio waves or signals, and controls a door lock device, the power window device, the lamps, or the like of the vehicle.
The battery control unit 7300 controls a secondary battery 7310, which is a power supply source for the driving motor, in accordance with various kinds of programs. For example, the battery control unit 7300 is supplied with information about a battery temperature, a battery output voltage, an amount of charge remaining in the battery, or the like from a battery device including the secondary battery 7310. The battery control unit 7300 performs arithmetic processing using these signals, and performs control for regulating the temperature of the secondary battery 7310 or controls a cooling device provided to the battery device or the like.
The outside-vehicle information detecting unit 7400 detects information about the outside of the vehicle including the vehicle control system 7000. For example, the outside-vehicle information detecting unit 7400 is connected with at least one of an imaging section 7410 and an outside-vehicle information detecting section 7420. The imaging section 7410 includes at least one of a time-of- flight (ToF) camera, a stereo camera, a monocular camera, an infrared camera, and other cameras. The outside-vehicle information detecting section 7420, for example, includes at least one of an environmental sensor for detecting current atmospheric conditions or weather conditions and a peripheral information detecting sensor for detecting another vehicle, an obstacle, a pedestrian, or the like on the periphery of the vehicle including the vehicle control system 7000.
The environmental sensor, for example, may be at least one of a rain drop sensor detecting rain, a fog sensor detecting fog, a sunshine sensor detecting a degree of sunshine, and a snow sensor detecting snowfall. The peripheral information detecting sensor may be at least one of an ultrasonic sensor, a radar device, and a LiDAR device (Light Detection and Ranging device, or Laser imaging detection and ranging device). Each of the imaging section 7410 and the outside-vehicle information detecting section 7420 may be provided as an independent sensor or device, or may be provided as a device in which a plurality of sensors or devices are integrated.
Fig. 10 depicts an example of installation positions of the imaging section 7410 and the outside- vehicle information detecting section 7420. Imaging sections 7910, 7912, 7914, 7916, and 7918 are, for example, disposed at at least one of positions on a front nose, sideview mirrors, a rear bumper, and a back door of the vehicle 7900 and a position on an upper portion of a windshield within the interior of the vehicle. The imaging section 7910 provided at the front nose and the imaging section 7918 provided at the upper portion of the windshield within the interior of the vehicle obtain mainly an image of the front of the vehicle 7900. The imaging sections 7912 and 7914 provided at the sideview mirrors obtain mainly an image of the sides of the vehicle 7900. The imaging section 7916 provided at the rear bumper or the back door obtains mainly an image of the rear of the vehicle 7900. The imaging section 7918 provided at the upper portion of the windshield within the interior of the vehicle is used mainly to detect a preceding vehicle, a pedestrian, an obstacle, a signal, a traffic sign, a lane, or the like.
Incidentally, Fig. 10 depicts an example of photographing ranges of the respective imaging sections 7910, 7912, 7914, and 7916. An imaging range a represents the imaging range of the imaging section 7910 provided at the front nose. Imaging ranges b and c respectively represent the imaging ranges of the imaging sections 7912 and 7914 provided at the sideview mirrors. An imaging range d represents the imaging range of the imaging section 7916 provided at the rear bumper or the back door. A bird's-eye image of the vehicle 7900 as viewed from above can be obtained by superimposing image data imaged by the imaging sections 7910, 7912, 7914, and 7916, for example.
Outside-vehicle information detecting sections 7920, 7922, 7924, 7926, 7928, and 7930 provided at the front, rear, sides, and corners of the vehicle 7900 and the upper portion of the windshield within the interior of the vehicle may be, for example, an ultrasonic sensor or a radar device. The outside- vehicle information detecting sections 7920, 7926, and 7930 provided at the front nose of the vehicle 7900, the rear bumper, the back door of the vehicle 7900, and the upper portion of the windshield within the interior of the vehicle may be a LiDAR device, for example. These outside- vehicle information detecting sections 7920 to 7930 are used mainly to detect a preceding vehicle, a pedestrian, an obstacle, or the like.
Returning to Fig. 9, the description will be continued. The outside-vehicle information detecting unit 7400 causes the imaging section 7410 to produce an image of the outside of the vehicle, and receives produced image data. In addition, the outside-vehicle information detecting unit 7400 receives detection information from the outside-vehicle information detecting section 7420 connected to the outside-vehicle information detecting unit 7400. In a case where the outside-vehicle information detecting section 7420 is an ultrasonic sensor, a radar device, or a LIDAR device, the outside-vehicle information detecting unit 7400 transmits an ultrasonic wave, an electromagnetic wave, or the like, and receives information of a received reflected wave. On the basis of the received information, the outside-vehicle information detecting unit 7400 may perform processing of detecting an object such as a human, a vehicle, an obstacle, a sign, a character on a road surface, or the like, or processing of detecting a distance thereto. The outside-vehicle information detecting unit 7400 may perform environment recognition processing of recognizing rain, fog, road surface conditions, or the like on the basis of the received information. The outside-vehicle information detecting unit 7400 may calculate a distance to an object outside the vehicle on the basis of the received information.
In addition, on the basis of the received image data, the outside-vehicle information detecting unit 7400 may perform image recognition processing of recognizing a human, a vehicle, an obstacle, a sign, a character on a road surface, or the like, or processing of detecting a distance thereto. The outside-vehicle information detecting unit 7400 may subject the received image data to processing such as distortion correction, alignment, or the like, and combine the image data imaged by a plurality of different imaging sections 7410 to generate a bird's-eye image or a panoramic image. The outside-vehicle information detecting unit 7400 may perform viewpoint conversion processing using the image data imaged by the imaging section 7410 including the different imaging parts.
The in- vehicle information detecting unit 7500 detects information about the inside of the vehicle. The in- vehicle information detecting unit 7500 is, for example, connected with a driver state detecting section 7510 that detects the state of a driver. The driver state detecting section 7510 may include a camera that images the driver, a biosensor that detects biological information on the driver, a microphone that collects sound within the interior of the vehicle, or the like. The biosensor is, for example, disposed in a seat surface, the steering wheel, or the like, and detects biological information on an occupant sitting in a seat or the driver holding the steering wheel. On the basis of detection information input from the driver state detecting section 7510, the in-vehicle information detecting unit 7500 may calculate a degree of fatigue of the driver or a degree of concentration of the driver, or may determine whether the driver is dozing. The in-vehicle information detecting unit 7500 may subject an audio signal obtained by the collection of the sound to processing such as noise canceling processing or the like.
The integrated control unit 7600 controls general operation within the vehicle control system 7000 in accordance with various kinds of programs. The integrated control unit 7600 is connected with an input section 7800. The input section 7800 is implemented by a device capable of input operation by an occupant, such, for example, as a touch panel, a button, a microphone, a switch, a lever, or the like. The integrated control unit 7600 may be supplied with data obtained by voice recognition of voice input through the microphone. The input section 7800 may, for example, be a remote control device using infrared rays or other radio waves, or an external connecting device such as a mobile telephone, a personal digital assistant (PDA), or the like that supports operation of the vehicle control system 7000. The input section 7800 may be, for example, a camera. In that case, an occupant can input information by gesture. Alternatively, data may be input which is obtained by detecting the movement of a wearable device that an occupant wears. Further, the input section 7800 may, for example, include an input control circuit or the like that generates an input signal on the basis of information input by an occupant or the like using the above-described input section 7800, and which outputs the generated input signal to the integrated control unit 7600. An occupant or the like inputs various kinds of data or gives an instruction for processing operation to the vehicle control system 7000 by operating the input section 7800.
The storage section 7690 may include a read only memory (ROM) that stores various kinds of programs executed by the microcomputer and a random access memory (RAM) that stores various kinds of parameters, operation results, sensor values, or the like. In addition, the storage section 7690 may be implemented by a magnetic storage device such as a hard disc drive (HDD) or the like, a semiconductor storage device, an optical storage device, a magneto-optical storage device, or the like.
The general-purpose communication I/F 7620 is a communication I/F used widely, which communication I/F mediates communication with various apparatuses present in an external environment 7750. The general-purpose communication I/F 7620 may implement a cellular communication protocol such as global system for mobile communications (GSM (registered trademark)), worldwide interoperability for microwave access (WiMAX (registered trademark)), long term evolution (LTE (registered trademark)), LTE-advanced (LTE-A), or the like, or another wireless communication protocol such as wireless LAN (referred to also as wireless fidelity (Wi-Fi (registered trade- mark)), Bluetooth (registered trademark), or the like. The general-purpose communication I/F 7620 may, for example, connect to an apparatus (for example, an application server or a control server) present on an external network (for example, the Internet, a cloud network, or a company-specific network) via a base station or an access point. In addition, the general-purpose communication I/F 7620 may connect to a terminal present in the vicinity of the vehicle (which terminal is, for example, a terminal of the driver, a pedestrian, or a store, or a machine type communication (MTC) terminal) using a peer to peer (P2P) technology, for example.
The dedicated communication I/F 7630 is a communication I/F that supports a communication protocol developed for use in vehicles. The dedicated communication I/F 7630 may implement a standard protocol such as, for example, wireless access in vehicle environment (WAVE), which is a combination of institute of electrical and electronic engineers (ΊΕΕΕ) 802.1 lp as a lower layer and IEEE 1609 as a higher layer, dedicated short range communications (DSRC), or a cellular communication protocol. The dedicated communication I/F 7630 typically carries out V2X communication as a concept including one or more of communication between a vehicle and a vehicle (Vehicle to Vehicle), communication between a road and a vehicle (Vehicle to Infrastructure), communication between a vehicle and a home (V ehicle to Home), and communication between a pedestrian and a vehicle (Vehicle to Pedestrian).
The positioning section 7640, for example, performs positioning by receiving a global navigation satellite system (GNSS) signal from a GNSS satellite (for example, a GPS signal from a global positioning system (GPS) satellite), and generates positional information including the latitude, longitude, and altitude of the vehicle. Incidentally, the positioning section 7640 may identify a current position by exchanging signals with a wireless access point, or may obtain the positional information from a terminal such as a mobile telephone, a personal Handy-phone system (PHS), or a smart phone that has a positioning function.
The beacon receiving section 7650, for example, receives a radio wave or an electromagnetic wave transmitted from a radio station installed on a road or the like, and thereby obtains information about the current position, congestion, a closed road, a necessary time, or the like. Incidentally, the function of the beacon receiving section 7650 may be included in the dedicated communication I/F 7630 described above.
The in-vehicle device I/F 7660 is a communication interface that mediates connection between the microcomputer 7610 and various in-vehicle devices 7760 present within the vehicle. The in-vehicle device I/F 7660 may establish wireless connection using a wireless communication protocol such as wireless LAN, Bluetooth (registered trademark), near field communication (NFC), or wireless universal serial bus (WUSB). In addition, the in-vehicle device I/F 7660 may establish wired connection by universal serial bus (USB), high-definition multimedia interface (HDMI (registered trademark)), mobile high-definition link (MHL), or the like via a connection terminal (and a cable if necessary) not depicted in the figures. The in-vehicle devices 7760 may, for example, include at least one of a mobile device and a wearable device possessed by an occupant and an information device carried into or attached to the vehicle. The in-vehicle devices 7760 may also include a navigation device that searches for a path to an arbitrary destination. The in-vehicle device I/F 7660 exchanges control signals or data signals with these in-vehicle devices 7760.
The vehicle-mounted network I/F 7680 is an interface that mediates communication between the microcomputer 7610 and the communication network 7010. The vehicle-mounted network I/F 7680 transmits and receives signals or the like in conformity with a predetermined protocol supported by the communication network 7010.
The microcomputer 7610 of the integrated control unit 7600 controls the vehicle control system 7000 in accordance with various kinds of programs on the basis of information obtained via at least one of the general-purpose communication I/F 7620, the dedicated communication I/F 7630, the positioning section 7640, the beacon receiving section 7650, the in-vehicle device I/F 7660, and the vehicle-mounted network I/F 7680. For example, the microcomputer 7610 may calculate a control target value for the driving force generating device, the steering mechanism, or the braking device on the basis of the obtained information about the inside and outside of the vehicle, and output a control command to the driving system control unit 7100. For example, the microcomputer 7610 may perform cooperative control intended to implement functions of an advanced driver assistance system (ADAS) which functions include collision avoidance or shock mitigation for the vehicle, following driving based on a following distance, vehicle speed maintaining driving, a warning of collision of the vehicle, a warning of deviation of the vehicle from a lane, or the like. In addition, the microcomputer 7610 may perform cooperative control intended for automatic driving, which causes the vehicle to travel autonomously without depending on the operation of the driver, or the like, by controlling the driving force generating device, the steering mechanism, the braking device, or the like on the basis of the obtained information about the surroundings of the vehicle.
The microcomputer 7610 may generate three-dimensional distance information between the vehicle and an object such as a surrounding structure, a person, or the like, and generate local map information including information about the surroundings of the current position of the vehicle, on the basis of information obtained via at least one of the general-purpose communication I/F 7620, the dedicated communication I/F 7630, the positioning section 7640, the beacon receiving section 7650, the in-vehicle device I/F 7660, and the vehicle-mounted network I/F 7680. In addition, the microcomputer 7610 may predict danger such as collision of the vehicle, approaching of a pedestri- an or the like, an entry to a closed road, or the like on the basis of the obtained information, and generate a warning signal. The warning signal may, for example, be a signal for producing a warning sound or lighting a warning lamp.
The sound/image output section 7670 transmits an output signal of at least one of a sound and an image to an output device capable of visually or acoustically notifying an occupant of the vehicle or the outside of the vehicle. In the example of Fig. 9, an audio speaker 7710, a display section 7720, and an instrument panel 7730 are illustrated as the output device. The display section 7720 may, for example, include at least one of an on-board display and a head-up display. The display section 7720 may have an augmented reality (AR) display function. The output device may be other than these devices, and may be another device such as headphones, a wearable device such as an eyeglass type display worn by an occupant or the like, a projector, a lamp, or the like. In a case where the output device is a display device, the display device visually displays results obtained by various kinds of processing performed by the microcomputer 7610 or information received from another control unit in various forms such as text, an image, a table, a graph, or the like. In addition, in a case where the output device is an audio output device, the audio output device converts an audio signal constituted of reproduced audio data or sound data or the like into an analog signal, and acoustically outputs the analog signal.
Incidentally, at least two control units connected to each other via the communication network 7010 in the example depicted in Fig. 9 may be integrated into one control unit. Alternatively, each individual control unit may include a plurality of control units. Further, the vehicle control system 7000 may include another control unit not depicted in the figures. In addition, part of or all the functions performed by one of the control units in the above description may be assigned to another control unit. That is, predetermined arithmetic processing may be performed by any of the control units as long as information is transmitted and received via the communication network 7010. Similarly, a sensor or a device connected to one of the control units may be connected to another control unit, and a plurality of control units may mutually transmit and receive detection information via the communication network 7010.
Incidentally, a computer program for realizing the functions described in this disclosure can be implemented in integrated control unit 7600, or the like. In addition, a computer readable recording medium storing such a computer program can also be provided. The recording medium is, for example, a magnetic disk, an optical disk, a magneto-optical disk, a flash memory, or the like. In addition, the above-described computer program may be distributed via a network, for example, without the recording medium being used.
In addition, at least part of the constituent elements of the integrated control unit 7600 described with reference to Fig. 9 may be implemented in a module (for example, an integrated circuit module formed with a single die) for the integrated control unit 7600 depicted in Fig. 9. Alternatively, the integrated control unit 7600 described with reference to Fig. 9 may be implemented by a plurality of control units of a vehicle control system as depicted in Fig. 9.
***
The methods as described herein are also implemented in some embodiments as a computer program causing a computer and/ or a processor and/ or a circuitry to perform the method, when being carried out on the computer and/ or processor and/ or circuitry. In some embodiments, also a non-transitory computer-readable recording medium is provided that stores therein a computer program product, which, when executed by a processor/ circuitry, such as the processor/ circuitry described above, causes the methods described herein to be performed.
It should be noted that the embodiments describe methods with an exemplary order of method steps. The specific order of method steps is, however, given for illustrative purposes only and should not be construed as binding.
It should also be noted that the division of the control or circuitry of Fig. 9 into units 931 to 940 is only made for illustration purposes and that the present disclosure is not limited to any specific division of functions in specific units. For instance, at least parts of the circuitry could be implemented by a respective programmed processor, field programmable gate array (FPGA), dedicated circuits, and the like.
All units and entities described in this specification and claimed in the appended claims can, if not stated otherwise, be implemented as integrated circuit logic, for example on a chip, and functionality provided by such units and entities can, if not stated otherwise, be implemented by software.
In so far as the embodiments of the disclosure described above are implemented, at least in part, using a software-controlled data processing apparatus, it will be appreciated that a computer program providing such software control and a transmission, storage or other medium by which such a computer program is provided are envisaged as aspects of the present disclosure.
Note that the present technology can also be configured as described below.
(1) An apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
(2) The apparatus of (1) wherein the common representation is a motion map.
(3) The apparatus of anyone of (1) or (2) wherein data association is given by the assignment of data to cells of the motion map. (4) The apparatus of anyone of (1) to (3) wherein the circuitry is configured to fuse the data of a Doppler radar and a stereo camera into a common representation.
(5) The apparatus of anyone of (1) to (4) wherein the circuitry is configured to transfer to the common representation motion information obtained from a Doppler radar.
(6) The apparatus of (4) or (5) wherein the motion information obtained from the Doppler radar comprises polar coordinates of a cell in the polar coordinate space and angular and radial components of the velocity attributed to the cell.
(7) The apparatus of anyone of (1) to (6) wherein the circuitry is configured to transfer to the common representation motion information obtained by scene flow estimation on images captured by a stereo camera.
(8) The apparatus of (4) or (7) wherein the motion information obtained from scene flow estimation comprises image positions, disparity data and displacement data.
(9) The apparatus of anyone of (1) to (6) wherein the circuitry is configured to reconstruct position and velocity from sensor data to obtain a motion map of the sensor data.
(10) The apparatus of anyone of (1) to (9) wherein the circuitry is configured to apply an error model for motion on the processed data to obtain a motion map of the sensor data.
(11) The apparatus of anyone of (1) to (10) wherein the circuitry is configured to represent the motion map represented by \
Figure imgf000026_0002
where
Figure imgf000026_0003
are 2d Cartesian coordinates in the motion map, are the mean values of a normal distribution describing a velocity estimate and
Figure imgf000026_0004
Figure imgf000026_0006
is the covariance matrix that represents the information on the motion measurement obtained
Figure imgf000026_0005
from a sensor-specific error model.
(12) The apparatus of anyone of (1) to (11) wherein the circuitry is configured to fuse sensor data cell-wise by determining for each cell a joint probability for the velocity.
(13) The apparatus of anyone of (1) to (12) wherein the circuitry is configured to assume, for every grid cell of a motion map, that the velocity V of contacts in this cell follow a normal distribution.
(14) The apparatus of anyone of (1) to (13) wherein the circuitry is configured to transform parameters of an error model into an auxiliary representation P , b according to:
Figure imgf000026_0001
where μ is a mean value and∑ is a covariance matrix.
Figure imgf000027_0005
(15) The apparatus of anyone of (1) to (14) wherein the circuitry is configured to fuse information from sensors "
Figure imgf000027_0003
as
with
Figure imgf000027_0002
Figure imgf000027_0001
being two given distributions for V in the same cell and where μ are the respective mean values
Figure imgf000027_0006
of the normal distribution N and are the respective covariance matrices of the normal
Figure imgf000027_0004
distribution N.
(16) Vehicle control system comprising the apparatus of anyone of (1) to (15).
(17) Vehicle control system of (16) wherein the vehicle is a motor vehicle, an electric vehicle, a hybrid vehicle, a robot, an autonomous robot, a drone product, or an autonomous drone product.
(18) Advanced driver assistance system comprising the apparatus of anyone of (1) to (15).
(19) A method comprising transferring motion information obtained from a plurality of sensors of different or similar type to a common representation.
(20) A computer program comprising instructions which when carried out on a processor cause the processor to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
(21) A tangible and readable storage medium storing a computer program comprising instructions which when carried out on a processor cause the processor to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.

Claims

1. An apparatus comprising circuitry configured to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
2. The apparatus of claim 1 wherein the common representation is a motion map.
3. The apparatus of claim 2 wherein data association is given by the assignment of data to cells of the motion map.
4. The apparatus of claim 1 wherein the circuitry is configured to fuse the data of a Doppler radar and a stereo camera into a common representation.
5. The apparatus of claim 1 wherein the circuitry is configured to transfer to the common representation motion information obtained from a Doppler radar.
6. The apparatus of claim 4 wherein the motion information obtained from the Doppler radar comprises polar coordinates of a cell in the polar coordinate space and angular and radial components of the velocity attributed to the cell.
7. The apparatus of claim 1 wherein the circuitry is configured to transfer to the common representation motion information obtained by scene flow estimation on images captured by a stereo camera.
8. The apparatus of claim 4 wherein the motion information obtained from scene flow estimation comprises image positions, disparity data and displacement data.
9. The apparatus of claim 1 wherein the circuitry is configured to reconstruct position and velocity from sensor data to obtain a motion map of the sensor data.
10. The apparatus of claim 1 wherein the circuitry is configured to apply an error model for motion on the processed data to obtain a motion map of the sensor data.
11. The apparatus of claim 1 wherein the circuitry is configured to represent the motion map represented by wnere x, z are 2d Cartesian coordinates in the motion map,
Figure imgf000028_0001
Figure imgf000028_0004
are the mean values of a normal distribution describing a velocity estimate ( ) and is the
Figure imgf000028_0002
Figure imgf000028_0003
covariance matrix that represents the information on the motion measurement obtained from a sensor-specific error model.
12. The apparatus of claim 1 wherein the circuitry is configured to fuse sensor data cell-wise by determining for each cell a joint probability for the velocity.
13. The apparatus of claim 1 wherein the circuitry is configured to assume, for every grid cell of a motion map, that the velocity V of contacts in this cell follow a normal distribution.
14. The apparatus of claim 1 wherein the circuitry is configured to transform parameters of an error model into an auxiliary representation P, b according to:
Figure imgf000029_0001
where μ is a mean value and∑ is a covariance matrix.
15. The apparatus of claim 1 wherein the circuitry is configured to fuse information from sensors
Figure imgf000029_0003
" as
with
Figure imgf000029_0002
being two given distributions for V in the same cell and where are the respective mean values
Figure imgf000029_0005
of the normal distribution N and are the respective covariance matrices of the normal
Figure imgf000029_0004
distribution N.
16. Vehicle control system comprising the apparatus of claim 1.
17. Vehicle control system of claim 16 wherein the vehicle is a motor vehicle, an electric vehicle, a hybrid vehicle, a robot, an autonomous robot, a drone product, or an autonomous drone product.
18. Advanced driver assistance system comprising the apparatus of claim 1.
19. A method comprising transferring motion information obtained from a plurality of sensors of different or similar type to a common representation.
20. A computer program comprising instructions which when carried out on a processor cause the processor to transfer motion information obtained from a plurality of sensors of different or similar type to a common representation.
PCT/EP2018/064246 2017-06-02 2018-05-30 Apparatus, method and computer program for computer vision Ceased WO2018220048A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201880036346.3A CN110691986B (en) 2017-06-02 2018-05-30 Apparatus, method, and non-transitory computer-readable recording medium for computer vision
US16/610,911 US11255959B2 (en) 2017-06-02 2018-05-30 Apparatus, method and computer program for computer vision

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
EP17174267.9 2017-06-02
EP17174267 2017-06-02

Publications (1)

Publication Number Publication Date
WO2018220048A1 true WO2018220048A1 (en) 2018-12-06

Family

ID=58992754

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/EP2018/064246 Ceased WO2018220048A1 (en) 2017-06-02 2018-05-30 Apparatus, method and computer program for computer vision

Country Status (3)

Country Link
US (1) US11255959B2 (en)
CN (1) CN110691986B (en)
WO (1) WO2018220048A1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020157138A1 (en) * 2019-01-30 2020-08-06 Sony Corporation Object detection apparatus, system and method
WO2021109033A1 (en) 2019-12-04 2021-06-10 Huawei Technologies Co., Ltd. Apparatus and method for collecting and auto-labelling measurement data in traffic scenario

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112050829B (en) * 2019-06-06 2023-04-07 华为技术有限公司 Motion state determination method and device
US11753023B2 (en) * 2020-01-19 2023-09-12 Mitsubishi Electric Research Laboratories, Inc. Adaptive control of autonomous or semi-autonomous vehicle
CN112130136B (en) * 2020-09-11 2024-04-12 中国重汽集团济南动力有限公司 Comprehensive perception system and method for traffic targets
US11842546B2 (en) * 2021-05-13 2023-12-12 GM Global Technology Operations LLC Sensor fusion-based top-view three-dimensional stixel representation for general obstacle detection in a vehicle
KR102651012B1 (en) * 2021-11-24 2024-03-25 (주)스마트레이더시스템 4-Dimensional Radar Signal Processing Apparatus
US20230350050A1 (en) * 2022-04-27 2023-11-02 Toyota Research Institute, Inc. Method for generating radar projections to represent angular uncertainty
US12379483B2 (en) * 2022-11-29 2025-08-05 Cnh Industrial America Llc Agricultural vehicle with fused sensor vision
CN116256747A (en) * 2023-01-09 2023-06-13 奇瑞新能源汽车股份有限公司 An electric vehicle environmental perception system and method thereof
EP4459315A1 (en) * 2023-05-02 2024-11-06 Aptiv Technologies AG Method for calibration of a radar sensor

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2799902A1 (en) * 2013-04-30 2014-11-05 Baselabs GmbH Method and apparatus for the tracking of multiple objects
US20170097411A1 (en) * 2015-10-06 2017-04-06 GM Global Technology Operations LLC Radar-vision fusion for target velocity estimation
US20170109644A1 (en) * 2015-10-19 2017-04-20 Ford Global Technologies, Llc Probabilistic Inference Using Weighted-Integrals-And-Sums-By-Hashing For Object Tracking

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5414643A (en) * 1993-06-14 1995-05-09 Hughes Aircraft Company Method and apparatus for continuous time representation of multiple hypothesis tracking data
DE4408328C2 (en) * 1994-03-11 2002-09-26 Siemens Ag Method for setting up a cellularly structured environment map of a self-moving mobile unit, which is oriented with the aid of sensors based on wave reflection
DE19546506A1 (en) * 1995-12-13 1997-06-19 Daimler Benz Ag Vehicle navigation system and signal processing method for such a navigation system
US8050863B2 (en) * 2006-03-16 2011-11-01 Gray & Company, Inc. Navigation and control system for autonomous vehicles
US9373149B2 (en) 2006-03-17 2016-06-21 Fatdoor, Inc. Autonomous neighborhood vehicle commerce network and community
US8049658B1 (en) 2007-05-25 2011-11-01 Lockheed Martin Corporation Determination of the three-dimensional location of a target viewed by a camera
JP4533936B2 (en) * 2008-02-01 2010-09-01 日立オートモティブシステムズ株式会社 Image processing apparatus and vehicle detection apparatus including the same
US9472097B2 (en) 2010-11-15 2016-10-18 Image Sensing Systems, Inc. Roadway sensing systems
CN102303605A (en) * 2011-06-30 2012-01-04 中国汽车技术研究中心 Multi-sensor information fusion-based collision and departure pre-warning device and method
US10094855B1 (en) * 2013-06-24 2018-10-09 Peter Fuhr Frequency visualization apparatus and method
US9215382B1 (en) * 2013-07-25 2015-12-15 The United States Of America As Represented By The Secretary Of The Navy Apparatus and method for data fusion and visualization of video and LADAR data
FR3022049B1 (en) * 2014-06-06 2016-07-22 Inria Inst Nat De Rech En Informatique Et En Automatique METHOD FOR ANALYZING A DYNAMIC SCENE, ANALYSIS MODULE AND COMPUTER PROGRAM THEREOF
US9599706B2 (en) * 2015-04-06 2017-03-21 GM Global Technology Operations LLC Fusion method for cross traffic application using radars and camera
US10754922B2 (en) * 2015-04-23 2020-08-25 Lockheed Martin Corporation Method and apparatus for sensor fusion
JP2017156219A (en) * 2016-03-02 2017-09-07 沖電気工業株式会社 Tracking device, tracking method, and program

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2799902A1 (en) * 2013-04-30 2014-11-05 Baselabs GmbH Method and apparatus for the tracking of multiple objects
US20170097411A1 (en) * 2015-10-06 2017-04-06 GM Global Technology Operations LLC Radar-vision fusion for target velocity estimation
US20170109644A1 (en) * 2015-10-19 2017-04-20 Ford Global Technologies, Llc Probabilistic Inference Using Weighted-Integrals-And-Sums-By-Hashing For Object Tracking

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020157138A1 (en) * 2019-01-30 2020-08-06 Sony Corporation Object detection apparatus, system and method
US12125263B2 (en) 2019-01-30 2024-10-22 Sony Group Corporation Object detection apparatus, system and method using feature maps transformed into a template coordinate system
WO2021109033A1 (en) 2019-12-04 2021-06-10 Huawei Technologies Co., Ltd. Apparatus and method for collecting and auto-labelling measurement data in traffic scenario
CN113330331A (en) * 2019-12-04 2021-08-31 华为技术有限公司 Device and method for collecting and automatically marking measurement data in traffic scenes
EP4058825A4 (en) * 2019-12-04 2023-01-04 Huawei Technologies Co., Ltd. DEVICE AND METHOD FOR COLLECTING AND AUTOMATICALLY LABELING MEASUREMENT DATA IN A TRAFFIC SCENARIO

Also Published As

Publication number Publication date
US11255959B2 (en) 2022-02-22
CN110691986A (en) 2020-01-14
US20200158856A1 (en) 2020-05-21
CN110691986B (en) 2023-07-11

Similar Documents

Publication Publication Date Title
US11255959B2 (en) Apparatus, method and computer program for computer vision
US11055909B2 (en) Image processing device and image processing method
CN108139202B (en) Image processing apparatus, image processing method, and program
US20190004178A1 (en) Signal processing apparatus and signal processing method
US11127194B2 (en) Image processing apparatus and image processing method
CN111886626A (en) Signal processing apparatus, signal processing method, program, and moving object
US10587863B2 (en) Image processing apparatus, image processing method, and program
CN109196557A (en) Image processing device, image processing method, and vehicle
US11062170B2 (en) Information processing apparatus, information processing method, and imaging apparatus
US20190206014A1 (en) Image processing apparatus and image processing method
JP2018032986A (en) Information processing apparatus and method, vehicle, and information processing system
US20230119187A1 (en) Circuitry and method
US11436706B2 (en) Image processing apparatus and image processing method for improving quality of images by removing weather elements
EP4063896A1 (en) Radar data determination circuitry and radar data determination method
US12423836B2 (en) Camera-radar fusion using correspondences
EP4248422A1 (en) Time-of-flight object detection circuitry and time-of-flight object detection method
WO2021065510A1 (en) Information processing device, information processing method, information processing system, and program
US20240127042A1 (en) Information processing device, information processing system, information processing method, and recording medium
WO2022128985A1 (en) Time-of-flight image sensor circuitry and time-of-flight image sensor circuitry control method
CN117741575A (en) Generating 3D mesh map and point cloud using data fusion of mesh radar sensors
WO2024052392A1 (en) Circuitry and method

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 18726496

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 18726496

Country of ref document: EP

Kind code of ref document: A1