The present application relates generally to a warning sensor fusion system and the method thereof, and particularly to a mobile carrier warning sensor fusion system and the method thereof.
Traditional advanced driver assistance systems (ADAS) are developed to assist drivers and can be divided into three main parts: automotive sensors, automotive processors, and actuators. ADAS sense signals outside carriers using automotive sensors such as millimeter-wave radars, lidar, thermal sensors, and pressure sensors. The sensing data from automotive sensors are transmitted to automotive processors, for example, electronic control units (ECU), for producing warning information for drivers according to the sensing data and thus avoiding dangerous road conditions. Furthermore, automotive sensors can even intervene the drivers' driving operations directly and activating actuators for slowing, emergency braking, or turning cars and protecting drivers.
In addition, to protect drivers, radar detection technologies are developed to detect carrier surroundings. Unfortunately, radars cannot differentiate fixed or mobile objects surrounding a carrier. When an object not influencing the movement of the carrier approaches, radars still drive the warning unit to submit warning messages, inducing additional bother to drivers. Although the detection for surrounding obstacles of a carrier has been improved, in the moving process of the carrier, there still exists danger caused by other carriers. Moreover, there are more objects that can influence driving safety. For example, pedestrians, animals, and moving objects can be regarded as the obstacles for moving carriers. They will cause emergency situations in the moving process. The influence is worst in the crowded streets of cities.
Dash cams are developed to record color images under emergency situations for judgements afterwards. Unfortunately, they do not solve the root problem. To solve the problem, drivers should be able to prevent emergency situations. Current dash cams are disposed on the front and rear sides of a carrier. There still exist blind spots on both sides. It is required to have image equipment integrated with detection technologies for both sides for further assisting drivers to prevent blind spots. In addition, according to the detection for the lateral blind spots, dangers can be predicted and drivers can be notified for protecting them.
Dangerous situations of carriers will not occur only at crossroads. They will happen even in parking, especially when auto parking technologies are widely applied. ADAS alone is not sufficient to protect drivers. The prediction of dangers is also required.
Accordingly, the present application provides a system for sensing and responding to a lateral blind spot of a mobile carrier and the method thereof. By scanning the objects on one side of a mobile carrier, the corresponding object image will be given. Then the images are filtered to give filtered images that indicate influence on the carrier. According to the corresponding objects in the filtered images, the paths of the objects will be predicted. By modifying the moving route, the dangerous situations can be avoided.
An objective of the present application is to provide a system for sensing and responding to a lateral blind spot of a mobile carrier and the method thereof. By scanning the objects on one side of a carrier, the corresponding object image will be given. Then the images are filtered to give filtered images corresponding to the lateral blind spot of the mobile carrier. According to the corresponding objects in the filtered images, the paths of the objects will be predicted. By modifying the moving route, the dangerous situations can be avoided.
To achieve the above objective, the present application discloses a method for sensing and responding to a lateral blind spot of a mobile carrier. The mobile carrier includes a host connected to a light scanning unit and an image extraction unit. The host executes the steps of the method. First, the host executes a parking command corresponding to the mobile carrier for enabling the mobile carrier to park to the corresponding parking space. The host generates a positioning message according to the relative location or absolute location of the mobile carrier with respect to the parking space. Next, the host generates a first moving route according to the positioning message and the parking space. The light scanning unit scans one or more object at the parking space according to the first moving route. The image extraction unit extracts one or more object image correspondingly. Then, the host adopts an image optical flow method to classify the one or more object image and giving the corresponding one or more filtered image of the parking space. Afterwards, the host generates one or more predicted path according to the corresponding object vector of the one or more filtered image. Namely, the host predicts the path of the corresponding object of the one or more filtered image. Next, the host modifies the first moving route according to the one or more predicted path and generates a second moving route correspondingly. In other words, the host performs danger prediction on the blond spots of the mobile carrier and adjusts the corresponding moving route of the mobile carrier. Accordingly, the present application can provide danger prediction on lateral blind spots of a mobile carrier in the parking process and generates the corresponding modified moving route. Then the driving assistance system can intervene driving control according to the notification message and notifies the driver concurrently.
According to an embodiment of the present application, in the steps in which the light scanning unit scans one or more object at the parking space according to the first moving route and the image extraction unit extracts one or more object image correspondingly, the light scanning unit further scans the one or more object surrounding the parking space and the image extraction unit extracts the corresponding one or more object image surrounding the parking space.
According to an embodiment of the present application, in the steps in which the host adopts an image optical flow method to classify the one or more object image, the host extracts a plurality of three-dimensional images according to the one or more filtered image and classifies the one or more object image using the image optical flow method according to the positioning message.
According to an embodiment of the present application, in the step in which the host modifies the first moving route according to the one or more predicted path and generates a second moving route correspondingly, the host judges if a first effective area of the parking space is shrunk to a second effective area according to the one or more predicted path. The first effective area is greater than a carrier size of the mobile carrier. The second effective area is smaller than the carrier size. When the first effective area is shrunk to the second effective area, the second moving route guides the mobile carrier to park to a portion of the parking space.
According to an embodiment of the present application, in the step in which the host modifies the first moving route according to the one or more predicted path and generates a second moving route correspondingly, the host calculates according to a corresponding radius difference between inner wheels and a turning angle of the first moving route and the one or more predicted path and then modifies the first moving route and generates the second moving route correspondingly.
The present application further provides a system for sensing and responding to a lateral blind spot of a mobile carrier and the mobile carrier may set a host, a positioning unit, a light scanning unit, and an image extraction unit. The host is disposed in the mobile carrier. The light scanning unit and the image extraction unit are disposed on one side of the mobile carrier. The host executes a parking command corresponding to the mobile carrier for enabling the mobile carrier to park to the corresponding parking space. The host generates a positioning message according to the relative location or absolute location of the mobile carrier with respect to the parking space. Next, the host generates a first moving route according to the positioning message and the parking space. The light scanning unit scans one or more object at the parking space according to the first moving route. The image extraction unit extracts one or more object image correspondingly. Then, the host adopts an image optical flow method to classify the one or more object image and giving the corresponding one or more filtered image of the parking space. Afterwards, the host generates one or more predicted path according to the corresponding object vector of the one or more filtered image. Namely, the host predicts the path of the corresponding object of the one or more filtered image. Next, the host modifies the first moving route according to the one or more predicted path and generates a second moving route. In other words, the host performs danger prediction on the blond spots of the mobile carrier and adjusts the corresponding moving route of the mobile carrier. Accordingly, the present application can provide danger prediction on lateral blind spots of a mobile carrier in the parking process and generates the corresponding modified moving route. Then the driving assistance system can intervene driving control according to the notification message and notifies the driver concurrently.
According to an embodiment of the present application, the light scanning unit is a lidar or a radar scanner.
According to an embodiment of the present application, the light scanning unit further scans the one or more object surrounding the parking space and the image extraction unit extracts the one or more object image surrounding the parking space.
According to an embodiment of the present application, the host judges if a first effective area of the parking space is shrunk to a second effective area according to the one or more predicted path. The first effective area is greater than a carrier size of the mobile carrier. The second effective area is smaller than the carrier size. When the first effective area is shrunk to the second effective area, the second moving route guides the mobile carrier to park to a portion of the parking space.
According to an embodiment of the present application, the host calculates according to a corresponding radius difference between inner wheels and a turning angle of the first moving route and the one or more predicted path and then modifies the first moving route and generates the second moving route correspondingly.
According to an embodiment of the present application, the location of the lateral blind spot is a blind spot region corresponding to the parking space of the mobile carrier and defined by the intelligent transport system ISO 17387.
Since the radar system according to the prior art and dash cams cannot provide prediction of lateral blind spots of a mobile carrier, the present application provides a system for sensing and responding to a lateral blind spot of a mobile carrier and the method thereof for avoiding the dangerous situations caused by later blind spots of a mobile carrier.
In the following, the properties and the accompanying system of the mobile carrier warning sensor fusion system and the method thereof according to the present application will be further illustrated.
First, please refer to
Please refer to
In the step S10, as shown in
The host 10 executes the step S14. Please refer again to
The location of the lateral blind spot is a blind spot region corresponding to the parking space of the mobile carrier V and defined by the intelligent transport system ISO 17387. For the first object VO1 or the second object VO2 in the blind spots, the light scanning unit 20 and the image extraction unit 30 can assist to extract the unaware places. In addition, the ADAS also needs a more complete image extraction for identifying lateral objects, such as pedestrians, cars, bus stops, traffic labels, or traffic lights, or even the A-pillars, which are the visual direction that always induces blind spots.
Next, in the step S16, as shown in
In the step S18, please refer to
In the step S20, please refer to
The equations for calculating the radius difference between inner wheels include:
R is the turning radius of the mobile carrier V; L is the wheelbase; d1 is the distance between front wheels; d2 is the distance between rear wheels; α is the angle between the midpoint of the front and rear axles of the mobile carrier V and the center of the turning circle; a is the moving radius of the central line of the inner rear wheel; b is the moving radius of the central line of the inner front wheel; and m is the radius difference of inner wheel of a non-trailer carrier.
As shown in
(x,y) is the first image point P1; (x′, y′) is the second image point P2; m0, m1, . . . m7 are the parameters relevant to the image extraction unit 30, including the focal length, the turning angle, and sizing parameters. The image points can be expanded to a plurality of image point pairs. Then the Levenberg-Marquardt algorithm can be used to perform nonlinear minimization and giving the optimum values of m1 to m7, which is used as the optimum focal length for the image extraction unit 30.
The above image optical flow method L adopts the Lucas-Kanade optical flow algorithm for estimating obstacles. The image difference method is used first. Then the image constraint equation is expanded by the Taylor equation:
where H.O.T. means higher order terms in the equation and can be neglected for infinitesimal displacement. According to the equation, we can get:
and giving:
Vx, Vy, Vz are formed by x, y, z in the optical flow vector I(x,y,z,t).
are the partial derivatives of the image with respective to the corresponding directions at the point (x,y,z,t). Thereby, equation (10) can be converted to the following equation:
I
x
V
x
+I
y
V
y
+I
z
V
z
=−I
t (11)
Rewriting equation (11) as:
∇IT·{right arrow over (V)}=−It (12)
Since equation (10) contains three unknowns (Vx,Vy,Vz), the subsequent algorithm can solve for the unknowns.
First, assume that the optical flow vector (Vx, Vy, Vz) is constant in a small m*m*m (m>1) cube. Then, according to the voxel 1 . . . n, n=m3, the following equation set will be given:
The above equation contain three unknowns and form an overdetermined equation set, meaning there is redundancy therein. The equation set can be represented as:
A{right arrow over (v)}=−b (15)
To solve this overdetermined problem, equation (15) adopts the least square method to give:
A
T
A{right arrow over (v)}=A
T(−b) (16)
{right arrow over (v)}=(ATA)−1AT(−b) (17)
Substituting the result of equation (18) into equation (10) for estimating acceleration vector information and distance information of one or more object. Thereby, the one or more objects can be classified and their route can be predicted. For example, the object image OBJ of the first object VO1 is classified as a filtered image IMG, and the predicted route ML of the first object VO1 is predicted.
In addition, as shown in
To sum up, the present application provides a system for sensing and responding to a lateral blind spot of a mobile carrier and the method thereof. The host acquires the object images of a plurality of objects on one side of a mobile carrier for classifying and giving filtered images. Then prediction calculations are performed on the corresponding objects of the filtered images to give predicted route. The predicted route is calculated with the moving route of the mobile carrier to give a second moving route. Besides, the host can further adjust the moving data according to the route data for avoiding dangerous situations.
Number | Date | Country | Kind |
---|---|---|---|
110144028 | Nov 2021 | TW | national |