WO2023029239A1 - 一种基于毫米波雷达的紧急转向系统 - Google Patents

一种基于毫米波雷达的紧急转向系统 Download PDF

Info

Publication number
WO2023029239A1
WO2023029239A1 PCT/CN2021/133321 CN2021133321W WO2023029239A1 WO 2023029239 A1 WO2023029239 A1 WO 2023029239A1 CN 2021133321 W CN2021133321 W CN 2021133321W WO 2023029239 A1 WO2023029239 A1 WO 2023029239A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
steering
millimeter
wave radar
emergency
Prior art date
Application number
PCT/CN2021/133321
Other languages
English (en)
French (fr)
Inventor
韩高峰
黄利权
黄秀芳
Original Assignee
浙江亚太机电股份有限公司
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 浙江亚太机电股份有限公司 filed Critical 浙江亚太机电股份有限公司
Publication of WO2023029239A1 publication Critical patent/WO2023029239A1/zh

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/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
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • 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
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9327—Sensor installation details
    • G01S2013/93271—Sensor installation details in the front of the vehicles
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9327—Sensor installation details
    • G01S2013/93272—Sensor installation details in the back of the vehicles

Definitions

  • the invention relates to a vehicle auxiliary control system, in particular to an emergency steering system and control method based on millimeter wave radar.
  • the present invention provides an emergency steering system and control method based on millimeter wave radar, which can effectively reduce the occurrence of collision accidents and protect the safety of personnel and property.
  • the present invention is mainly aimed at avoiding accidents due to the driver's inability to take effective collision avoidance measures in such an emergency situation that a collision accident is about to occur.
  • the present invention mainly combines this kind of situation, and four millimeter-wave radars are installed around the vehicle for sensing surrounding vehicle conditions.
  • the system can judge whether the collision can be effectively avoided and calculate a safe and stable steering path according to the vehicle condition information obtained by the millimeter wave radar.
  • the system will monitor whether the driver has the intention to turn. If there is this intention, the control command is sent to the steering control module through the CAN network to control the steering wheel to perform effective collision avoidance actions.
  • this system can significantly avoid such traffic accidents and reduce casualties and property losses.
  • This system is mainly installed around the vehicle body with the millimeter-wave radar to sense and monitor the surrounding road condition information.
  • the system master When it is judged that a collision with the vehicle in front is about to occur based on the information of the vehicle in front, the system calculates a safe and stable lane-changing trajectory according to the current surrounding vehicle conditions and judges that it is safe to change lanes, and then sends a control command to the steering control module and Send prompt alarm information to remind the driver to pay attention to steering safety.
  • the steering control module controls the steering wheel to follow the previously calculated trajectory to safely steer before the original collision point to prevent collisions and protect the safety of the occupants in the vehicle.
  • An emergency steering control system :
  • millimeter-wave radar arranged around the body, to detect and obtain vehicle condition information around the body, and send it to the CAN network of the body;
  • Including the main control of the vehicle system receives the vehicle condition information of the millimeter-wave radar through the CAN network, collects its own vehicle information, and judges whether it is possible to perform a safe emergency steering by combining the vehicle condition information and vehicle information: if it is possible to perform a safe emergency steering, then Process to obtain a safe steering obstacle avoidance path, generate a steering control signal according to the steering obstacle avoidance path conversion and send it to the steering control module;
  • It includes a steering control module, which automatically controls the steering wheel for emergency steering according to the steering control signal.
  • a millimeter-wave radar is installed on each side of the body.
  • the millimeter-wave radar on the front side can detect the position of the vehicle ahead. If the surrounding environment can be ignored under ideal conditions, only the millimeter-wave radar on the front side can be used.
  • Through the millimeter-wave radar on the rear side and both sides it is possible to confirm whether the road conditions at the rear and both sides can meet the steering requirements, and in complex situations such as non-ideal conditions, it is possible to confirm the road conditions at the rear and both sides through the millimeter-wave radar on the rear side and both sides And then carry out emergency steering control.
  • the processing In the main control of the vehicle system, if safe emergency steering cannot be performed, the processing generates a braking control signal and sends it to the braking system module, and the braking system module automatically controls the brakes to perform emergency braking according to the braking control signal.
  • the main controller of the vehicle system generates prompt alarm information while generating the steering control signal, and presents the reminder to the driver on the main console.
  • the emergency steering system is arranged on the vehicle, and the longitudinal distance and the lateral distance between the vehicle and the vehicle in front are detected through the millimeter-wave radar arranged in front of the vehicle body.
  • the longitudinal distance is the distance along the direction of travel
  • the lateral distance is the distance along the direction perpendicular to the direction of travel.
  • the present invention aims at the situation that the own vehicle and the preceding vehicle are running back and forth along the same route, and the own vehicle is running close to the preceding vehicle.
  • the vehicle condition information includes the current distance and relative speed between the own vehicle and the preceding vehicle, and the vehicle information includes the current speed of the own vehicle.
  • the steering angle of the ego vehicle at the elapsed time T is obtained according to the following formula:
  • k represents the angle multiple
  • A represents the time period coefficient
  • the distance between the front vehicle and the vehicle along the driving path within the elapsed time T is obtained as:
  • V 0 and V 1 represent the speeds of the vehicle in front and the vehicle in front respectively
  • X 1 represents the longitudinal driving distance of the preceding vehicle along the driving path
  • Y 1 represents the lateral driving distance of the preceding vehicle along the driving path
  • DD represents the passing The longitudinal distance between the front vehicle and the vehicle before time T
  • X 0 represents the longitudinal distance of the vehicle along the driving path
  • Y 0 represents the lateral distance of the vehicle along the driving path
  • d T represents the distance of the vehicle The travel distance within the elapsed time T
  • d T indicates that the integral variable to be integrated in this formula is T.
  • W represents the width of the vehicle
  • D represents the safety distance between the workshops
  • the present invention is an effective supplement to the active anti-collision technology.
  • the system mainly solves the problems of the current forward anti-collision system that mostly adopts the longitudinal braking intervention method to avoid collisions due to high relative speed, poor road surface adhesion conditions, and low overlap rate with obstacles. In some specific scenarios, there is a problem that the braking distance is too long, which makes it impossible to completely avoid collisions.
  • the invention effectively improves the safety of the vehicle when a collision accident is about to occur, and further protects the safety of occupants in the vehicle.
  • Figure 1 is a top view of the system block diagram of the emergency steering system based on millimeter wave radar
  • Figure 2 is the steering obstacle avoidance path diagram of the emergency steering system based on millimeter wave radar
  • ⁇ x is the longitudinal displacement when steering and collision avoidance is completed
  • ⁇ y is the lateral displacement when steering and collision avoidance is completed.
  • the system includes:
  • millimeter-wave radars 1-4 one millimeter-wave radar is arranged on each side of the body, and there are four millimeter-wave radars in total, which detect and obtain vehicle condition information around the body and send it to the CAN network 7 of the body;
  • vehicle system master control 5 which receives the vehicle condition information of the millimeter-wave radar through the CAN network, collects its own vehicle information, and judges whether a safe emergency steering can be performed based on the vehicle condition information and vehicle information: if it is possible to perform a safe emergency steering, Then process to obtain a safe steering obstacle avoidance path, convert and generate a steering control signal according to the steering obstacle avoidance path and send it to the steering control module 6; system module;
  • It includes a steering control module 6, which automatically controls the steering wheel to perform emergency steering according to the steering control signal.
  • It includes a brake system module; the brake system module automatically controls the brake to perform emergency braking according to the brake control signal.
  • the main controller of the vehicle system generates a prompt alarm message while generating the steering control signal, and reminds the driver on the main console to remind the information that the emergency steering control will be carried out.
  • the emergency steering system is arranged on the car, and the longitudinal distance and the lateral distance between the car and the front car are detected by the millimeter-wave radar 1 arranged in front of the car body.
  • the millimeter-wave radar 1-4 installed around the vehicle recognizes pedestrians, vehicles or other obstacles, thereby monitoring the surrounding vehicle conditions, and sends obstacle information data to the vehicle system master 5 through the CAN network 7 in real time.
  • the vehicle system main control 5 finds that a collision accident will occur ahead according to the vehicle condition data.
  • the vehicle system master 5 will immediately evaluate whether it is safe to avoid collisions based on the surrounding vehicle condition information obtained from the millimeter wave radar 1-4. Determine and calculate a safe and stable steering path (Figure 2), and then remind the driver through a warning signal, and then the system starts to monitor the driver's steering intention, once it detects that the driver starts to turn, it starts to take over the vehicle, the system combines the current The vehicle speed converts the path information into a steering control command and sends it to the steering control module 6 through the CAN network 7 .
  • the steering control module 6 controls the steering wheel angle according to the given control command, so that the vehicle can avoid collision along the calculated steering path ( Figure 2) before the original collision point. Compare and correct with the planned path to prevent other accidents caused by deviation from the established path. After completing the emergency steering collision avoidance action, the vehicle system main control 5 will remind the driver to take over the steering wheel again and continue to drive normally.
  • the steering obstacle avoidance path key6i is set according to the following rules: 1.
  • the planned path has smooth curvature and continuous second-order derivative; 2.
  • the longitudinal avoidance distance of the path is as short as possible; 3.
  • the extreme value of the path is small; 4.
  • the lateral displacement of the vehicle is small; 5.
  • the specific implementation uses a quintic polynomial to fit and describe the steering obstacle avoidance path, and the lateral acceleration curve at each time point is smooth and continuous, which is more in line with the behavior habits of most drivers. According to the boundary conditions of the path and meeting the boundary requirements of the path initial point and the seed point, the desired path can be obtained (Fig. 2).
  • the distance ⁇ D and relative speed between the current vehicle and the vehicle in front are obtained in real time through the millimeter wave radar 1-4, and emergency steering and collision avoidance control processing is performed as follows:
  • the forward direction of the vehicle is set as the longitudinal direction, denoted as X, and the transverse direction as Y.
  • the vehicle system main control 5 obtains the angle multiple k and the time cycle coefficient A by collecting its own vehicle information, and the steering angle of the own vehicle after time T is obtained according to the following formula:
  • k represents the angle multiple
  • A represents the time period coefficient
  • both k and A are constant parameters
  • the distance between the front vehicle and the vehicle along the driving path within the elapsed time T is obtained as:
  • V 0 and V 1 represent the speeds of the vehicle in front and the vehicle in front respectively. Since the vehicle in front and the vehicle in front travel along the same route, the lateral offset between the vehicle in front and the vehicle in front is 0, and X 1 indicates that the vehicle in front is at The longitudinal driving distance along the driving path, Y 1 represents the lateral driving distance of the preceding vehicle on the driving path, ⁇ D represents the longitudinal distance between the preceding vehicle and the own vehicle before the elapsed time T; X 0 represents the driving distance of the leading vehicle along the driving path The longitudinal travel distance on the path, Y represents the lateral travel distance of the vehicle along the travel path, and d T represents the travel distance of the vehicle within the elapsed time T;
  • W represents the width of the vehicle
  • D represents the safety distance between the workshops
  • a braking control signal is generated to brake and decelerate as much as possible to avoid accidents or reduce accident losses.

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

一种基于毫米波雷达的紧急转向系统，毫米波雷达(1-4)布置在车身周围，探测获得车身周围的车况信息，并经车身CAN网络(7)发送到车辆系统主控(5)；车辆系统主控(5)通过CAN网络(7)接收毫米波雷达(1-4)的车况信息，并采集自身的车辆信息，结合车况信息和车辆信息判断出是否紧急转向，并处理获得一条安全的转向避障路径，根据转向避障路径转换产生转向控制信号并发送到转向控制模块(6)；转向控制模块(6)根据转向控制信号控制方向盘进行紧急转向。解决了目前多采用纵向制动介入方式实现避撞的前向防碰撞系统在相对速度过高、路面附着条件差、与障碍物重叠率低等特定场景下存在制动距离过长而造成无法完全避撞的问题。

Description

一种基于毫米波雷达的紧急转向系统 技术领域
本发明涉及了一种汽车辅助控制系统，尤其是涉及了一种基于毫米波雷达的紧急转向系统和控制方法。
背景技术
随着世界范围内各国生活水平的提高，汽车保有量持续地增加，同时各类交通事故以及由此引发的人员伤亡和财产损失案例也不断增长。虽然ABS、ESP等安全技术地应用使得在极端工况下车辆的操控稳定性有一定的提高，但是依旧不足以完全防止交通事故的发生。根据道路交通事故数据显示，有约四成的交通事故发生时司机没有采取任何有效的回避动作；另外汽车碰撞事故约占全部交通事故的六七成。这些交通事故中，由于驾驶者在紧急的工况下存在认知延迟或操作不当而造成无法避免事故的发生。
发明内容
为了解决背景技术中存在的问题，本发明所提供一种基于毫米波雷达的紧急转向系统和控制方法，有效的减少碰撞事故的发生，保护人员和财产安全。
本发明采用的技术方案是：
本发明主要针对在这种即将发生碰撞事故的紧急情况下，避免因驾驶员无法进行有效避撞措施而发生事故。本发明主要是结合此类情况，在车辆的四周安装有4个毫米波雷达用于感知周围车况。当即将发生碰撞事故时，本系统能够根据毫米波雷达得到的车况信息判断出能否有效避撞并计算出一条安全稳定的转向路径，同时系统会监控驾驶员是否有打转向的意图，如果发现有此意图则通过CAN网络发送控制指令给转向控制模块来控制方向盘进行有效的避撞动作。通过有效的避撞行为，本系统能够显著地避免此类的交通事故发生，减少人员伤亡和财产损失。
本系统主要安装在车辆车身四周的毫米波雷达对周围的路况信息进行感知监测，当毫米波雷达识别出前方存在车辆并把车辆信息通过CAN网络传输给系统主控，并且系统主控根据自身车辆和前方车辆信息判断出即将与前车发生碰撞时，根据当前的周围车况并判断能够安全转向变道的情况下本系统计算出一条安全稳定的变道轨迹，然后发送控制命令给转向控制模块并且发送提示报警 信息提示驾驶员注意转向安全。转向控制模块控制方向盘沿先前计算出的轨迹，在原碰撞点之前能够安全地进行转向防止碰撞，保护车内乘员的安全性。
本发明的有益效果是：
一、一种紧急转向控制系统：
包括毫米波雷达，布置在车身周围，探测获得车身周围的车况信息，并发送到车身CAN网络；
包括车身CAN网络，接收车况信息并发送到车辆系统主控；
包括车辆系统主控，通过CAN网络接收毫米波雷达的车况信息，并采集自身的车辆信息，结合车况信息和车辆信息判断出是否能够进行安全的紧急转向：若能进行进行安全的紧急转向，则处理获得一条安全的转向避障路径，根据转向避障路径转换产生转向控制信号并发送到转向控制模块；
包括转向控制模块，根据转向控制信号自动控制方向盘进行紧急转向。
车身四周各布置装有一个毫米波雷达。前侧的毫米波雷达能够前车的位置，如果在理想状况下可以不考虑周围环境则可以只使用前侧的毫米波雷达。通过后侧和两边的毫米波雷达能够确认后方和两边的路况环境是否能够满足转向的需求，在非理想状况等复杂情况下通过通过后侧和两边的毫米波雷达能够确认后方和两边的路况环境进而进行紧急转向控制。
还包括制动系统模块；
所述车辆系统主控中，若不能进行进行安全的紧急转向，则处理产生制动控制信号并发送到制动系统模块，由制动系统模块根据制动控制信号自动控制制动器进行紧急制动。
所述的车辆系统主控在产生转向控制信号的同时产生提示报警信息，在主控台上向驾驶员提醒呈现。
所述的紧急转向系统布置在本车上，通过本车车身前方布置的毫米波雷达探测本车和前车之间的纵向距离和横向距离。纵向距离为沿行驶方向的距离，横向距离为沿垂直于行驶方向的距离。
本发明针对本车和前车在沿同一路线上前后行驶的情况，本车相对于前车靠近行驶。
所述的车况信息包括了当前本车和前车之间的距离、相对速度，所述的车辆信息包括了当前本车的速度。
二、应用于上述紧急转向系统的一种紧急转向控制方法：
通过毫米波雷达实时获得当前本车和前车之间的距离ΔD、相对速度，按照以下进行紧急转向避撞控制处理：
经过时间T的本车车辆的转向角度按照以下公式获得：
θ＝k sin(AT)
其中，k表示角度倍数，A表示时间周期系数；
根据转向角度θ实时处理获得经过时间T内前车和本车沿行驶路径的距离为：
Figure PCTCN2021133321-appb-000001
Figure PCTCN2021133321-appb-000002
其中，V 0和V 1分别表示本车和前车的速度，X 1表示前车在沿行驶路径上的纵向行驶距离，Y 1表示前车在沿行驶路径上的横向行驶距离，DD表示经过时间T前的前车和本车之间的纵向距离；X 0表示本车在沿行驶路径上的纵向行驶距离，Y 0表示本车在沿行驶路径上的横向行驶距离，d T表示本车经过时间T内的行驶距离；d T表示的是本公式中要积分的积分变量为T。
根据实时获得的前车的纵向行驶距离X 1、横向行驶距离Y 1以及本车的纵向行驶距离X 0、横向行驶距离Y 0，代入以下公式并进行判断：
Figure PCTCN2021133321-appb-000003
其中，W表示车宽，D表示车间安全距离；
若同时满足上述两个公式，则能够进行安全的紧急转向。
本发明是对主动防碰撞技术的有效补充，系统主要解决了目前多采用纵向制动介入方式实现避撞的前向防碰撞系统在相对速度过高、路面附着条件差、与障碍物重叠率低等特定场景下存在制动距离过长而造成无法完全避撞的问题。
本发明有效的提高了车辆在碰撞事故将要发生时的安全性，进一步保护车内乘员的安全。
附图说明
图1为基于毫米波雷达的紧急转向系统的系统框图俯视图
图中：1-4、毫米波雷达，5、系统主控，6、转向控制模块，7、CAN网络。
图2为基于毫米波雷达的紧急转向系统的转向避障路径图
图中：Δx为转向避撞完成时的纵向位移，Δy为转向避撞完成时的横向位移。
具体实施方式
下面结合附图及具体实施例对本发明作进一步详细说明。
如图1所示，系统包括：
包括毫米波雷达1-4，车身四周各布置装有一个毫米波雷达，共计有四个毫米波雷达，探测获得车身周围的车况信息，并发送到车身CAN网络7；
包括车身CAN网络7，接收车况信息并发送到车辆系统主控；
包括车辆系统主控5，通过CAN网络接收毫米波雷达的车况信息，并采集自身的车辆信息，结合车况信息和车辆信息判断出是否能够进行安全的紧急转向：若能进行进行安全的紧急转向，则处理获得一条安全的转向避障路径，根据转向避障路径转换产生转向控制信号并发送到转向控制模块6；若不能进行进行安全的紧急转向，则处理产生制动控制信号并发送到制动系统模块；
包括转向控制模块6，根据转向控制信号自动控制方向盘进行紧急转向。
包括制动系统模块；由制动系统模块根据制动控制信号自动控制制动器进行紧急制动。
车辆系统主控在产生转向控制信号的同时产生提示报警信息，在主控台上向驾驶员提醒呈现，以提醒将进行紧急转向控制的信息。
紧急转向系统布置在本车上，通过本车车身前方布置的毫米波雷达1探测本车和前车之间的纵向距离和横向距离。
安装在车辆四周的毫米波雷达1-4识别到行人、车辆或其他障碍物，从而对周围的车况进行监控，并实时把障碍物信息数据通过CAN网络7发送给车辆系统主控5。
如果在某一时刻，车辆系统主控5根据车况数据发现前方将发生碰撞事故。在这种紧急情况下若驾驶员因认知延迟或操作不当而没有采取有效的措施，车辆系统主控5将会立刻根据毫米波雷达1-4得到的四周车况信息对能否安全避撞进行判定并计算出一条安全平稳的转向路径(图2)，然后通过提示警示信号提醒驾驶员，然后系统开始监测驾驶员的转向意图，一旦检测到驾驶员开始转向，则开始接管车辆，系统结合当前车速把路径信息转化成转向控制指令通过CAN网络7发送给转向控制模块6。
转向控制模块6根据给定的控制指令控制方向盘转角，使车辆在原碰撞点前沿着计算出的转向路径(图2)进行避撞动作，与此同时车辆系统主控5还会根 据实时的车辆路径与计划好的路径进行比较并修正，防止因偏离既定轨迹而造成其他事故。当完成紧急转向避撞动作后，车辆系统主控5会提醒驾驶员重新接管方向盘继续正常行驶。
转向避障路径key6i按照以下规则设置：1、规划路径曲率平滑且二阶导数连续；2、路径纵向避让距离尽量短；3、路径极值较小；4、车辆侧向位移量较小；5、曲率边界条件；6、单值函数的边界条件；7、以时间为参数自变量的边界条件。
具体实施采用了五次多项式来拟合描述转向避障路径，能够在各个时间点的横向加速度曲线光滑且连续，较为符合大多数驾驶员的行为习惯。根据路径边界条件并满足路径初始点和种子点边界要求的前提下，能够得到期望的路径(图2)。
本发明的具体实施转向控制过程如下：
通过毫米波雷达1-4实时获得当前本车和前车之间的距离ΔD、相对速度，按照以下进行紧急转向避撞控制处理：
具体设置车辆前进方向为纵向，表示为X，横向为Y。
以转向角度平顺情况考虑，车辆系统主控5通过采集自身的车辆信息获得角度倍数k和时间周期系数A，经过时间T的本车车辆的转向角度按照以下公式获得：
θ＝k sin(AT)
其中，k表示角度倍数，A表示时间周期系数，k和A均为常数参数；
根据转向角度θ实时处理获得经过时间T内前车和本车沿行驶路径的距离为：
Figure PCTCN2021133321-appb-000004
Figure PCTCN2021133321-appb-000005
其中，V 0和V 1分别表示本车和前车的速度，由于前车和本车均沿同一路线行驶，因此前车和本车的两车横向偏移为0，X 1表示前车在沿行驶路径上的纵向行驶距离，Y 1表示前车在沿行驶路径上的横向行驶距离，ΔD表示经过时间T前的前车和本车之间的纵向距离；X 0表示本车在沿行驶路径上的纵向行驶距离，Y表示本车在沿行驶路径上的横向行驶距离，d T表示本车经过时间T内的行驶距离；
根据实时获得的前车的纵向行驶距离X 1、横向行驶距离Y 1以及本车的纵向行驶距离X 0、横向行驶距离Y 0，代入以下公式并进行判断：
Figure PCTCN2021133321-appb-000006
其中，W表示车宽，D表示车间安全距离；
若同时满足上述两个公式，则能够进行安全的紧急转向。
若无法同时满足上述两个公式，则产生制动控制信号进行制动尽量减速来避免事故或者减轻事故损失。
当X 1＝X 0时，则前车和本车的两车在纵向方向上会碰撞，此时若|Y 0-Y 1|≥W+D则判定为能够通过紧急转向来避撞，能够进行安全的紧急转向。
当|Y 0-Y 1|＝W+D且X 1≥X 0时，也判定能够紧急转向避撞，能够进行安全的紧急转向。

Claims (5)

  1. 一种基于毫米波雷达的紧急转向系统，其特征在于：
    包括毫米波雷达(1-4)，布置在车身周围，探测获得车身周围的车况信息，并发送到车身CAN网络(7)；
    包括车身CAN网络(7)，接收车况信息并发送到车辆系统主控；
    包括车辆系统主控(5)，通过CAN网络接收毫米波雷达的车况信息，并采集自身的车辆信息，结合车况信息和车辆信息判断出是否能够进行安全的紧急转向：若能进行进行安全的紧急转向，则处理获得一条安全的转向避障路径，根据转向避障路径转换产生转向控制信号并发送到转向控制模块(6)；
    包括转向控制模块(6)，根据转向控制信号自动控制方向盘进行紧急转向。
  2. 根据权利要求1所述的一种基于毫米波雷达的紧急转向系统，其特征在于：车身四周各布置装有一个毫米波雷达。
  3. 根据权利要求1所述的一种基于毫米波雷达的紧急转向系统，其特征在于：还包括制动系统模块；
    所述车辆系统主控中，若不能进行进行安全的紧急转向，则处理产生制动控制信号并发送到制动系统模块，由制动系统模块根据制动控制信号自动控制制动器进行紧急制动。
  4. 根据权利要求3所述的一种基于毫米波雷达的紧急转向系统，其特征在于：所述的车辆系统主控在产生转向控制信号的同时产生提示报警信息，在主控台上向驾驶员提醒呈现。
  5. 根据权利要求4所述的一种基于毫米波雷达的紧急转向系统，其特征在于：所述的紧急转向系统布置在本车上，通过本车车身前方布置的毫米波雷达(1)探测本车和前车之间的纵向距离和横向距离。
PCT/CN2021/133321 2021-08-31 2021-11-26 一种基于毫米波雷达的紧急转向系统 WO2023029239A1 (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202111011156.6A CN113619575A (zh) 2021-08-31 2021-08-31 一种基于毫米波雷达的紧急转向系统
CN202111011156.6 2021-08-31

Publications (1)

Publication Number Publication Date
WO2023029239A1 true WO2023029239A1 (zh) 2023-03-09

Family

ID=78388449

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/133321 WO2023029239A1 (zh) 2021-08-31 2021-11-26 一种基于毫米波雷达的紧急转向系统

Country Status (2)

Country Link
CN (1) CN113619575A (zh)
WO (1) WO2023029239A1 (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113619575A (zh) * 2021-08-31 2021-11-09 浙江亚太机电股份有限公司 一种基于毫米波雷达的紧急转向系统
CN114030434A (zh) * 2021-11-30 2022-02-11 浙江亚太机电股份有限公司 基于毫米波雷达的防追尾系统
CN114043983A (zh) * 2021-11-30 2022-02-15 浙江亚太机电股份有限公司 基于车联网系统tbox的绿波带通行速度控制系统

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20160116432A (ko) * 2015-03-30 2016-10-10 주식회사 만도 차량의 충돌 방지 제어 시스템 및 그 제어방법
CN106184202A (zh) * 2016-07-26 2016-12-07 浙江吉利控股集团有限公司 一种用于车辆的自动紧急转向系统及其控制方法
CN106427998A (zh) * 2016-09-30 2017-02-22 江苏大学 一种高速状态下车辆紧急变道避撞的控制方法
CN110194159A (zh) * 2018-02-26 2019-09-03 比亚迪股份有限公司 一种车辆智能避障系统及车辆
CN111731282A (zh) * 2020-06-04 2020-10-02 南京航空航天大学 一种考虑车辆稳定性的紧急避撞系统及其控制方法
US20200369264A1 (en) * 2019-05-21 2020-11-26 Mando Corporation Collision avoidance device, vehicle having the same and method of controlling the vehicle
CN113619575A (zh) * 2021-08-31 2021-11-09 浙江亚太机电股份有限公司 一种基于毫米波雷达的紧急转向系统

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103072575B (zh) * 2013-01-18 2016-03-30 浙江吉利汽车研究院有限公司杭州分公司 一种车辆主动防碰撞方法
CN110606082A (zh) * 2019-09-25 2019-12-24 中国第一汽车股份有限公司 基于自动驾驶的制动系统、方法、装置及车辆
CN112677963B (zh) * 2021-01-07 2022-02-15 吉林大学 智能网联四轮独立转向和独立驱动电动汽车紧急避障系统

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20160116432A (ko) * 2015-03-30 2016-10-10 주식회사 만도 차량의 충돌 방지 제어 시스템 및 그 제어방법
CN106184202A (zh) * 2016-07-26 2016-12-07 浙江吉利控股集团有限公司 一种用于车辆的自动紧急转向系统及其控制方法
CN106427998A (zh) * 2016-09-30 2017-02-22 江苏大学 一种高速状态下车辆紧急变道避撞的控制方法
CN110194159A (zh) * 2018-02-26 2019-09-03 比亚迪股份有限公司 一种车辆智能避障系统及车辆
US20200369264A1 (en) * 2019-05-21 2020-11-26 Mando Corporation Collision avoidance device, vehicle having the same and method of controlling the vehicle
CN111731282A (zh) * 2020-06-04 2020-10-02 南京航空航天大学 一种考虑车辆稳定性的紧急避撞系统及其控制方法
CN113619575A (zh) * 2021-08-31 2021-11-09 浙江亚太机电股份有限公司 一种基于毫米波雷达的紧急转向系统

Also Published As

Publication number Publication date
CN113619575A (zh) 2021-11-09

Similar Documents

Publication Publication Date Title
WO2023029239A1 (zh) 一种基于毫米波雷达的紧急转向系统
CN110614998B (zh) 一种激进型辅助驾驶弯道避障换道路径规划系统及方法
US11897459B2 (en) Collision avoidance assist apparatus
CN107145147B (zh) 一种车辆低速自动驾驶避碰方法及系统
CN110723141B (zh) 一种车辆主动避撞系统及其避撞方式切换方法
CN109808685B (zh) 一种基于危险评估的汽车预警自动避撞控制方法
CN109720345B (zh) 一种切入车辆监测方法及系统
CN105644564B (zh) 一种汽车侧向主动避撞安全性判断方法
US6624747B1 (en) Method for preventing the collision of a vehicle with an obstacle located in front of the vehicle and braking device
CN108501946B (zh) 用于在车辆中产生警告的装置和方法
KR101987636B1 (ko) 차량의 충돌회피 제어 방법 및 이를 구현하는 충돌회피 장치
US11938924B2 (en) Driving assistance control apparatus for vehicle, driving assistance control system for vehicle, and driving assistance control method for vehicle
JP7272255B2 (ja) 運転支援装置
WO2021109550A1 (zh) 一种用于车辆转弯主动控制的方法及系统
JP7443177B2 (ja) 衝突回避支援装置
CN108407807B (zh) 一种商用车的转向避撞系统及其控制方法
CN103273920B (zh) 防前碰的汽车爆胎安全控制系统
US11364952B2 (en) System for recognizing trailer of vehicle and method thereof
CN206954216U (zh) 大型车辆转弯视觉盲区预警自动制动装置
CN113665578A (zh) 一种基于视觉系统和毫米波雷达的路面避坑系统
CN109849879A (zh) 适用于弯道及十字路口的自动紧急制动系统及方法
CN113232648A (zh) 针对弱势道路使用者的汽车避撞系统及其控制方法
CN113561947B (zh) 一种乘用车自动制动方法、装置及系统
CN216467658U (zh) 一种基于毫米波雷达用于车辆防追尾的监控装置
CN114030434A (zh) 基于毫米波雷达的防追尾系统

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: 21955767

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE