Nothing Special   »   [go: up one dir, main page]

CN112606828B - 自动泊车控制装置、方法及车辆 - Google Patents

自动泊车控制装置、方法及车辆 Download PDF

Info

Publication number
CN112606828B
CN112606828B CN202011447147.7A CN202011447147A CN112606828B CN 112606828 B CN112606828 B CN 112606828B CN 202011447147 A CN202011447147 A CN 202011447147A CN 112606828 B CN112606828 B CN 112606828B
Authority
CN
China
Prior art keywords
parking
torque
distance
zero
vehicle
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.)
Active
Application number
CN202011447147.7A
Other languages
English (en)
Other versions
CN112606828A (zh
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 CN202011447147.7A priority Critical patent/CN112606828B/zh
Publication of CN112606828A publication Critical patent/CN112606828A/zh
Application granted granted Critical
Publication of CN112606828B publication Critical patent/CN112606828B/zh
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/06—Automatic manoeuvring for parking
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00—Control parameters of input or output; Target parameters
    • B60L2240/10—Vehicle control parameters
    • B60L2240/12—Speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00—Control parameters of input or output; Target parameters
    • B60L2240/40—Drive Train control parameters
    • B60L2240/42—Drive Train control parameters related to electric machines
    • B60L2240/423—Torque
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/72—Electric energy management in electromobility

Landscapes

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

Abstract

本发明公开一种自动泊车控制装置、方法及车辆，所述装置包括：一种自动泊车控制装置，所述自动泊车控制装置包括：泊车控制器，用于接收自动泊车请求，并获取车辆周围的环境数据，以响应所述自动泊车请求，并根据所述环境数据，确定目标距离及最大泊车车速；整车控制器，与所述泊车控制器相连，所述整车控制器用于根据所述目标距离、所述最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩；电子稳定性控制器，与所述泊车控制器相连，所述电子稳定性控制器用于确定所述最大泊车车速为零或者所述目标距离小于或者等于零，则通知所述整车控制器将所述实际泊车扭矩设置为零。本发明可在泊车过程中，遇到障碍物时，实现对车辆平稳制动。

Description

自动泊车控制装置、方法及车辆
技术领域
本发明涉及自动泊车技术领域，具体涉及一种自动泊车控制装置、方法及车辆。
背景技术
现有技术，在自动泊车过程中，对距离控制精度不高，当车辆遇到障碍物时，往往刹车比较急，用户体验不好。
发明内容
本发明的目的是提供一种自动泊车控制装置、方法及车辆，可在泊车过程中，遇到障碍物时，实现对车辆平稳制动。
本发明实施例提供了以下方案：
第一方面，本发明实施例提供一种自动泊车控制装置，所述自动泊车控制装置包括：
泊车控制器，用于接收自动泊车请求，并获取车辆周围的环境数据，以响应所述自动泊车请求，并根据所述环境数据，确定目标距离及最大泊车车速；
整车控制器，与所述泊车控制器相连，所述整车控制器用于根据所述目标距离、所述最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩，其中，当所述目标泊车距离大于或者等于所述最小泊车距离，所述实际泊车扭矩大于或者等于零，当所述目标泊车距离小于所述最小泊车距离，所述实际泊车扭矩小于或者等于零；
电子稳定性控制器，与所述泊车控制器相连，所述电子稳定性控制器用于确定所述最大泊车车速为零或者所述目标距离小于或者等于零，则通知所述整车控制器将所述实际泊车扭矩设置为零，并通过车辆制动装置对车辆制动；以及
电机控制器，与所述整车控制器相连，所述电机控制器用于根据所述实际泊车扭矩控制所述车辆的电机运行。
可选的，所述整车控制器根据所述最大泊车车速，确定第一扭矩；根据所述目标距离及所述最小泊车距离的差值，确定第二扭矩；确定所述第一扭矩与所述第二扭矩中较小者为第三扭矩；以及根据所述第三扭矩及所述第三扭矩的变化率，确定所述实际泊车扭矩。
可选的，当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和大于零时，则所述实际泊车扭矩等于所述第三扭矩与所述变化率之和；以及当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和小于零时，则所述实际泊车扭矩为零。
可选的，当所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述第三扭矩的变化率之和小于零时，则所述实际泊车扭矩等于所述第三扭矩与所述变化率之和；以及当所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述变化率之和大于零时，则所述实际泊车扭矩为零。
可选的，当所述电子稳定性控制器确定所述最大泊车车速为零或者所述目标距离为零时，则设置所述电子稳定性控制器的制动标志位设置为预设值，并将所述制动标志位发送至所述整车控制器，所述整车控制器根据所述制动标志位将所述实际泊车扭矩设置为零。
第二方面，本发明实施例提供一种自动泊车控制方法，所述方法包括：
接收自动泊车请求，并获取车辆周围环境数据，以响应所述自动泊车请求；
根据所述环境数据，确定目标距离及最大泊车车速；
根据所述目标距离、所述最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩，其中，当所述目标泊车距离大于或者等于所述最小泊车距离，所述实际泊车扭矩大于或者等于零，当所述目标泊车距离小于所述最小泊车距离，所述实际泊车扭矩小于或者等于零；
确定所述最大泊车车速为零或者所述目标距离小于或者等于零，则将所述实际泊车扭矩设置为零，并通过车辆制动装置对车辆制动；以及
根据所述实际泊车扭矩控制所述车辆。
可选的，所述根据所述目标距离、所述最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩包括：
根据所述最大泊车车速，确定第一扭矩；
根据所述目标距离及设定的最小泊车距离的差值，确定第二扭矩；
确定所述第一扭矩与所述第二扭矩中较小者为第三扭矩；以及
根据所述第三扭矩及所述第三扭矩的变化率，确定实际泊车扭矩。
可选的，所述根据所述第三扭矩及所述第三扭矩的变化率，确定实际泊车扭矩包括：
当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和大于零时，则所述实际泊车扭矩等于所述第三扭矩与所述变化率之和；以及当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和小于零时，则所述实际泊车扭矩为零。
可选的，所述根据所述第三扭矩及所述第三扭矩的变化率，确定实际泊车扭矩包括：
如果所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述扭矩的变化率之和小于零，则所述实际泊车扭矩等于所述第三扭矩与所述扭矩的变化率之和；以及
如果所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述扭矩的变化率之和大于零，则所述实际泊车扭矩为零。
第三方面，本发明实施例提供一种车辆，所述车辆包括：
感测装置，用于感测车辆的周围环境数据；
电机；
上述的自动泊车控制装置，与所述感测装置及电机相连，用于获取所述环境数据，并控制所述电机运行。
本发明与现有技术相比，具有如下的优点和有益效果：
本发明实施例通过设定最小泊车距离，在目标泊车距离大于最小泊车距离，车辆距离障碍物较远时，通过VCU发送至电机控制器的实际泊车扭矩为正值，电机控制器控制电机正转，驱动车辆前进，在目标泊车距离小于或者等于最小泊车距离，车辆距离障碍物较近时，通过VCU发送至电机控制器的实际泊车扭矩为负值，电机控制器控制给电机反向的力，控制车辆减速，在低速情况下辅助车辆制动。在所述最大泊车车速为零或者所述目标距离小于或者等于零，车辆到达障碍物时，ESC参与车辆制动，在VCU和ESC共同制动下，保证了制动的平稳性。
附图说明
为了更清楚地说明本说明书实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本说明书的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的一种自动泊车控制装置的功能模块图；
图2是图1所示的自动泊车控制装置的确定第一扭矩的示意图；
图3是图1所示的自动泊车控制装置的确定第二扭矩的示意图；
图4是图1所示的自动泊车控制装置的第三扭矩的一维查表图；
图5是图1所示的自动泊车控制装置的第三扭矩的一维查表曲线图；
图6是本发明一个实施例提供的一种自动泊车控制方法的流程图；
图7是图6所示的自动泊车控制方法的步骤S3的流程图；
图8是本发明另一实施例提供的一种自动泊车控制方法的流程图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整的描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例，基于本发明实施例，本领域普通技术人员所获得的所有其他实施例，都属于本发明实施例保护的范围。
请参阅图1，图1为本发明实施例提供的一种自动泊车控制装置10的模块图。自动泊车控制装置10应用于车辆100，对车辆100进行自动泊车控制。车辆100还包括感测装置20、电机30及车辆制动装置40。感测装置20包括设置于车辆100上的雷达21、传感器22、及摄像头23，用于感测车辆100的周围环境数据。
自动泊车控制装置10包括泊车控制器11、VCU(Vehicle control unit，整车控制器)12、ESC(Electronic Stability Controller，电子稳定性控制器)13以及电机控制器14。
泊车控制器11用于接收自动泊车请求，并获取车辆100周围的环境数据，以响应自动泊车请求，根据环境数据，确定目标距离及最大泊车车速。VCU12与泊车控制器10相连，VCU12用于根据目标距离、最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩。ESC13与泊车控制器10相连，ESC13用于确定最大泊车车速为零或者目标距离为零，则通知VCU12将实际泊车扭矩设置为零，并通过车辆制动装置40对车辆制动。电机控制器14与VCU12相连，电机控制器14用于根据实际泊车扭矩控制车辆100的电机30运行。
具体地，当驾驶员需车辆100进行自动泊车时，驾驶员可以通过预设的指令输入装置输入自动泊车请求，例如，可以通过语音输入的方式输入自动泊车请求，或者是通过触发驾驶室内的预设按钮的方式输入自动泊车请求，泊车控制器10接收自动泊车请求，通过感测装置获取车辆100周围的环境数据。环境数据包括障碍物的距离以及路况等，障碍物可以是人、动物等活动体，也可以是围栏、主体、墙面等固定物。
在本实施例中，目标距离为障碍物的距离。最大泊车车速可为根据路况查询获得在路况下的自动泊车的最高车速。在本实施例中，最大泊车车速为5km/h。最小泊车距离由车辆100的雷达21的最小感测距离确定，在本实施例中，最小泊车距离在5cm至20cm之间。
在本实施例中，VCU12根据最大泊车车速，确定第一扭矩；根据目标距离及最小泊车距离的差值，确定第二扭矩；VCU12确定第一扭矩与第二扭矩中较小者为第三扭矩；以及根据第三扭矩及第三扭矩的变化率，确定实际泊车扭矩。
具体地，请一并参阅图2及图3，VCU12的PID控制器121将最大泊车车速作为PID(比例-积分-微分)控制器121的输入信号，经PID计算后，输出信号为第一扭矩Tq1。VCU12的运算器132将目标距离L和最小泊车距离Lmin的差值作为PID控制器121的输入信号，经PID计算后，输出信号为第二扭矩Tq2，PID控制器121比较第一扭矩Tq1和第二扭矩Tq2的大小，并确定第一扭矩Tq1与第二扭矩Tq2中较小者为第三扭矩Tq3。
进一步，为了防止第三扭矩Tq3的变化过快或者过慢，VCU12还对第三扭矩的变化率做限定处理。
具体地，VCU12周期地计算第三扭矩，例如，当前周期计算得到的第三扭矩为Tq3_1，下一周期计算得到的第三扭矩为Tq3_2，两个周期计算得到的第三扭矩差值ΔT＝(Tq3_1-Tq3_2)，ΔT为第三扭矩的变化率。
在本实施例中，对第三扭矩的变化率通过查询表得到，将目标距离L作为输入，查表得到第三扭矩的变化率ΔT。例如，设定目标距离Ldate＝[-20、-10、0、10、20、30、40、50]，第三扭矩的变化率ΔT＝[-1、-0.5、0、0.5、1、1.5、2、2]，根据目标距离Ldate和第三扭矩的变化率ΔT生成一维查表图(如图4所示)以及对应的一维查表曲线图(如图5所示)。由图5可知，X轴的目标距离Ldate，可以得到第三扭矩的变化率ΔT。上述示例仅为便于理解一维查表而举例的数值，实际并不限于上述数值，根据不同的车型参数可以设定不同的值，上述数值可以通过对车辆进行测试得到。
在本实施例中，当目标泊车距离大于最小泊车距离时，车辆100距离障碍物较远，计算得到第二扭矩大于或者等于零，此时，如果第三扭矩与变化率之和大于零时，则实际泊车扭矩等于第三扭矩与变化率之和。具体地，如果第三扭矩在增加，即Tq3_2>Tq3_1，通过一维查表得到变化率为ΔT，VCU12计算得到的实际泊车扭矩为驱动扭矩Tq_Drv＝Tq3_1+|ΔT|；如果第三扭矩在减小，即Tq3_2<Tq3_1，则VCU12计算得到的驱动扭矩Tq_Drv＝Tq3_1-|ΔT|，并且设定当第三扭矩与变化率之和小于零，即Tq3_1-|ΔT|<0时，则驱动扭矩Tq_Drv＝0，保证驱动扭矩Tq_Drv的值不是负数。此时，电机控制器14根据实际泊车扭矩控制电机30正向转动，驱动车辆100前进。
当目标泊车距离小于最小泊车距离时，车辆100距离障碍物较近，计算得到第二扭矩小于零，此时，如果第三扭矩与第三扭矩的变化率之和小于零，则实际泊车扭矩等于第三扭矩与变化率之和。具体地，如果第三扭矩在增加，即|Tq3_2|>|Tq3_1|，通过一维查表得到变化率为ΔT，VCU12计算得到的实际泊车扭矩为反向扭矩Tq_Brk＝Tq3_1-|ΔT|；如果第三扭矩在减小，即|Tq3_2|<Tq3_1|，则VCU12计算得到的反向扭矩Tq_Brk＝Tq3_1+|ΔT|，并且如果第三扭矩与变化率之和大于零，即Tq3_1+|ΔT|>0时，则反向扭矩Tq_Brk＝0，保证反向扭矩Tq_Drv的值不是正数，此时，实际泊车扭矩小于或者等于零，电机控制器14根据实际泊车扭矩控制电机30反向转动，控制车辆100减速，以便在低速情况下，辅助车辆100制动。
在车辆100自动泊车的过程中，ESC13从泊车控制器11获取目标距离及最大泊车车速，当ESC13确定最大泊车车速为零或者目标距离小于或者等于零时，车辆100到达障碍物或者泊车终点，ESC13设置ESC13的制动标志位设置为预设值，例如，高电平，并将制动标志位发送至VCU12，通知VCU12根据制动标志位将实际泊车扭矩设置为零，并通过车辆制动装置40对车辆制动。ESC13参与车辆制动，ESC13和VCU12共同制动，保证了制动的平稳性。可以理解，制动标志位的默认值可为低电平，此时，ESC13不参与车辆100的制动。
在另一实施例中，VCU12通过在车载MP5上设置语音播报功能，当车辆100与障碍物的距离达到预设距离时，泊车控制器11通过雷达21将车辆100与障碍物的距离发送到车载MP5上，MP5的语音播报功能播报车辆与障碍物的距离，让用户可以清楚的知道车辆100与障碍物的距离。
请一并参阅图6，基于与方法同样的发明构思，本发明实施例还提供了一种自动泊车控制方法，方法包括如下步骤：
步骤S1，接收自动泊车请求，并获取车辆周围环境数据，以响应自动泊车请求。
步骤S2，根据环境数据，确定目标距离及最大泊车车速。
步骤S3，根据目标距离、最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩。请一并参阅图7，步骤S3包括以下步骤：
步骤S31，根据最大泊车车速，确定第一扭矩。
步骤S32，根据目标距离及设定的最小泊车距离的差值，确定第二扭矩。
步骤S33，确定第一扭矩与第二扭矩中较小者为第三扭矩。
步骤S34，根据第三扭矩及第三扭矩的变化率，确定实际泊车扭矩。
具体地，如果目标泊车距离大于最小泊车距离，且第三扭矩与变化率之和大于零时，则实际泊车扭矩等于第三扭矩与变化率之和；以及当目标泊车距离大于最小泊车距离，且第三扭矩与变化率之和小于零时，则实际泊车扭矩为零。
如果目标泊车距离小于最小泊车距离，且第三扭矩与扭矩的变化率之和小于零，则实际泊车扭矩等于第三扭矩与扭矩的变化率之和；以及如果目标泊车距离小于最小泊车距离，且第三扭矩与扭矩的变化率之和大于零，则实际泊车扭矩为零。
步骤S4，确定最大泊车车速为零或者目标距离小于或者等于零，则将实际泊车扭矩设置为零。
具体地，当最大泊车车速为零或者目标距离小于或者等于零时，则设置ESC13的制动标志位设置为预设值，并根据制动标志位将实际泊车扭矩设置为零。
步骤S5，根据实际泊车扭矩控制车辆的电机运行。
请参阅图8，在一个具体实施例中，所述自动泊车控制方法包括如下步骤：
步骤S101，当驾驶员需车辆100进行自动泊车时，驾驶员可以通过预设的指令输入装置输入自动泊车请求，车辆100的自动泊车系统激活。泊车控制器11接收自动泊车请求，并获取车辆100周围的环境数据，以响应自动泊车请求，根据环境数据，确定目标距离L及最大泊车车速V。
步骤S102，VCU12从泊车控制器11接收目标距离L及最大泊车车速V，进入步骤S105、S106或者S110。
步骤S103，ESC13从泊车控制器11接收目标距离L及最大泊车车速V，进入步骤S104。可以理解，步骤S102与步骤S103可同时进行。
步骤S104，ESC13确定最大泊车车速V为零或者目标距离L小于或者等于零时，车辆100到达障碍物或者泊车终点，ESC13设置ESC13的制动标志位设置为预设值，例如，1(高电平)，并将制动标志位发送至VCU12，此时，ESC13通过车辆制动装置40对车辆制动。可以理解，制动标志位的默认值可为0(低电平)。
步骤S105，VCU12根据最大泊车车速，通过PID控制器121，计算得到第一扭矩Tq1。
步骤S106，如果目标距离L大于或者等于最小泊车距离Lmin，VCU12通过PID控制器，计算得到正扭矩Tq2。
步骤S107，PID控制器121比较第一扭矩Tq1和第二扭矩Tq2的大小，并确定第一扭矩Tq1与第二扭矩Tq2中较小者为第三扭矩Tq3。
步骤S108，VCU结合扭矩变化率计算得到实际泊车扭矩为驱动扭矩Tq_Drv。
步骤S119，电机控制器14收到VCU12发送的驱动扭矩Tq_Drv，控制电机30正转驱动，此时，车辆100进入驱动状态。
步骤S110，如果目标距离L小于最小泊车距离Lmin，VCU12通过PID控制器121，计算得到负扭矩Tq2。
步骤S111，VCU12判断ESC13的制动标志位是否为1，如果制动标志位为1，则进入步骤S112，如果制动标志位不为1，则进入步骤S115。
步骤S112，PID控制器121比较第一扭矩Tq1和第二扭矩Tq2的大小，并确定第一扭矩Tq1与第二扭矩Tq2中较小者为第三扭矩Tq3。
步骤S113，VCU12结合扭矩变化率计算得到反向扭矩Tq_Drv。
步骤S114，电机控制器14接收VCU12的反向扭矩Tq_Drv控制电机反转制动，此时，车辆进入制动状态。
步骤S115，VCU12根据所述制动标志位将所述实际泊车扭矩设置为零，车辆进入制动状态。
本发明实施例中提供的技术方案，至少具有如下技术效果或优点：
本发明实施例通过设定最小泊车距离，在目标泊车距离大于最小泊车距离，车辆距离障碍物较远时，通过VCU12发送至电机控制器14的实际泊车扭矩为正值，电机控制器14控制电机30正转，驱动车辆前进，在目标泊车距离小于或者等于最小泊车距离，车辆距离障碍物较近时，通过VCU12发送至电机控制器14的实际泊车扭矩为负值，电机控制器14控制给电机30反向的力，控制车辆100减速，在低速情况下辅助车辆100制动。在所述最大泊车车速为零或者所述目标距离小于或者等于零，车辆100到达障碍物时，ESC13参与车辆100制动，在VCU12和ESC13共同制动下，保证了制动的平稳性。
本发明实施例在自动泊车时，当车辆100与障碍物距离较近时，在MP5上语音播报障碍物的距离，让用户清晰的知道障碍物的距离。
尽管已描述了本发明的优选实施例，但本领域内的技术人员一旦得知了基本创造概念，则可对这些实施例作出另外的变更和修改。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。
显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包括这些改动和变型在内。

Claims (10)

1.一种自动泊车控制装置，其特征在于，所述自动泊车控制装置包括：
泊车控制器，用于接收自动泊车请求，并获取车辆周围的环境数据，以响应所述自动泊车请求，并根据所述环境数据，确定目标距离及最大泊车车速；
整车控制器，与所述泊车控制器相连，所述整车控制器用于根据所述目标距离、所述最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩，其中，当所述目标泊车距离大于或者等于所述最小泊车距离，所述实际泊车扭矩大于或者等于零，当所述目标泊车距离小于所述最小泊车距离，所述实际泊车扭矩小于或者等于零；
电子稳定性控制器，与所述泊车控制器相连，所述电子稳定性控制器用于确定所述最大泊车车速为零或者所述目标距离小于或者等于零，则通知所述整车控制器将所述实际泊车扭矩设置为零，并通过车辆制动装置对车辆制动；以及
电机控制器，与所述整车控制器相连，所述电机控制器用于根据所述实际泊车扭矩控制所述车辆的电机运行。
2.根据权利要求1所述的自动泊车控制装置，其特征在于，所述整车控制器根据所述最大泊车车速，确定第一扭矩；根据所述目标距离及所述最小泊车距离的差值，确定第二扭矩；确定所述第一扭矩与所述第二扭矩中较小者为第三扭矩；以及根据所述第三扭矩及所述第三扭矩的变化率，确定所述实际泊车扭矩。
3.根据权利要求2所述的自动泊车控制装置，其特征在于，当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和大于零时，则所述实际泊车扭矩等于所述第三扭矩与所述变化率之和；以及当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和小于零时，则所述实际泊车扭矩为零。
4.根据权利要求3所述的自动泊车控制装置，其特征在于，当所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述第三扭矩的变化率之和小于零时，则所述实际泊车扭矩等于所述第三扭矩与所述变化率之和；以及当所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述变化率之和大于零时，则所述实际泊车扭矩为零。
5.根据权利要求3所述的自动泊车控制装置，其特征在于，当所述电子稳定性控制器确定所述最大泊车车速为零或者所述目标距离为零时，则设置所述电子稳定性控制器的制动标志位设置为预设值，并将所述制动标志位发送至所述整车控制器，所述整车控制器根据所述制动标志位将所述实际泊车扭矩设置为零。
6.一种自动泊车控制方法，其特征在于，所述方法包括：
接收自动泊车请求，并获取车辆周围环境数据，以响应所述自动泊车请求；
根据所述环境数据，确定目标距离及最大泊车车速；
根据所述目标距离、所述最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩，其中，当所述目标泊车距离大于或者等于所述最小泊车距离，所述实际泊车扭矩大于或者等于零，当所述目标泊车距离小于所述最小泊车距离，所述实际泊车扭矩小于或者等于零；
确定所述最大泊车车速为零或者所述目标距离小于或者等于零，则将所述实际泊车扭矩设置为零，通过车辆制动装置对车辆制动；以及
根据所述实际泊车扭矩控制所述车辆。
7.根据权利要求6所述的自动泊车控制方法，其特征在于，所述根据所述目标距离、所述最大泊车车速及设定的最小泊车距离，确定实际泊车扭矩包括：
根据所述最大泊车车速，确定第一扭矩；
根据所述目标距离及设定的最小泊车距离的差值，确定第二扭矩；
确定所述第一扭矩与所述第二扭矩中较小者为第三扭矩；以及
根据所述第三扭矩及所述第三扭矩的变化率，确定实际泊车扭矩。
8.根据权利要求7所述的自动泊车控制方法，其特征在于，所述根据所述第三扭矩及所述第三扭矩的变化率，确定实际泊车扭矩包括：
当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和大于零时，则所述实际泊车扭矩等于所述第三扭矩与所述变化率之和；以及当所述目标泊车距离大于所述最小泊车距离，且所述第三扭矩与所述变化率之和小于零时，则所述实际泊车扭矩为零。
9.根据权利要求7所述的自动泊车控制方法，其特征在于，所述根据所述第三扭矩及所述第三扭矩的变化率，确定实际泊车扭矩包括：
如果所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述扭矩的变化率之和小于零，则所述实际泊车扭矩等于所述第三扭矩与所述扭矩的变化率之和；以及
如果所述目标泊车距离小于所述最小泊车距离，且所述第三扭矩与所述扭矩的变化率之和大于零，则所述实际泊车扭矩为零。
10.一种车辆，所述车辆包括：
感测装置，用于感测车辆的周围环境数据；
电机；
自动泊车控制装置，与所述感测装置及电机相连，用于获取所述环境数据，并控制所述电机运行，其特征在于，所述自动泊车控制装置为权利要求1-5任意一项所述自动泊车控制装置。
CN202011447147.7A 2020-12-11 2020-12-11 自动泊车控制装置、方法及车辆 Active CN112606828B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011447147.7A CN112606828B (zh) 2020-12-11 2020-12-11 自动泊车控制装置、方法及车辆

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011447147.7A CN112606828B (zh) 2020-12-11 2020-12-11 自动泊车控制装置、方法及车辆

Publications (2)

Publication Number Publication Date
CN112606828A CN112606828A (zh) 2021-04-06
CN112606828B true CN112606828B (zh) 2022-02-01

Family

ID=75234382

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011447147.7A Active CN112606828B (zh) 2020-12-11 2020-12-11 自动泊车控制装置、方法及车辆

Country Status (1)

Country Link
CN (1) CN112606828B (zh)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20130142346A (ko) * 2012-06-19 2013-12-30 현대모비스 주식회사 스마트 전기자동차 및 이의 운용방법
CN106467131A (zh) * 2016-08-31 2017-03-01 东风汽车公司 基于电动助力转向系统的泊车辅助系统与方法
FR3063701A1 (fr) * 2017-03-08 2018-09-14 Renault S.A.S Procede et systeme d'aide au stationnement d'un vehicule automobile
CN109131319A (zh) * 2018-10-19 2019-01-04 北京经纬恒润科技有限公司 一种自动泊车扭矩控制方法和装置
CN109501797A (zh) * 2018-12-07 2019-03-22 威马汽车科技集团有限公司 一种自动泊车的控制方法及自动泊车系统
CN110155042A (zh) * 2019-04-29 2019-08-23 江铃汽车股份有限公司 混和动力汽车的自动泊车系统及方法
CN110171412A (zh) * 2019-06-27 2019-08-27 浙江吉利控股集团有限公司 用于车辆的障碍物识别方法及系统
CN110347167A (zh) * 2019-08-27 2019-10-18 广州小鹏汽车科技有限公司 一种速度规划方法及速度规划系统
CN111791881A (zh) * 2020-07-17 2020-10-20 上海汽车集团股份有限公司 一种自动泊车方法及装置

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6000693B2 (ja) * 2012-07-03 2016-10-05 日立オートモティブシステムズ株式会社 駐車支援装置
JP6573795B2 (ja) * 2015-07-31 2019-09-11 アイシン精機株式会社 駐車支援装置、方法及びプログラム
US20170144661A1 (en) * 2015-11-20 2017-05-25 Ford Global Technologies, Llc Vehicle speed control system
US11161547B2 (en) * 2016-09-09 2021-11-02 Mitsubishi Electric Corporation Parking assistance device
KR101915165B1 (ko) * 2016-12-30 2018-11-06 현대자동차주식회사 자동 주차 시스템 및 자동 주차 방법
CN109624969A (zh) * 2018-12-24 2019-04-16 北京新能源汽车股份有限公司 一种自动泊车控制方法、装置及电动汽车
CN110126820B (zh) * 2019-05-17 2021-05-07 浙江吉利控股集团有限公司 自动泊车系统、泊车方法及车辆
CN110562246A (zh) * 2019-08-26 2019-12-13 中国第一汽车股份有限公司 一种泊车控制方法、装置、车辆和存储介质

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20130142346A (ko) * 2012-06-19 2013-12-30 현대모비스 주식회사 스마트 전기자동차 및 이의 운용방법
CN106467131A (zh) * 2016-08-31 2017-03-01 东风汽车公司 基于电动助力转向系统的泊车辅助系统与方法
FR3063701A1 (fr) * 2017-03-08 2018-09-14 Renault S.A.S Procede et systeme d'aide au stationnement d'un vehicule automobile
CN109131319A (zh) * 2018-10-19 2019-01-04 北京经纬恒润科技有限公司 一种自动泊车扭矩控制方法和装置
CN109501797A (zh) * 2018-12-07 2019-03-22 威马汽车科技集团有限公司 一种自动泊车的控制方法及自动泊车系统
CN110155042A (zh) * 2019-04-29 2019-08-23 江铃汽车股份有限公司 混和动力汽车的自动泊车系统及方法
CN110171412A (zh) * 2019-06-27 2019-08-27 浙江吉利控股集团有限公司 用于车辆的障碍物识别方法及系统
CN110347167A (zh) * 2019-08-27 2019-10-18 广州小鹏汽车科技有限公司 一种速度规划方法及速度规划系统
CN111791881A (zh) * 2020-07-17 2020-10-20 上海汽车集团股份有限公司 一种自动泊车方法及装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于多传感器多路径规划自动泊车系统仿真及实车验证;高航等;《自动化与仪器仪表》;20110725(第04期);全文 *

Also Published As

Publication number Publication date
CN112606828A (zh) 2021-04-06

Similar Documents

Publication Publication Date Title
US10239522B2 (en) Inter-vehicle control apparatus
CN107458376B (zh) 一种自适应巡航控制方法、装置及汽车
US9452755B2 (en) Vehicle travel control apparatus
EP1375234A2 (en) Driving assist system for vehicle
RU2570191C2 (ru) Вспомогательная система управления транспортным средством
CN110678372B (zh) 车辆控制装置
CN108128210B (zh) 蠕行扭矩输出控制方法及装置、汽车
US10421394B2 (en) Driving assistance device, and storage medium
CN111923923A (zh) 将转向控制从自动驾驶车辆转换为驾驶员
JP2013517178A (ja) 車両のための始動支援装置
CN111610782B (zh) 用于车辆的纵向运动控制的方法和装置
US20210370985A1 (en) Method and apparatus for controlling autonomous driving
JP5375677B2 (ja) 走行支援装置、方法およびプログラム
KR20210134128A (ko) 자율 주행 제어 방법 및 장치
CN114040870A (zh) 用于对运输工具的变道过程进行支持的方法和设备
CN112606828B (zh) 自动泊车控制装置、方法及车辆
US20220203988A1 (en) Method for driving a vehicle platoon
CN111886169B (zh) 自动驾驶车辆的控制方法以及控制装置
EP3904182B1 (en) Autonomous driving control method and device
JP7226238B2 (ja) 車両制御システム
CN115092122B (zh) 一种基于esc控制的纵向控制、自动泊车方法及装置
JP4875006B2 (ja) 運転支援装置、運転支援方法および運転支援プログラム
CN114274791B (zh) 一种纯电动汽车行驶方向前进与倒退切换的扭矩控制方法
CN115973142A (zh) 一种车辆驱动控制方法、系统以及车辆
JP2020104590A (ja) 車両制御装置

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