CN113415273A - System and method for automobile to intelligently pass through obstacles - Google Patents

System and method for automobile to intelligently pass through obstacles Download PDF

Info

Publication number
CN113415273A
CN113415273A CN202110718429.4A CN202110718429A CN113415273A CN 113415273 A CN113415273 A CN 113415273A CN 202110718429 A CN202110718429 A CN 202110718429A CN 113415273 A CN113415273 A CN 113415273A
Authority
CN
China
Prior art keywords
vehicle
distance
obstacle
automobile
road
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110718429.4A
Other languages
Chinese (zh)
Other versions
CN113415273B (en
Inventor
王瑞林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dongfeng Motor Corp
Original Assignee
Dongfeng Motor 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 Dongfeng Motor Corp filed Critical Dongfeng Motor Corp
Priority to CN202110718429.4A priority Critical patent/CN113415273B/en
Publication of CN113415273A publication Critical patent/CN113415273A/en
Application granted granted Critical
Publication of CN113415273B publication Critical patent/CN113415273B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095—Predicting travel path or likelihood of collision
    • B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08—Interaction between the driver and the control system
    • B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00—Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001—Planning or execution of driving tasks
    • B60W60/0015—Planning or execution of driving tasks specially adapted for safety
    • B60W60/0016—Planning or execution of driving tasks specially adapted for safety of the vehicle or its occupants
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08—Interaction between the driver and the control system
    • B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/143—Alarm means
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00—Input parameters relating to infrastructure
    • B60W2552/50—Barriers
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00—Input parameters relating to infrastructure
    • B60W2552/53—Road markings, e.g. lane marker or crosswalk

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

The invention discloses a system and a method for an automobile to pass through obstacles intelligently, which comprises the steps of collecting road edge or marking information and position information of the whole body of the automobile and obstacles; converting the position information into a position under a finished automobile coordinate system; respectively calculating the transverse distance S between the road edge or the marked line and the central axis of the vehicle, and when the distance is less than the set safe distance, exiting the obstacle avoidance function; calculating the transverse movement acceleration of the vehicle when an obstacle exists, and if the transverse movement acceleration is larger than a safety range preset by a system, exiting the obstacle avoidance function; otherwise, the transverse moving distance of the vehicle is calculated and the vehicle is controlled to move. By using the method, the risks such as the road width risk, the too close distance between the vehicle and the barrier and the like can be automatically identified, the human judgment error is avoided, the risks such as vehicle collision, side turning and the like are reduced, the automatic safe driving of the barrier road section is realized, and the driving science and technology feeling and the comfort are improved.

Description

System and method for automobile to intelligently pass through obstacles
Technical Field
The invention belongs to the technical field of intelligent driving of automobiles, and particularly relates to an intelligent obstacle passing system and method for an automobile.
Background
With the continuous popularization of the application range of automobiles in daily production and life of people, the driving scene is increasingly complex. When vehicles pass through the width-limited roadblock, meet vehicles on a narrow road surface and run on a narrow road surface or a narrow bridge passing road section, the accident is caused because the judgment is possibly inaccurate through the experience of a driver.
CN103832357B discloses a lane departure warning system based on machine vision, which includes an interface processing unit, a forward-looking camera, a digital signal processing unit and a power module, but is mainly applied to scenes with good road conditions and clear road marking lines.
CN108501959A discloses a lane departure early warning system, in which a camera transmits acquired image information of a lane line boundary in front of a vehicle to a camera processing module, the camera processing module transmits a lane departure warning signal to a CAN bus according to the image information, the CAN bus transmits the warning signal to an instrument controller and is used by an automobile instrument for warning, and the CAN bus transmits the warning signal to an electric power-assisted module to generate steering wheel shake for warning. However, the speed of the intelligent driving system is generally required to be higher than 30Km/h, and the intelligent driving system can only change lanes according to the lane marking lines when driving forwards.
The invention is mainly applied to the passage of a limited-width road barrier, the meeting of vehicles on a narrow road surface, the passage of a narrow road surface or a narrow bridge, the information of a road side line, an adjacent vehicle or an obstacle and the like is sensed by a vehicle-mounted radar and a camera, a controller analyzes and processes the acquired information and plans a proper route by an algorithm, and then the vehicle is controlled by an associated system to safely pass through a narrow road section or an obstacle zone so as to avoid traffic accidents caused by psychological or technical reasons of people fear.
Disclosure of Invention
The invention aims to solve the problem of recognizing and extracting the road sidelines and the obstacles, calculate the distance between the vehicle and the road sidelines and the obstacles, recognize risks by comparing with safe distance, and automatically adjust the direction of the vehicle to avoid reasonably.
The technical scheme of the method for realizing the intelligent obstacle passing of the automobile, which is one of the purposes of the invention, is as follows: collecting road edge or marking information and position information of the whole vehicle and obstacles; converting the position information into a position under a finished automobile coordinate system; respectively calculating the transverse distance S between the road edge or the marked line and the axis in the vehicle, and when the distance is less than the set safe distance, exiting the obstacle avoidance function; calculating the transverse movement acceleration of the vehicle when an obstacle exists, and if the transverse movement acceleration is larger than a safety range preset by a system, exiting the obstacle avoidance function; otherwise, the transverse moving distance of the vehicle is calculated and the vehicle is controlled to move.
The intelligent obstacle-passing system for the automobile comprises operation keys, a sensor, a controller, an actuator and a display. The operation keys comprise a function selection switch, a forward button and a backward button, and can be integrated on a switch panel. The sensor comprises a look-around camera, a radar and an infrared sensor; actuators are implemented primarily by ESCs and EPS, controlling the longitudinal and lateral directions of the vehicle, respectively. The driver and the passenger start the obstacle avoidance function after pressing the function confirmation button, the driver and the passenger need to press the function confirmation button again after exiting the obstacle avoidance function, the obstacle avoidance function does not need to be started manually when the obstacle avoidance function is suspended, and the obstacle avoidance function is converted from the suspended state to the exiting state if the trigger condition of the obstacle avoidance function is not met within the set time.
When a vehicle meets a specific scene, a driver parks and hangs a P gear, an EPB is pulled up, after a confirmation button of an obstacle avoidance function is pressed, the vehicle carries out self-checking, the function is activated after the self-checking is normal, after the driver selects a forward key or a backward key, a camera collects pictures around the vehicle body, a radar collects the distances between the vehicle and a road shoulder, surrounding vehicles and a road edge, a controller carries out fusion analysis on the collected data and plans a route, the ESC controls the vehicle to move longitudinally, and the EPS controls the vehicle to move transversely, so that the vehicle always keeps a safe distance with the road shoulder, surrounding vehicles, the road edge and the like, and the vehicle is ensured to run on the current road section safely until the function exits.
The specific scenes include the following scenes: 1. the width limiting road section: limiting the width of road pier at two sides of the road, and allowing a single vehicle to pass; 2. meeting at a narrow road section: no road mark line, and vehicles meeting oppositely; 3. narrow road section passing: no road marking is provided, and two sides are not protected; 4. passing through a narrow road section: no road marking line, and a road shoulder or a wall surface is arranged on one side or two sides of the road marking line; 5. narrow bridge passage: no protection is provided on two sides; 6. s-shaped road: and continuously turning a narrow road section.
The safe distance is the distance from the central axis of the vehicle to the wheel on one side and the wheel distance on the sideA predetermined distance S from the edge of the road or the road marking1Sum of the predetermined distance S1Can be set according to actual conditions.
The further technical scheme comprises the following steps: the method comprises the steps of vehicle self-checking, wherein when the self-checking is failed, the obstacle avoidance function exits; and after the obstacle avoidance function is started, whether the self-checking condition is met or not is always monitored, if the self-checking condition is not met, the obstacle avoidance function is suspended, waiting and continuous monitoring are carried out, and if the self-checking condition is not met within the set waiting time, the obstacle avoidance function exits.
The self-check comprises whether the gear is P gear; whether the EPB is pulled up; whether the door is closed; whether the safety belt is fastened or not.
The further technical scheme comprises the following steps: after the obstacle avoidance function is started, the vehicle body stability control system controls the vehicle speed to be a longitudinal constant speed for driving, and the longitudinal constant speed is smaller than or equal to a set value.
The further technical scheme comprises the following steps: and in the moving process of the vehicle, monitoring whether the transverse distance S between the road edge or the marked line and the central axis of the vehicle is smaller than the safety distance or not all the time, and if the transverse distance S is smaller than the safety distance, exiting the obstacle avoidance function.
The further technical scheme comprises the following steps: and the collected position information coordinate is subjected to dimension reduction processing and is converted into a finished automobile coordinate system, wherein the finished automobile coordinate system is established, the central point of the front bumper is taken as the origin of coordinates when the front bumper moves forwards, and the central point of the rear bumper is taken as the origin of coordinates when the rear bumper moves backwards.
The further technical scheme comprises the following steps: in the moving process of the vehicle, the sum of the X coordinates of the road edges or the marked lines on the two sides is always kept smaller than a set value so as to ensure that the vehicle runs in the middle.
The further technical scheme comprises the following steps: the method comprises the following steps:
step 1, a driver parks and hangs a P gear, an EPB is pulled up, a function confirmation button is pressed, and the system carries out self-checking; if the self-test is not satisfied, the instrument sends out a buzzing sound, the MP5 pops up a window to remind and wait for the set time, and if the self-test is still not satisfied within the set time, the function exits; if the self-checking is successful, the driver is prompted to select a forward or backward button.
Step 2, collecting distance and angle information of the whole body of the vehicle and the surrounding environment, the vehicle and obstacles and road edge information by a sensor; and processing the image data to identify an obstacle or a road marking line or a road edge line.
And 3, establishing a whole vehicle coordinate system by taking the central points of the front and rear bumpers of the vehicle as the origin of coordinates, wherein the central point of the front bumper is taken as the origin of coordinates when the vehicle moves forwards, and the central point of the rear bumper is taken as the origin of coordinates when the vehicle moves backwards. And converting the three-dimensional coordinates of the barrier or the road edge or the road marking line into two-dimensional coordinates under a finished automobile coordinate system.
Step 4, calculating the distance S between the coordinate origin and the wheel on one side under the coordinate system of the whole vehicle1And the safe distance S between the side wheel and the road edge or the marked line2The sum of S1 and S2 is compared with a preset safety distance SsafeComparing if less than the safety distance SsafeWarning that the vehicle cannot pass; if the distance is larger than or equal to the safety distance, whether the obstacle exists or not is continuously judged.
If no obstacle exists, the transverse moving distance of the vehicle can be calculated, and the controller controls the vehicle to pass through, and meanwhile, the direction is adjusted until the sum of the X coordinates of the road edge or the marked line is smaller than a set value.
If the obstacle exists, the required advancing distance Y and the transverse moving distance X of the current vehicle are calculated. Calculating the transverse movement acceleration according to the constant longitudinal vehicle speed, judging to continue passing if the transverse movement acceleration is less than or equal to the safety range preset by the system, and periodically monitoring the S in the advancing process1And S2Whether the sum is less than a preset safety distance SsafeComparing if less than the safety distance SsafeWarning that the vehicle cannot pass; if the transverse movement acceleration is larger than the safety range preset by the system, the obstacle cannot be passed through is judged, and the passing is not warned.
The safety distance SsafeThe distance between the central axis of the vehicle and the wheels on one side and the preset distance S between the wheels on one side and the edge of the road or the road mark line1Sum of the predetermined distance S1Can be set according to actual conditions.
The system for realizing the second purpose of the invention is characterized in that: the data acquisition module: the system comprises a data acquisition module, a data acquisition module and a data processing module, wherein the data acquisition module is used for acquiring data of road edges and obstacles around a vehicle; an image identification module: processing the data acquired by the data acquisition module, and identifying road edge or obstacle information; a coordinate conversion module: the system comprises a sensor, a data acquisition module and a data processing module, wherein the sensor is used for acquiring data of a vehicle coordinate system; a road planning module: the obstacle avoidance system is used for planning an obstacle avoidance driving route of the vehicle; and the obstacle avoidance starting and stopping module is used for starting or stopping the obstacle avoidance function.
The further technical scheme comprises the following steps: the automobile obstacle avoidance system further comprises a self-checking module, when the automobile is powered on and after the obstacle avoidance function is started, states of the automobile and the sensors are detected, and whether the conditions for starting the obstacle avoidance function are met or not is judged.
The further technical scheme comprises the following steps: the road planning module also comprises a calculation module which is used for judging whether the vehicle can pass through the barrier or not in real time and calculating the transverse distance, the longitudinal distance and the acceleration of the vehicle which need to move.
By using the method, the risks such as the road width risk, the too close distance between the vehicle and the obstacle and the like can be automatically identified, the human judgment error is avoided, the risks such as vehicle collision, side turning and the like are reduced, the automatic safe driving of the obstacle road section is realized, and the driving science and technology feeling and the driving comfort are improved.
Drawings
FIG. 1 is a system architecture diagram according to the present invention;
FIG. 2 is a flow chart of the logic control of the system according to the present invention;
FIG. 3 is a system diagram according to the present invention;
FIG. 4 is a schematic diagram of system coordinates during unobstructed passage in accordance with the present invention;
fig. 5 is a schematic diagram of system coordinates when an obstacle passes through the system according to the present invention.
Detailed Description
The following detailed description is provided for the purpose of explaining the claimed embodiments of the present invention so that those skilled in the art can understand the claims. The scope of the invention is not limited to the following specific implementation configurations. It is intended that the scope of the invention be determined by those skilled in the art from the following detailed description, which includes claims that are directed to this invention.
The scheme of the invention is mainly used for the scenes of limited width roadblock passage, narrow road meeting, narrow road or narrow bridge and the like, is mainly applied to the low-speed range of 0-10Km/h, can go forward or backward, continuously optimizes the driving direction according to the road condition, has the specific control logic as shown in figure 2, and is implemented as follows.
The sensor in this embodiment includes 4 all-round cameras and 12 ultrasonic radars. Actuators are implemented by ESCs and EPS, controlling the longitudinal and lateral directions of the vehicle, respectively.
After the vehicle is powered on, the system starts self-checking to detect whether the sensor is shielded or damaged, whether the related message/signal is normal or not and whether the actuator works normally or not.
The driver and the crew press the function opening button, the vehicle state check is carried out, the gear is in the P gear, the EPB is pulled up, the vehicle door is closed, the safety belt is fastened, the state meets the requirement, the function indicating lamp is lightened, the function is opened, and the vehicle enters the system to take over. If the requirement is not met, the meter sends out a buzzing tone, and the MP5 pops up the window to remind and wait.
Through the radar probe of placing on the front and rear bumper, can detect the distance and the angle information of vehicle whole body and surrounding environment, vehicle and obstacle. The camera collects road edge information, and for roads with marking lines, the outer marking lines are selected as road edges; for the non-road marking line, the edge of the actual road is taken as the edge of the road.
The controller firstly carries out gray image processing on the received image data and degrades the color space from three dimensions to one dimension; then, Gaussian blur is carried out, noise is removed from the image, and the image obtained in the last step is smoother; and finally, performing edge detection, and finding an edge line of the image through the image which is gray and subjected to Gaussian blur, wherein the edge is an area with a suddenly jumping gray value in the image.
The central point of the front bumper and the central point of the rear bumper of the vehicle are used as coordinate original points to establish a coordinate system of the whole vehicle, the central point of the front bumper is used as the coordinate original point when the vehicle moves forwards, the central point of the rear bumper is used as the coordinate original point when the vehicle moves backwards, the vehicle moving direction is used as the positive direction of the y axis, the direction parallel to the vertical vehicle moving direction is used as the positive direction of the x axis to the right, and the vertical direction of the ground is used as the positive direction of the z axis. After the radar detects the distance and angle information of the obstacle, the coordinate of the obstacle relative to the origin is calculated by combining the position of the radar on the vehicle body, the Z-direction coordinate is deleted and degraded into a two-dimensional coordinate, and the coordinate information is input into a coordinate system of the whole vehicle. Meanwhile, the camera collects road edge or identification line images, the images are input into a whole vehicle coordinate system and are compared with the position of the vehicle image in the coordinate system, and the abscissa of the position with the ordinate of 0 is taken to obtain the road edge coordinates at the moment, as shown in fig. 3.
The driver and the crew press the forward or backward key, the switch sends a message to the EPS, the TCU and the EPB controller through the CAN line, the EPS reads the data of the torque sensor and returns to the positive steering wheel, the TCU adjusts the gear to the D gear or the R gear, and the EPB releases the calipers.
When the radar does not detect that the obstacle exists in the road, the camera detects the road edges or the road marking at two sides, and the position of the road edges or the road marking is coordinated to be (X)1,0)(X20), as shown in FIG. 4, if | X1| ≧ S and | X2| ≧ S, judging to continue driving, and adjusting direction to X1And X2Is less than the set value SjIn this embodiment, the set value SjSet to 10cm, i.e., X1+ X2 ≦ 10cm, but not limited to this value, to ensure that the vehicle is running centered. Where S is L1+ L2, L1 is the distance from the origin of coordinates to the one-sided wheel, and L2 is the safety distance of the wheel from the edge of the road or the road marking, which may be set to 10cm, but is not limited thereto.
When the radar detects that the obstacle exists in the road, the distance and the angle of the obstacle are obtained and are converted into two-dimensional coordinates (X)3,Y3) As shown in fig. 5, in order to ensure that the vehicle safely avoids the obstacle, the theoretical calculation indicates that the vehicle origin point needs to pass through the target point (X, Y), where X ═ X3-S,Y＝Y3The required advancing distance Y and the transverse moving distance X of the current vehicle can be calculated. According to the constant v of the advancing vehicle speed,the longitudinal moving time t can be calculated as Y/v, and then the acceleration of the lateral movement can be calculated, if the acceleration of the lateral movement is less than or equal to the preset safety range of the system, it is determined that the vehicle can continue to pass through, if the acceleration of the lateral movement is greater than the preset safety range of the system, it is determined that the vehicle cannot pass through the obstacle, at this time, the vehicle is alarmed through the MP5, the display cannot pass through the obstacle, and the vehicle is requested to stop in time, where the preset safety range is (0-9.8 m/s) in this embodiment2). When the vehicle moves towards a target point (X, Y), the controller receives the coordinates (X) of the road edges or the road marking at intervals of fixed frequency and detects the road edges or the road marking at two sides by the camera4,Y4)(X5,Y5) If | X4| ≧ S and | X5≧ S, i.e., it is determined that the vehicle can safely pass through the obstacle and continue driving, in this embodiment, the fixed frequency is set to 50ms, where S is L1+ L2, L1 is the distance from the origin of coordinates to the one-side wheel, and L2 is the safety distance from the one-side wheel to the road edge or the marking line, and this safety distance may be set to 10cm, but is not limited thereto.
When the forward button is selected, the vehicle moves forward, and the ESC controls the vehicle speed to be constant at a low speed, which is set to be 5Km/h in the embodiment for driving, but is not limited to this value; when the backward button is selected, the vehicle moves backward, and in order to facilitate calculation, a whole vehicle coordinate system is established by taking the central point of the rear wheel shaft of the vehicle as a coordinate origin, the calculation method is the same as that of the forward movement of the vehicle.
The vehicle moving process is monitored all the time, the acceleration and brake pedal, the vehicle door state and the safety belt state are monitored, if the acceleration and brake pedal is stepped on or the vehicle door is opened and the safety belt is not fastened, the advancing or retreating function is suspended, the system waits for a period of time in a default mode, one minute is set in the embodiment, if the acceleration and brake pedal is stepped on or the vehicle door is opened and the safety belt is not fastened, the function is continued, and if the acceleration and brake pedal is recovered within one minute, the obstacle avoidance system exits. If the obstacle avoidance function needs to be started again after the system quits, the driver and passengers need to press the function starting button.
After the vehicle passes through the current road section, the function starting button is pressed again, the function exits, the system adjusts the gear P, the EPB is pulled up, and the instrument displays the taking-over information of the driver.

Claims (10)

1. An intelligent obstacle passing method for an automobile is characterized by collecting road edge or marking information and position information of the whole body of the automobile and an obstacle; converting the position information into a position under a finished automobile coordinate system; respectively calculating the transverse distance S between the road edge or the marked line and the central axis of the vehicle, and when the distance is less than the set safe distance, exiting the obstacle avoidance function; calculating the transverse movement acceleration of the vehicle when an obstacle exists, and if the transverse movement acceleration is larger than a safety range preset by a system, exiting the obstacle avoidance function; otherwise, the transverse moving distance of the vehicle is calculated and the vehicle is controlled to move.
2. The method for the intelligent passing of the obstacle of the automobile as recited in claim 1, further comprising a vehicle self-check, wherein when the self-check fails, the obstacle avoidance function exits; and after the obstacle avoidance function is started, whether the self-checking condition is met or not is always monitored, if the self-checking condition is not met, the obstacle avoidance function is suspended, waiting and continuous monitoring are carried out, and if the self-checking condition is not met within the set waiting time, the obstacle avoidance function exits.
3. The method for the automobile to intelligently pass through the obstacle as claimed in claim 1, wherein after the obstacle avoidance function is started, the automobile body stability control system controls the automobile speed to be a longitudinal constant speed for driving, and the longitudinal constant speed is less than or equal to a set value.
4. The method for the automobile to intelligently pass through the obstacle as claimed in claim 1, wherein whether the transverse distance S between the road edge or the marked line and the central axis of the automobile is smaller than the safety distance is always monitored in the moving process of the automobile, and if the transverse distance S is smaller than the safety distance, the obstacle avoidance function exits.
5. An intelligent method for passing obstacles according to claim 1, wherein the coordinate reduction processing and transformation of the collected position information into the entire vehicle coordinate system comprises establishing the entire vehicle coordinate system with the center point of the front bumper as the origin of coordinates when moving forward and the center point of the rear bumper as the origin of coordinates when moving backward.
6. The method for the intelligent obstacle crossing of the automobile as claimed in claim 1 or 5, wherein the sum of the X coordinates of the road edges or marked lines on the two sides is always kept smaller than the set value during the moving process of the automobile so as to ensure that the automobile runs in the middle.
7. The method for intelligent obstacle crossing of an automobile according to claim 1, comprising the steps of:
step 1, a driver parks and hangs a P gear, an EPB is pulled up, a function confirmation button is pressed, and a system carries out self-checking; if the self-test is not satisfied, the instrument sends out a buzzing sound, the MP5 pops up a window to remind and wait for the set time, and the function exits if the self-test is still not satisfied within the set time; and if the self-checking is successful, prompting the driver to select a forward or backward key.
Step 2, collecting distance and angle information of the whole body of the vehicle and the surrounding environment, the vehicle and obstacles and road edge information by a sensor; and processing the image data to identify an obstacle or a road marking or a road edge line.
And 3, establishing a whole vehicle coordinate system by taking the central points of the front and rear bumpers of the vehicle as the origin of coordinates, wherein the central point of the front bumper is taken as the origin of coordinates when the vehicle moves forwards, and the central point of the rear bumper is taken as the origin of coordinates when the vehicle moves backwards. And converting the three-dimensional coordinates of the barrier or the road edge or the road marking line into two-dimensional coordinates under a finished automobile coordinate system.
Step 4, calculating the distance S between the coordinate origin and the wheel on one side under the coordinate system of the whole vehicle1And the safe distance S between the side wheel and the road edge or the marked line2Will S1And S2The sum is separated from a preset safety distance SsafeComparing if less than the safety distance SsafeWarning that the vehicle cannot pass; if the distance is larger than or equal to the safe distance, whether the obstacle exists is continuously judged.
If no obstacle exists, the transverse moving distance of the vehicle can be calculated, and the controller controls the vehicle to pass through, and meanwhile, the direction is adjusted until the sum of the X coordinates of the road edge or the marked line is smaller than a set value.
If the obstacle exists, the required advancing distance Y and the transverse moving distance X of the current vehicle are calculated. Calculating the transverse moving acceleration according to the constant longitudinal speed, judging to continue passing if the transverse moving acceleration is less than or equal to the safety range preset by the system, and periodically monitoring the S in the advancing process1And S2Whether the sum is less than a preset safety distance SsafeComparing if less than the safety distance SsafeWarning that the vehicle cannot pass; if the transverse movement acceleration is larger than the safety range preset by the system, the obstacle cannot be passed through is judged, and the passing is not warned.
8. A system for intelligent obstacle crossing of a vehicle, comprising: a data acquisition module: the system comprises a data acquisition module, a data acquisition module and a data processing module, wherein the data acquisition module is used for acquiring data of road edges and obstacles around a vehicle; an image recognition module: processing the data acquired by the data acquisition module, and identifying road edge or obstacle information; a coordinate conversion module: the system comprises a sensor, a data acquisition module and a data processing module, wherein the sensor is used for acquiring data of a vehicle coordinate system; a road planning module: the obstacle avoidance system is used for planning an obstacle avoidance driving route of the vehicle; and the obstacle avoidance starting and stopping module is used for starting or stopping the obstacle avoidance function.
9. The system of claim 7, further comprising a self-checking module for detecting the status of the vehicle and the sensor when the vehicle is powered on and after the obstacle avoidance function is enabled, and determining whether the conditions for enabling the obstacle avoidance function are met.
10. The system for intelligent obstacle crossing of an automobile of claim 7, wherein the road planning module further comprises a calculating module for real-time judging whether the vehicle can pass through the obstacle and calculating the lateral distance, the longitudinal distance and the acceleration of the vehicle which need to move.
CN202110718429.4A 2021-06-28 2021-06-28 System and method for automobile to pass through obstacle intelligently Active CN113415273B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110718429.4A CN113415273B (en) 2021-06-28 2021-06-28 System and method for automobile to pass through obstacle intelligently

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110718429.4A CN113415273B (en) 2021-06-28 2021-06-28 System and method for automobile to pass through obstacle intelligently

Publications (2)

Publication Number Publication Date
CN113415273A true CN113415273A (en) 2021-09-21
CN113415273B CN113415273B (en) 2022-11-01

Family

ID=77717069

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110718429.4A Active CN113415273B (en) 2021-06-28 2021-06-28 System and method for automobile to pass through obstacle intelligently

Country Status (1)

Country Link
CN (1) CN113415273B (en)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101132965A (en) * 2005-03-03 2008-02-27 大陆-特韦斯贸易合伙股份公司及两合公司 Method and device for avoiding a collision as a vehicle is changing lanes
CN106696960A (en) * 2017-02-27 2017-05-24 奇瑞汽车股份有限公司 Vehicle collision early warning method and device
CN106740835A (en) * 2016-11-21 2017-05-31 北汽福田汽车股份有限公司 Adaptive cruise control method, device and vehicle
CN208101972U (en) * 2018-03-15 2018-11-16 东风商用车有限公司 A kind of steering anti-collision system of commercial vehicle
CN109116843A (en) * 2018-08-09 2019-01-01 北京智行者科技有限公司 Vehicle follows line running method
CN110450777A (en) * 2019-07-10 2019-11-15 同济大学 The vehicle early warning control method and system of multi-parameter input based on millimetre-wave radar
US20200180618A1 (en) * 2017-06-06 2020-06-11 Mazda Motor Corporation Vehicle control device
CN111332285A (en) * 2018-12-19 2020-06-26 长沙智能驾驶研究院有限公司 Method and device for vehicle to avoid obstacle, electronic equipment and storage medium
CN112248986A (en) * 2020-10-23 2021-01-22 厦门理工学院 Automatic braking method, device, equipment and storage medium for vehicle

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101132965A (en) * 2005-03-03 2008-02-27 大陆-特韦斯贸易合伙股份公司及两合公司 Method and device for avoiding a collision as a vehicle is changing lanes
CN106740835A (en) * 2016-11-21 2017-05-31 北汽福田汽车股份有限公司 Adaptive cruise control method, device and vehicle
CN106696960A (en) * 2017-02-27 2017-05-24 奇瑞汽车股份有限公司 Vehicle collision early warning method and device
US20200180618A1 (en) * 2017-06-06 2020-06-11 Mazda Motor Corporation Vehicle control device
CN208101972U (en) * 2018-03-15 2018-11-16 东风商用车有限公司 A kind of steering anti-collision system of commercial vehicle
CN109116843A (en) * 2018-08-09 2019-01-01 北京智行者科技有限公司 Vehicle follows line running method
CN111332285A (en) * 2018-12-19 2020-06-26 长沙智能驾驶研究院有限公司 Method and device for vehicle to avoid obstacle, electronic equipment and storage medium
CN110450777A (en) * 2019-07-10 2019-11-15 同济大学 The vehicle early warning control method and system of multi-parameter input based on millimetre-wave radar
CN112248986A (en) * 2020-10-23 2021-01-22 厦门理工学院 Automatic braking method, device, equipment and storage medium for vehicle

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
王浩: "基于改进人工势场法的车辆避障路径规划研究", 《中国优秀硕士学位论文全文数据库（电子期刊）》 *

Also Published As

Publication number Publication date
CN113415273B (en) 2022-11-01

Similar Documents

Publication Publication Date Title
US10406980B2 (en) Vehicular lane change system
CN110920552B (en) Vehicle safety system and method for preventing interlink accident after collision on highway
CN108883725B (en) Driving vehicle alarm system and method
CN106708040B (en) Sensor module, automated driving system and the method for automated driving system
US10407060B2 (en) Driver assistance apparatus and method for operating the same
US7375620B2 (en) Speed-sensitive rear obstacle detection and avoidance system
CN105216727B (en) A kind of vehicle distances detection active safety system and control method
CN108928343A (en) A kind of panorama fusion automated parking system and method
CN111746511B (en) Vehicle control system
CN111824126B (en) Vehicle control system
CN104554259A (en) Active type automatic drive assistance system and method
CN111231827B (en) Device and method for displaying front collision risk area of vehicle in rainy and foggy weather
EP3919336B1 (en) Travel control method and travel control device for vehicle
CN101101333A (en) Apparatus and method for producing assistant information of driving vehicle for driver
CN108032809B (en) Reverse side auxiliary system and data fusion and control method thereof
TWI535589B (en) Active automatic driving assistance system and method
CN113043944A (en) Vehicle safety warning system and method integrating track prediction and side obstacle monitoring
CN108407807B (en) Steering collision avoidance system of commercial vehicle and control method thereof
CN112793507A (en) Blind area early warning braking system based on inertial device perception vehicle right turn motion characteristic
CN112721806A (en) Method and device for assisting blind zone of gradient road section
CN113221638B (en) Vehicle target perception method and system
JP2019209909A (en) Vehicle control system
CN108238102A (en) A kind of vehicle-mounted ultrasonic wave sensor system
CN113415273B (en) System and method for automobile to pass through obstacle intelligently
JP2017151704A (en) Automatic driving device

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant