CN109017983A - 行驶辅助*** - Google Patents
行驶辅助*** Download PDFInfo
- Publication number
- CN109017983A CN109017983A CN201810588968.9A CN201810588968A CN109017983A CN 109017983 A CN109017983 A CN 109017983A CN 201810588968 A CN201810588968 A CN 201810588968A CN 109017983 A CN109017983 A CN 109017983A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- traveling
- turning radius
- setting
- angle
- 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
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/021—Determination of steering angle
- B62D15/024—Other means for determination of steering angle without directly measuring it, e.g. deriving from wheel speeds on different sides of the car
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/08—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits responsive only to driver input torque
- B62D6/10—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits responsive only to driver input torque characterised by means for sensing or determining torque
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/001—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits the torque NOT being among the input 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
- B60W40/072—Curvature of the road
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/114—Yaw movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/027—Parking aids, e.g. instruction means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/002—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels
-
- 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
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/20—Steering systems
- B60W2510/205—Steering speed
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/28—Wheel speed
-
- 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- 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/30—Road curve radius
-
- 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供能够提高行驶中的车辆的转弯半径的推定精度的行驶辅助***。行驶辅助***具有:第一检测部,该第一检测部检测作为与车辆的左侧车轮的旋转相关的信息的第一旋转信息;第二检测部,该第二检测部检测作为与所述车辆的右侧车轮的旋转相关的信息的第二旋转信息;以及处理部,该处理部根据所述第一旋转信息和所述第二旋转信息来推定所述车辆行驶的行驶路径上的行驶转弯圆的行驶转弯半径。
Description
技术领域
本发明涉及行驶辅助***。
背景技术
公知有在车辆的停车等行驶时通过自动运转等来辅助行驶的***。在这样的***中,根据与方向盘等转向部的转向角相关联地预先存储在存储装置等的车辆的转弯半径来控制车辆。
专利文献1:日本特开2010-269707号公报
然而,有时由于每个车辆的特性等而导致车辆按照预先与转向角相关联的转弯半径所不同的转弯半径进行行驶,在这样的情况下,存在无法精度良好地推定车辆实际上行驶的行驶路径的转弯半径的课题。
发明内容
本发明鉴于上述课题而完成的,其目的在于,提供能够以较高的精度推定行驶中的车辆的转弯半径的行驶辅助***。
用于解决课题的手段
为了解决上述的课题并达成目的,本发明的行驶辅助***具有:第一检测部,该第一检测部检测作为与车辆的左侧车轮的旋转相关的信息的第一旋转信息;第二检测部,该第二检测部检测作为与所述车辆的右侧车轮的旋转相关的信息的第二旋转信息;以及处理部,该处理部根据所述第一旋转信息和所述第二旋转信息来推定所述车辆所行驶的行驶路径上的行驶转弯圆的行驶转弯半径。
这样,在本发明的行驶辅助***中,检测部检测与实际的左右车轮的旋转相关的旋转信息,处理部根据该旋转信息来推定行驶转弯半径。由此,与根据被车辆的特性等所左右的转向角等来推定行驶转弯半径的情况相比,行驶辅助***能够以较高的精度来推定实际行驶的行驶转弯半径。
在本发明的行驶辅助***中,也可以是,所述处理部根据所述行驶转弯半径来计算用于校正转向部的转向角的校正值,所述转向部对所述车辆的转向轮进行操作。
这样,在本发明的行驶辅助***中,由于处理部根据以较高的精度推定出的行驶转弯半径来计算校正值,因此能够在自动运转等中,进一步使车辆沿着设定路径行驶。
在本发明的行驶辅助***中,也可以是,所述处理部根据将舵角增减率或作为多个所述舵角增减率的平均值的舵角增减率平均值乘以小于1的第一校正系数而得到的临时校正值来计算所述校正值,该舵角增减率是朝向目标地点的设定路径上的设定转弯圆的设定转弯半径与所述行驶转弯半径的比率。
这样,在本发明的行驶辅助***中,由于处理部将小于1的第一校正系数乘以舵角增减率平均值来计算校正值,因此即使在舵角增减率平均值等为异常值的情况下,也能够降低异常值对校正值的影响。
在本发明的行驶辅助***中,也可以是,如果所述舵角增减率或所述舵角增减率平均值的偏差为预先设定的偏差阈值以上,则所述处理部根据将所述舵角增减率或所述舵角增减率平均值乘以比所述第一校正系数小的第二校正系数而得到的所述临时校正值来计算所述校正值。
这样,在本发明的行驶辅助***中,在舵角增减率平均值等的偏差较大的情况下,处理部将舵角增减率平均值等乘以比第一校正系数小的第二校正系数来计算校正值,因此能够降低不适当的舵角增减率平均值等对校正值的影响。
在本发明的行驶辅助***中,也可以是,所述处理部根据与朝向目标地点的设定路径上的设定转弯圆的设定转弯半径相关联的目标转向角、和检测出的转向部的检测转向角,而在所述行驶路径上设定开始点,在所述设定转弯圆结束的所述行驶路径上的地点设定结束点,基于根据所述第一旋转信息和所述第二旋转信息而计算出的所述开始点和所述结束点的坐标来推定所述行驶转弯半径。
这样,在本发明的行驶辅助***中,由于处理部基于根据实测的旋转信息而计算出的开始点和结束点的坐标来计算行驶转弯半径,因此能够计算精度较高的行驶转弯半径。
在本发明的行驶辅助***中,也可以是,所述处理部根据所述第一旋转信息和所述第二旋转信息而在作为开始点角度与结束点角度的平均角度的所述行驶路径上的地点设定中间点,该开始点角度是所述开始点的所述车辆的方向与基准方向的角度,该结束点角度是所述结束点的所述车辆的方向与所述基准方向的角度,所述处理部基于根据所述第一旋转信息和所述第二旋转信息而计算出的所述开始点、所述中间点和所述结束点的坐标来推定所述行驶转弯半径。
这样,在本发明的行驶辅助***中,由于处理部基于根据旋转信息而计算出的开始点和结束点的角度来设定中间点,因此与根据开始点与结束点的距离等来设定中间点的情况相比,能够使中间点与开始点和结束点的距离相等并变大。由此,行驶辅助***能够计算精度更高的行驶转弯半径。
在本发明的行驶辅助***中,也可以是,所述处理部在所述行驶路径上的所述中间点的前后设定多个副中间点,所述处理部根据多个临时行驶转弯半径来推定所述行驶转弯半径,该多个临时行驶转弯半径是基于根据所述第一旋转信息和所述第二旋转信息计算出的所述开始点、所述中间点、所述多个副中间点以及所述结束点的坐标而计算出的。
这样,在本发明的行驶辅助***中,由于处理部基于根据中间点和多个副中间点而计算出的多个临时行驶转弯半径来推定行驶转弯半径,因此能够计算精度更高的行驶转弯半径。
附图说明
图1是搭载有实施方式的停车辅助***的车辆的俯视图。
图2是表示实施方式的行驶辅助***的整体结构的框图。
图3是说明行驶辅助装置的功能的功能框图。
图4是表示转向表的一例的图。
图5是表示校正前的设定路径和行驶路径的图。
图6是表示校正前的设定路径和行驶路径的图。
图7是表示校正后的设定路径和行驶路径的图。
图8是说明推定部对本车位置的推定方法的一例的图。
图9是说明推定部对本车位置的推定部位的一例的图。
图10是说明行驶转弯半径的推定方法的图。
图11是表示舵角增减率与计算次数的关系的图表。
图12是表示校正值与计算次数的关系的图表。
图13是处理部的运转控制部所执行的行驶辅助处理中的运转控制处理的流程图。
图14是处理部的推定部和校正部所执行的行驶辅助处理中的校正处理的流程图。
符号说明
10 车辆、12 转向部、13 车轮、18 车轮速度传感器、20 行驶辅助***、34 行驶辅助装置、70 处理部、72 存储部、74 运转控制部、76 推定部、78 校正部、SP 开始点、MP 中间点、MPm 副中间点、EP 结束点、LRR 左后旋转信息、RRR 右后旋转信息、LTP 目标地点、RR行驶路径、RTR 行驶转弯半径、SR 设定路径、STC 设定转弯圆、STR 设定转弯半径、θe 结束点角度、θs 开始点角度
具体实施方式
对以下的例示的实施方式等的相同的结构要素标注共用的符号而适当省略重复的说明。
<实施方式>
图1是搭载有实施方式的停车辅助***的车辆10的俯视图。车辆10例如可以是将内燃机(发动机,未图示)作为驱动源的汽车(内燃机汽车),可以是将电动机(马达,未图示)作为驱动源的汽车(电动汽车、燃料电池汽车等),也可以是将它们双方作为驱动源的汽车(混合动力汽车)。并且,车辆10能够搭载各种变速装置,能够搭载驱动内燃机、电动机所需的各种装置(***、构件等)。并且,与车辆10中的车轮13的驱动相关的装置的方式、个数以及布局等能够进行各种设定。
如图1所示,车辆10具有车身11、转向部12、4个车轮13FL、13FR、13RL、13RR、1个或多个(在本实施方式中为4个)摄像部14a、14b、14c、14d、转向部传感器16、多个(在本实施方式中为4个)车轮速度传感器18FL、18FR、18RL、18RR。在不需要区别车轮13FL、13FR、13RL、13RR的情况下,记为车轮13。在不需要区别摄像部14a、14b、14c、14d的情况下,记为摄像部14。在不需要区别车轮速度传感器18FL、18FR、18RL、18RR的情况下,记为车轮速度传感器18。
车身11构成供乘员乘车的车室。车身11收容或保持车轮13、转向部12、摄像部14、转向部传感器16、车轮速度传感器18等。
转向部12例如包含手柄或方向盘等,是对车辆10的转向轮(例如,车轮13FL、13FR)进行操作的装置。
车轮13FL设置于车辆10的左前。车轮13FR设置于车辆10的右前。车轮13RL设置于车辆10的左后。车轮13RR设置于车辆10的右后。前侧的2个车轮13FL、13FR作为由转向部12进行转向而使车辆10的行进方向发生变化的转向轮而发挥功能。后侧的2个车轮13RL、13RR例如作为通过来自发动机或马达等的驱动力而旋转的驱动轮发挥功能。
摄像部14例如是内设CCD(Charge Coupled Device:电荷耦合器件)或CIS(CMOSImage Sensor:图像传感器)等摄像元件的数字照相机。摄像部14将包含以规定的帧速率生成的多个帧图像的运动图像或静止图像的数据作为摄像图像的数据而输出。摄像部14分别具有广角透镜或鱼眼透镜,能够对水平方向上的140°~190°的范围进行摄影。摄像部14的光轴被设定为朝向斜下方。因此,摄像部14输出拍摄包含周边的路面的车辆10的周边而得到的摄像图像的数据。
摄像部14设置在车身11的周围。例如,摄像部14a设置在车身11的前端部的左右方向的中央部(例如,前保险杠)。摄像部14a生成拍摄车辆10前方的周边而得到的摄像图像。摄像部14b设置在车身11的后端部的左右方向的中央部(例如,后保险杠)。摄像部14b生成拍摄车辆10后方的周边而得到的摄像图像。摄像部14c设置在车身11的左端部的前后方向的中央部(例如,左侧的侧视镜11a)。摄像部14c生成拍摄车辆10左方的周边而得到的摄像图像。摄像部14d设置在车身11的右端部的前后方向的中央部(例如,右侧的侧视镜11b)。摄像部14d生成拍摄车辆10右方的周边而得到的摄像图像。
转向部传感器16设置在转向部12附近。转向部传感器16例如是包含霍尔元件等的角度传感器,将检测出的转向部12的旋转角作为检测转向角而输出。
车轮速度传感器18具有设置于各车轮13附近的霍尔元件,是检测车轮13的旋转量或每单位时间的转速的传感器。
车轮速度传感器18FL设置在左前的车轮13FL附近。车轮速度传感器18FL将与车轮13FL的旋转量或每单位时间的转速相关联的车轮速度脉冲检测为作为与车轮13FL的旋转相关的信息即左前旋转信息并输出。
车轮速度传感器18FR设置在右前的车轮13FR附近。车轮速度传感器18FR将与车轮13FR的旋转量或每单位时间的转速相关联的车轮速度脉冲检测为作为与车轮13FR的旋转相关的信息即右前旋转信息并输出。
车轮速度传感器18RL是第一检测部的例子,设置在左后的车轮13RL附近。车轮速度传感器18RL将与车轮13RL的旋转量或每单位时间的转速相关联的车轮速度脉冲检测为作为与车轮13RL的旋转相关的信息即左后旋转信息并输出。左后旋转信息是第一旋转信息的一例。
车轮速度传感器18RR是第二检测部的例子,设置在右后的车轮13RR附近。车轮速度传感器18RR将与车轮13RR的旋转量或每单位时间的转速相关联的车轮速度脉冲检测为作为与车轮13RR的旋转相关的信息即右后旋转信息并输出。右后旋转信息是第二旋转信息的一例。
图2是表示实施方式的行驶辅助***20的整体结构的框图。行驶辅助***20搭载于车辆10,通过使车辆10自动运转(包含部分自动运转)而辅助驾驶员。并且,行驶辅助***20通过对自动运转的转向部12的转向角进行校正,而使自动运转中的作为实际路径的行驶路径RR接近设定路径。
如图2所示,行驶辅助***20具有摄像部14、车轮速度传感器18、制动***22、加速***24、转向***26、变速***28、监视装置32、行驶辅助装置34以及车内网络36。
摄像部14将拍摄车辆10的周边而得到的摄像图像输出给行驶辅助装置34。
车轮速度传感器18将检测出的旋转信息输出给车内网络36。
制动***22控制车辆10的减速。制动***22具有制动部40、制动控制部42和制动部传感器44。
制动部40例如包含制动器和制动踏板等,是用于使车辆10减速的装置。
制动控制部42例如是包含具有CPU(Central Processing Unit:中央处理单元)等硬件处理器的ECU(Electronic Control Unit:电子控制单元)等微型计算机的计算机。制动控制部42根据来自行驶辅助装置34的指示来控制制动部40,从而控制车辆10的减速。
制动部传感器44例如是位置传感器,在制动部40是制动踏板的情况下,检测制动部40的位置。制动部传感器44将检测出的制动部40的状态输出给车内网络36。
加速***24控制车辆10的加速。加速***24具有加速部46、加速控制部48和加速部传感器50。
加速部46例如包含加速踏板等,是用于使车辆10加速的装置。
加速控制部48例如是包含具有CPU等硬件处理器的ECU等微型计算机的计算机。加速控制部48根据来自行驶辅助装置34的指示来控制加速部46,从而控制车辆10的加速。
加速部传感器50例如是位置传感器,在加速部46是加速踏板的情况下,检测加速部46的位置。加速部传感器50将检测出的加速部46的状态输出给车内网络36。
转向***26控制车辆10的行进方向。转向***26具有转向部12、转向控制部54和转向部传感器16。
转向控制部54例如是包含具有CPU等硬件处理器的ECU等微型计算机的计算机。转向控制部54根据来自行驶辅助装置34的指示舵角来控制转向部12,从而控制车辆10的行进方向。
转向部传感器16将检测出的转向部12的检测转向角输出给车内网络36。
变速***28控制车辆10的变速比。变速***28具有变速部58、变速控制部60和变速部传感器62。
变速部58例如包含换挡杆等,是使车辆10的变速比等变更的装置。
变速控制部60例如是包含具有CPU等硬件处理器的ECU等微型计算机的计算机。变速控制部60根据来自行驶辅助装置34的指示来控制变速部58,从而控制车辆10的变速比等。
变速部传感器62检测行驶、驻车以及倒车等的变速部58的位置。变速部传感器62将检测出的变速部58的位置输出给车内网络36
监视装置32设置在车辆10的车室内的仪表板等。监视装置32具有显示部64、语音输出部66以及操作输入部68。
显示部64根据行驶辅助装置34所发送的图像数据来显示图像。显示部64例如是液晶显示器(LCD:Liquid Crystal Display)或有机EL显示器(OELD:OrganicElectroluminescent Display)等显示装置。显示部64例如显示用于接受从手动运转向自动运转的切换的停车框线等图像
语音输出部66根据行驶辅助装置34所发送的语音数据而输出语音。语音输出部66例如是扬声器。语音输出部66例如输出朝向自动运转的引导等语音。
操作输入部68接受乘员的输入。操作输入部68例如是触摸面板。操作输入部68设置于显示部64的显示画面。操作输入部68构成为能够透过显示部64所显示的图像。由此,操作输入部68能够使乘员看到显示在显示部64的显示画面上的图像。操作输入部68接受与停车辅助等相关的指示,并发送给行驶辅助装置34,该指示是通过由乘员接触与显示在显示部64的显示画面上的图像对应的位置而输入的。另外,操作输入部68不限于触摸面板,也可以是按钮式等硬开关。
行驶辅助装置34是包含ECU(Electronic Control Unit)等微型计算机的计算机。行驶辅助装置34从摄像部14取得摄像图像的数据。行驶辅助装置34将与根据摄像图像等而生成的图像或语音相关的数据发送给监视装置32。行驶辅助装置34将与对驾驶员的指示以及对驾驶员的通知等的图像或语音相关的数据发送给监视装置32。行驶辅助装置34经由车内网络36来控制各***22、24、26、28,而使车辆10自动运转从而辅助停车等行驶。行驶辅助装置34具有:CPU(Central Processing Unit:中央处理单元)34a、ROM(Read Only Memory:只读存储器)34b、RAM(Random Access Memory:随机存取存储器)34c、显示控制部34d、语音控制部34e以及SSD(Solid State Drive:固态硬盘)34f。CPU 34a、ROM 34b和RAM 34c也可以集成在同一组件内。
CPU 34a是硬件处理器的一例,读出存储在ROM 34b等非易失性的存储装置中的程序,根据该程序来执行各种运算处理和控制。CPU 34a例如执行显示在显示部64上的行驶辅助用的图像等的图像处理。
ROM 34b存储各程序和程序的执行所需的参数等。RAM 34c临时地存储有在CPU34a中的运算中使用的各种数据。显示控制部34d主要执行行驶辅助装置34的运算处理中的、摄像部14所得到的图像的图像处理、显示在显示部64上的显示用的图像的数据转换等。语音控制部34e主要执行行驶辅助装置34的运算处理中的、向语音输出部66输出的语音的处理。SSD 34f是可改写的非易失性的存储装置,在行驶辅助装置34的电源切断的情况下也维持数据。
车内网络36以能够发送接收信息的方式将车轮速度传感器18、制动***22、加速***24、转向***26、变速***28、监视装置32的操作输入部68、行驶辅助装置34彼此连接。
图3是说明行驶辅助装置34的功能的功能框图。如图3所示,行驶辅助装置34具有处理部70和存储部72。
处理部70例如作为CPU 34a等的功能被实现。处理部70具有运转控制部74、推定部76和校正部78。处理部70例如可以通过读取存储在存储部72中的行驶辅助程序80而实现运转控制部74、推定部76和校正部78的功能。运转控制部74、推定部76和校正部78的一部分或全部也可以由包含ASIC(Application Specific Integrated Circuit:专用集成电路)的电路等硬件构成。
运转控制部74在自动运转的行驶辅助中,根据包含多个路径模式等信息的路径数据82,而设定朝向设定于停车区域等的目标地点LTP的设定路径。运转控制部74例如设定包含转弯圆(以下为设定转弯圆)的一部分的设定路径。以下,将转弯圆的半径记为设定转弯半径。运转控制部74通过控制***22、24、26、28中的任意***,而使车辆10沿着设定路径行驶。
具体而言,运转控制部74根据预先设定的转向表84而使转向部12与设定转弯半径对应地转向,从而使车轮13FL、13FR转向。转向表84是预先使目标转向角与设定转弯半径相关联的表。目标转向角是为了使车辆10沿着设定转弯半径的设定转弯圆行驶而设为目标的转向部12的转向角。因此,运转控制部74向转向***26输出指示舵角来控制转向部12,以使转向部12的转向角成为与设定转弯半径相关联的目标转向角。由此,运转控制部74使车辆10沿着设定路径上的设定转弯圆行驶。
运转控制部74经由车内网络36而从车轮速度传感器18取得旋转信息LRR、RRR等。运转控制部74基于根据旋转信息LRR、RRR而计算出的移动距离等,来控制转向部12的转向时机、加速***24的加速时机等。由此,运转控制部74使车辆10沿着包含设定转弯圆的设定路径行驶。
运转控制部74将设定路径的信息作为运转数据88的一部分保存在存储部72中。设定路径的信息包含转向开始地点的坐标、转向结束地点的坐标、返转地点的坐标、目标转向角、指示舵角、设定转弯半径和设定转弯中心的坐标等。并且,运转控制部74在自动运转中从车轮速度传感器18RL、18RR取得旋转信息LRR、RRR,将所取得的与时刻相关联的旋转信息LRR、RRR作为运转数据88的一部分保存在存储部72中。
推定部76根据由车轮速度传感器18RL检测出的左后的车轮13RL的左后旋转信息LRR和由车轮速度传感器18RR检测出的右后的车轮13RR的右后旋转信息RRR,来推定车辆10实际行驶的行驶路径RR上的转弯圆(以下为行驶转弯圆)的转弯半径(以下为行驶转弯半径)。
例如,推定部76根据左后旋转信息LRR所示的与左后车轮13RL的转速对应的左后车轮速度脉冲数(以下为左后脉冲数)、以及右后旋转信息RRR所示的与右后车轮13RR的转速对应的右后车轮速度脉冲数(以下为右后脉冲数),而在行驶路径RR上设定多个位置(后述的开始点、中间点以及结束点等)。推定部76根据推定出的多个位置的坐标来计算并推定行驶转弯半径。推定部76将推定出的行驶转弯半径输出给校正部78。
校正部78根据从推定部76取得的行驶转弯半径来计算用于校正转向部12的转向角的校正值。例如,校正值是为了控制转向部12的转向角而校正所提取出的目标转向角或指示舵角的值。校正部78可以根据行驶转弯半径和运转控制部74所生成的设定路径所示的设定转弯半径来计算校正值。具体而言,校正部78计算作为设定转弯半径与行驶转弯半径的比率的舵角增减率。校正部78计算多个舵角增减率,根据作为多个舵角增减率的平均值即舵角增减率平均值来计算校正值。校正部78将包含计算出的校正值的校正数据90保存在存储部72中。
在存储部72中保存包含校正值的校正数据90的情况下,运转控制部74根据路径数据82对设定路径进行设定,利用校正值来校正与包含在设定路径中的设定转弯圆的设定转弯半径对应的目标转向角或指示舵角,而执行行驶辅助。
存储部72作为ROM 34b、RAM 34c和SSD 34f中的至少1个功能被实现。存储部72也可以设置在外部的网络上等。存储部72存储由处理部70执行的程序、程序的执行所需的数据、以及通过程序的执行而生成的数据等。存储部72例如存储由处理部70执行的行驶辅助程序80。存储部72存储行驶辅助程序80的执行所需的、包含路径模式的路径数据82、转向表84、以及包含阈值和数学式等的数值数据86。存储部72存储通过行驶辅助程序80的执行而生成的运转数据88和校正数据90。运转数据88包含设定路径的信息、目标转向角、在各时刻向转向部12输出的指示舵角、各时刻的检测转向角、在各时刻从车轮速度传感器18RL、18RR取得的包含车轮速度脉冲的旋转信息LRR、RRR等。校正数据90包含校正值,并且包含在校正值的计算过程中计算出的值。
图4是表示转向表84的一例的图。如图4所示,转向表84使目标转向角θcn与设定转弯半径STRn相关联。n=1、2、···。运转控制部74从转向表84提取与包含在设定路径中的设定转弯圆的设定转弯半径STR对应起来的目标转向角θcn。运转控制部74将作为提取出的目标转向角θcn的指示舵角输出给转向***26,使车辆10沿着设定转弯圆行驶。
接着,关于设定路径SR和实际的车辆10的行驶路径RR、以及设定转弯半径STR的校正的概要进行说明。图5和图6是表示校正前的设定路径SR和行驶路径RR的图。图7是表示校正后的设定路径SR和行驶路径RR的图。
在图5至图7中,细实线表示设定路径SR,细虚线表示实际的行驶路径RR。粗实线表示形成设定路径SR的一部分的设定转弯半径STR的设定转弯圆STC,粗虚线表示形成实际的行驶路径RR的一部分的行驶转弯半径RTR的行驶转弯圆RTC。这里的设定路径SR为朝向设置于停车厂等的划分线CL内的停车区域的路径。
如果转向表84所示的转向部12的目标转向角θc与设定转弯半径STR的关系准确,则车辆10在自动运转的情况下,沿着包含设定转弯圆STC的一部分的设定路径SR行驶。然而,由于车辆10各自的特性或车辆10周围的环境等,有时目标转向角θc与设定转弯半径STR的实际关系与转向表84的关系不同,有时车辆10沿着与设定路径SR不同的行驶路径RR行驶。
例如,如图5所示,车辆10由于特性而沿着比设定转弯圆STC的设定转弯半径STR小的行驶转弯半径RTR的行驶转弯圆RTC行驶。如图6所示,车辆10由于特性而沿着比设定转弯圆STC的设定转弯半径STR大的行驶转弯半径RTR的行驶转弯圆RTC行驶。由此,运转控制部74通过自动运转而将车辆10引导到与设定路径SR的目标地点LTP不同的位置DP。
因此,推定部76基于根据在行驶转弯圆RTC上行驶中的车辆10的左后旋转信息LRR和右后旋转信息RRR而推定出的行驶路径RR上的本车位置,来推定行驶转弯圆RTC的行驶转弯半径RTR。校正部78根据由推定部76推定出的行驶转弯半径RTR和设定转弯半径STR,来计算用于校正转向部12的转向角的校正值。
由此,如图7所示,推定部76和校正部78使设定转弯圆STC与行驶转弯圆RTC的偏差变小,而使自动运转中的车辆10的实际的行驶路径RR接近设定路径SR。
图8是说明推定部76对本车位置的推定方法的一例的图。推定部76可以根据使用了旋转信息LRR、RRR的图8所示的已知的方法(例如,日本特开2015-075337号公报)来推定行驶路径RR上的本车位置。图8表示在时刻t处于坐标(X0,Y0)的位置且朝向方向θ0的车辆10在时刻(t+Δt)移动到坐标(X,Y)且朝向方向θ的情况。在假定在时间Δt期间,车辆10的转弯中心和转弯半径没有变化且车辆10直线移动的情况下,车辆10的移动距离MD能够由以下的式子表示。
MD=k(NL+NR)/2
k:将脉冲数转换成移动距离的系数
NL:Δt期间的左后脉冲数
NR:Δt期间的右后脉冲数
这里,当设为X=X0+ΔX、Y=Y0+ΔY时,ΔX、ΔY能够由以下的式子表示。
ΔX=MDcosθ0=(k(NL+NR)/2)cosθ0···(1)
ΔY=MDsinθ0=(k(NL+NR)/2)sinθ0···(2)
并且,时刻(t+Δt)时的车辆10的方向θ能够由下面的式子表示。
θ=θ0+Δθ=θ0+k·Δt(NL-NR)/TW···(3)
TW:胎面宽度
推定部76使用式子(1)、式子(2)、式子(3)每隔时间Δt计算本车位置,从而检测车辆10的实际的行驶路径RR。
图9是说明推定部76对本车位置的推定部位的一例的图。如图9所示,推定部76根据指示舵角、检测转向角、目标转向角θc和旋转信息LRR、RRR所示的脉冲数,而在行驶路径RR上设定开始点SP、中间点MP、多个副中间点MPm(m=1、2··)和结束点EP。推定部76根据开始点SP、中间点MP、副中间点MPm和结束点EP的坐标来推定行驶转弯半径RTR。车辆10的坐标例如为车辆10的后轮轴的中心的坐标。
推定部76根据在自动运转中由运转控制部74保存在存储部72中的运转数据88,而在行驶路径RR上设定开始点SP。推定部76可以根据运转数据88所示的指示舵角、检测出的转向部12的检测转向角、以及与设定路径SR上的设定转弯圆STC的设定转弯半径STR相关联的目标转向角θc,而在行驶路径RR上设定开始点SP。例如,推定部76可以将满足了预先确定的开始点条件的行驶路径RR上的地点设定为开始点SP。开始点条件的例子如下。
(第一开始点条件)指示舵角固定
(第二开始点条件)从目标转向角减去了指示舵角得到的差为第一阈值残差以下
(第三开始点条件)从指示舵角减去检测转向角得到的差为第二阈值残差以下
第一阈值残差和第二阈值残差被预先确定,作为数值数据86保存在存储部72中。第一阈值残差是用于判定指示舵角与目标转向角θc大致一致的值,例如可以为几度左右。第二阈值残差是用于判定检测转向角与指示舵角大致一致的值,可以根据转向部传感器16的分辨率和转向部传感器16的过冲的值等来设定。另外,推定部76也可以将满足了上述的开始点条件中的任意条件(例如,第二和第三开始点条件)的地点设定为开始点SP。
推定部76可以将设定转弯圆STC结束的行驶路径RR上的点设定为结束点EP。例如,推定部76可以根据从运转控制部74输出的指示舵角而在行驶路径RR上设定结束点EP。具体而言,推定部76可以将开始点SP之后变化了固定的指示舵角的地点设定为结束点EP。
推定部76可以根据基准方向SD与车辆10的方向(以下为本车方向CD)之间的角度而在行驶路径RR上设定中间点MP。基准方向SD的一例是与划分线CL垂直的方向。例如,推定部76可以根据旋转信息LRR、RRR而在作为开始点角度θs与结束点角度θe的平均角度θm的地点设定中间点MP,开始点角度θs是开始点SP的本车方向CD与基准方向SD的角度,结束点角度θe是结束点EP的本车方向CD与基准方向SD的角度。
具体而言,推定部76通过图8所示的方法,根据旋转信息LRR、RRR来计算开始点角度θs和结束点角度θe。推定部76计算开始点角度θs与结束点角度θe的平均角度(=(θs+θe)/2)。推定部76计算基准方向SD与行驶路径RR上的各地点的本车方向CD的角度,将该角度为平均角度的地点设定为中间点MP。
此外,推定部76也可以在行驶路径RR上的中间点MP的前后位置设定副中间点MPm。其中,设为m=1、2、···。推定部76隔开车轮速度脉冲的1脉冲以上的间隔而设定副中间点MPm的位置。推定部76优选在开始点SP与中间点MP的中央位置和中间点MP与结束点EP的中央位置之间设定副中间点MPm的位置。
接着,关于推定部76对行驶转弯半径RTR的推定方法进行说明。图10是说明行驶转弯半径RTR的推定方法的图。
如图10所示,推定部76通过图8所示的方法,根据旋转信息LRR、RRR来计算开始点SP、中间点MP、副中间点MPm和结束点EP的坐标。将开始点SP的坐标设为(Xs,Ys)。将中间点MP的坐标设为(Xm,Ym)。将结束点EP的坐标设为(Xe,Ye)。
连结开始点SP和中间点MP的第一直线LN1的第一垂线PL1与连结中间点MP和结束点EP的第二直线LN2的第二垂线PL2交叉的位置是行驶转弯圆RTC的中心。这里,第一垂线PL1的第一斜率GR1和第一截距IN1、第二垂线PL2的第二斜率GR2和第二截距IN2能够由以下的式子表示。
GR1=-1/((Ys-Ym)/(Xs-Xm))···(4)
IN1=(Ys+Ym)/2-GR1×((Xs+Xm)/2)···(5)
GR2=-1/((Ym-Ye)/(Xm-Xe))···(6)
IN2=(Ym+Ye)/2-GR2×((Xm+Xe)/2)···(7)
接着,行驶转弯圆RTC的中心的坐标(Cx,Cy)能够由以下的式子表示。
Cx=(IN2-IN1)/(GR1-GR2)···(8)
Cy=GR1×Cx+IN1···(9)
因此,当将临时行驶转弯半径设为VRTR时,临时行驶转弯半径能够由以下的式子表示。
VRTR=((Cx-Xs)2+(Cy-Ys)2)1/2···(10)
推定部76可以根据开始点SP、中间点MP和结束点EP的坐标、以及式子(4)至式子(10),来计算临时行驶转弯半径。各式可以包含在数值数据86中,保存在存储部72中。
同样,在设定多个副中间点MPm的情况下,推定部76可以利用与上述的临时行驶转弯半径的计算方法相同的方法,根据多个副中间点MPm的坐标、开始点SP和结束点EP的坐标来计算多个临时行驶转弯半径。在该情况下,推定部76计算与中间点MP和副中间点MPm的个数对应的多个临时行驶转弯半径。推定部76可以根据多个临时行驶转弯半径来计算行驶转弯半径RTR。例如,推定部76可以将多个临时行驶转弯半径的中央值计算为行驶转弯半径RTR。
这里,也可以是,校正部78在校正值的计算中不采用计算出的所有的行驶转弯半径RTR,而是根据预先确定的条件来判定该行驶转弯半径RTR的采用或不采用。采用条件的一例如下。
(第一采用条件)车速小于车速阈值
(第二采用条件)车辆所行驶的圆弧相对于一整圆的比例为圆弧阈值以上
(第三采用条件)设定转弯半径与行驶转弯半径的差(或比)小于半径阈值
可以是,在满足了上述的3个采用条件中的1个或多个的情况下,校正部78采用计算出的行驶转弯半径RTR。由此,校正部78降低成为不适当的值的概率较高的行驶转弯半径RTR的影响。圆弧阈值和半径阈值可以根据推定精度而适当设定,可以作为数值数据86的一部分进行保存。
接着,关于校正部78根据行驶转弯半径RTR来计算校正值的处理进行说明。
图11是表示舵角增减率与计算次数的关系的图表。图12是表示校正值与计算次数的关系的图表。另外,计算次数是自动运转的运转次数中的采用满足了采用条件的行驶转弯半径RTR来计算校正值的次数。
如图11所示,校正部78在每次停车时计算舵角增减率,该舵角增减率是由推定部76推定出的行驶转弯半径RTR相对于从运转控制部74取得的设定转弯半径STR的比率。
每次舵角增减率的计算次数成为预先确定的设定平均次数时,校正部78计算作为舵角增减率的平均值的舵角增减率平均值。设定平均次数的一例是3次。
这里,校正部78可以将临时平均值和计算次数保存在存储部72中直到计算次数成为设定平均次数为止,计算舵角增减率平均值,该临时平均值是每次从推定部76取得行驶转弯半径RTR时对过去的舵角增减率进行平均而计算出的。具体而言,当从推定部76取得第一次的停车时的行驶转弯半径RTR时,校正部78将作为计算次数的“1”和临时平均值(这里为第一次的舵角增量率)作为校正数据90的一部分保存在存储部72中。接着,当从推定部76取得第二次的停车时的行驶转弯半径RTR时,校正部78将作为计算次数的“2”和作为第一次与第二次的舵角增量率的平均值的临时平均值保存在存储部72中,并且从存储部72中删除之前保存的作为计算次数的“1”以及之前的临时平均值(这里为第一次的舵角增量率)。然后,重复相同的处理,当从推定部76取得第M次的停车时的行驶转弯半径RTR时,校正部78将已经保存在存储部72中的作为计算次数的“M-1”与临时平均值(直到第M-1次的舵角增量率的平均值)之积与本次的舵角增量率之和除以作为本次的计算次数的“M”而得到的值计算为新的临时平均值。校正部78将作为计算次数的“M”和从第一次到第M次的舵角增量率的临时平均值作为校正数据90保存在存储部72中,并且从存储部72中删除之前保存的作为次数的“M-1”和之前的临时平均值(这里为M-1个舵角增量率的平均值)。由此,校正部78能够降低校正所需的存储部72的容量。
当计算次数为设定平均次数时,校正部78将保存在存储部72中的计算次数(这里为设定平均次数-1)与临时平均值之积与本次的行驶转弯半径RTR之和除以设定平均次数而得到的值计算为舵角增减率平均值。并且,校正部78将计算次数复位为“0”。校正部78将舵角增减率平均值作为校正数据90的一部分保存在存储部72中。
如图12所示,校正部78将舵角增减率平均值乘以第一校正系数α1,来计算临时校正值。校正部78根据该临时校正值来计算校正值。第一校正系数α1为小于1的正值,例如为“0.8”。
这里,也可以是,如果舵角增减率平均值的偏差为预先设定的偏差阈值以上,则校正部78根据将舵角增减率平均值乘以比第一校正系数α1小的第二校正系数α2而得到的临时校正值来计算校正值。第二校正系数α2例如为“0.2”。由此,校正部78降低在车辆10周围的状况异常的情况下(例如,坡路等的情况下)成为异常值的舵角增减率和舵角增减率平均值对校正值的影响。
校正部78当将舵角增减率平均值乘以校正系数α1、α2中的任意系数来计算临时校正值时,通过使该临时校正值与作为将已经完成计算的所有的临时校正值相加得到的总和的校正值相加,而计算新的校正值。另外,在最初的设定平均次数中,临时校正值为校正值。校正部78将计算出的校正值作为校正数据90的一部分保存在存储部72中。
运转控制部74根据由校正部78计算出的校正值来校正自动运转。例如,运转控制部74根据校正值来校正用于使转向***26控制转向角的目标转向角或指示舵角。具体而言,使目标转向角或指示舵角除以校正值而得到的值为新的目标转向角或指示舵角,运转控制部74根据该新的目标转向角或指示舵角来控制转向部12。由此,在设定了校正值之后(在图11所示的例子中计算次数为4次以上),舵角增减率变小,接近“0”。
然后,与直到上述的设定平均次数(图11所示的第三次)为止的处理同样地,校正部78根据从推定部76取得的行驶转弯半径RTR而重复临时平均值的计算直到成为接下来的设定平均次数(图11所示的第六次)为止,计算新的舵角增减率平均值。这里,在第二次的设定平均次数时计算出的舵角增减率平均值比在最初的设定平均次数时计算出的舵角增减率平均值小,且接近“0”。然而,根据比1小的第一校正系数α1乘以舵角增减率平均值而得到的校正值使车辆10自动运转,因此在第二次的设定平均次数时计算出的舵角增减率平均值通常并不是“0”。然后,如图12所示,校正部78计算临时校正值,该临时校正值是在第二次的设定平均次数时计算出的舵角增减率平均值与第一校正系数α1(或第二校正系数α2)之积。校正部78将该临时校正值与在第一次的设定平均次数时计算出的校正值之和计算为新的校正值。
校正部78通过重复相同的处理,而在每次设定平均次数的停车时计算新的舵角增减率平均值和临时校正值,将该临时校正值与上次的校正值之和计算为新的校正值。换言之,校正部78使在每个设定平均次数计算出的临时校正值累加而计算校正值。由此,舵角增减率平均值逐渐变小,接近“0”。校正部78将计算出的校正值作为校正数据90的一部分保存在存储部72中。
图13是处理部70的运转控制部74所执行的行驶辅助处理中的运转控制处理的流程图。例如,当在显示部64上显示接受自动运转的指示的停车框线等图像的状态下,利用操作输入部68从驾驶员接受自动运转的指示时,运转控制部74开始进行运转控制处理。
如图13所示,在行驶辅助处理的运转控制处理中,运转控制部74设定目标地点LTP(S102)。目标地点LTP的一例是使车辆10停车的停车位置。例如,运转控制部74根据从摄像部14取得的摄像图像而以当前的车辆10的位置为基准来设定目标地点LTP。
运转控制部74根据路径数据82来设定从当前的车辆10的位置朝向目标地点LTP的设定路径SR(S104)。运转控制部74控制***22、24、26、28,而开始进行朝向目标地点LTP的自动运转(S106)。这里,在已经将校正值保存在存储部72中的情况下,运转控制部74根据由该校正值校正后的指示舵角,来校正且控制转向***26的转向部12的转向角。
运转控制部74在自动运转中将运转数据88保存在存储部72中(S108)。例如,运转控制部74依次保存运转数据88,该运转数据88包含设定路径SR的信息、目标转向角θc、在各时刻输出到转向部12的指示舵角、各时刻的检测转向角、在各时刻从车轮速度传感器18RL、18RR取得的包含车轮速度脉冲的旋转信息LRR、RRR等。运转控制部74持续自动运转并且依次将运转数据88保存在存储部72中直到到达目标地点LTP为止(S110:否)。
当到达目标地点LTP时(S110:是),运转控制部74结束自动运转(S112),进行待机直到下一运转控制处理。
图14是处理部70的推定部76和校正部78所执行的行驶辅助处理中的校正处理的流程图。推定部76和校正部78也可以与上述的运转控制处理并行地执行校正处理。
如图14所示,在行驶辅助处理的校正处理中,推定部76取得保存在存储部72中的运转数据88(S202)。
推定部76根据图8所示的方法和运转数据88来推定基于设定路径SR而自动运转的车辆10实际上行驶的行驶路径RR上的本车位置(S204)。这里,推定部76推定在行驶路径RR上转向部12以固定的状态转弯的范围、即行驶转弯圆RTC上的本车位置。即,推定部76只要像图9所示那样以在行驶路径RR上设定开始点SP、中间点MP、多个副中间点MPm和结束点EP而能够计算各点的坐标和方向的方式推定本车位置即可。
推定部76基于图10所示的方法,根据开始点SP、中间点MP、多个副中间点MPm和结束点EP的坐标来推定实际的行驶路径RR上的行驶转弯半径RTR(S206)。具体而言,推定部76可以根据开始点SP、中间点MP、多个副中间点MPm以及结束点EP来计算多个临时行驶转弯半径,采用多个行驶转弯半径RTR的中央值作为行驶转弯半径RTR。
校正部78判定在校正值的计算中是否采用从推定部76取得的行驶转弯半径RTR(S207)。具体而言,校正部78可以根据上述的第一采用条件到第三采用条件来判定是否采用行驶转弯半径RTR。
当判定为不采用行驶转弯半径RTR时(S207:否),校正部78不计算新的校正值而结束校正处理,处于待机状态直到执行下一运转控制处理为止。
另一方面,当判定为采用行驶转弯半径RTR时(S207:是),校正部78根据该行驶转弯半径RTR来计算舵角增减率(S208)。具体而言,将行驶转弯半径RTR相对于包含在运转数据88中的设定转弯半径STR的比率计算为舵角增减率。
校正部78判定舵角增减率的计算次数是否为设定平均次数(S210)。
当判定为舵角增减率的计算次数不是设定平均次数时(S210:否),校正部78计算舵角增减率的临时平均值(S212)。校正部78使计算次数增加+1(S214)。校正部78将计算次数和临时平均值作为校正数据90保存在存储部72中(S216)。由此,推定部76和校正部78结束校正处理,处于待机状态直到执行下一运转控制处理为止。
另一方面,当判定为舵角增减率的计算次数是设定平均次数时(S210:是),校正部78计算舵角增减率平均值(S218)。具体而言,校正部78计算保存在存储部72中的计算次数(这里为设定平均次数-1)与临时平均值之积与本次的舵角增减率之和。校正部78将该和除以设定平均次数而得到的值计算为舵角增减率平均值。校正部78将计算次数复位(S220)。
校正部78根据舵角增减率平均值来计算临时校正值(S222)。具体而言,校正部78将舵角增减率平均值与校正系数α1、α2中的任意系数之积计算为临时校正值。另外,校正部78可以根据舵角增减率和舵角增减率平均值是否为异常值来选择校正系数α1、α2。校正部78例如可以根据舵角增减率之间的比较、以及过去的舵角增减率平均值与本次的舵角增减率平均值的比较等,来判定舵角增减率和舵角增减率平均值是否为异常值。
校正部78根据计算出的临时校正值来计算校正值(S226)。具体而言,校正部78将已经保存在存储部72中的校正值加上本次的临时校正值而得到的和计算为新的校正值。校正部78将计算出的新的校正值和复位的计算次数作为校正数据90并保存在存储部72中(S228)。由此,推定部76和校正部78结束校正处理,处于待机状态直到执行下一运转控制处理为止。
如上所述,在行驶辅助***20中,车轮速度传感器18RL、18RR检测与实际的左右车轮13RL、13RR的旋转相关的旋转信息LRR、RRR,处理部70根据该旋转信息LRR、RRR来推定行驶转弯半径RTR。由此,与根据被车辆10的特性等所左右的指示舵角或检测转向角等来推定行驶转弯半径RTR的情况相比,行驶辅助***20能够以较高的精度来推定车辆10的实际的行驶转弯半径RTR。
在行驶辅助***20中,由于根据以较高的精度推定出的行驶转弯半径RTR来计算对转向角进行校正的校正值,因此能够提高校正值的精度。由此,行驶辅助***20能够进一步使车辆10沿着设定路径SR行驶。
在行驶辅助***20中,处理部70使舵角增减率平均值乘以小于1的第一校正系数α1,而计算校正值。由此,在舵角增减率平均值成为异常值的情况下,行驶辅助***20也能够降低异常值对校正值的影响。
在行驶辅助***20中,在舵角增减率和舵角增减率平均值的偏差较大的情况下,处理部70使舵角增减率平均值乘以比第一校正系数α1小的第二校正系数α2,而计算校正值。由此,行驶辅助***20能够降低对在舵角增减率平均值的偏差变大的情况下变大的校正值的不适当的影响。
在行驶辅助***20中,处理部70基于根据实测的旋转信息LRR、RRR而计算出的开始点SP的开始点角度θs和结束点EP的结束点角度θe,来设定中间点MP。由此,与根据坐标来设定中间点MP的情况相比,处理部70能够进一步使开始点SP与中间点MP的沿着行驶转弯圆RTC的距离、以及中间点MP与结束点EP的沿着行驶转弯圆RTC的距离相等。由此,行驶辅助***20能够增大中间点MP与开始点SP和结束点EP的距离,因此能够以更高的精度计算行驶转弯半径RTR。
在行驶辅助***20中,处理部70将根据中间点MP和多个副中间点MPm而计算出的多个临时行驶转弯半径的中央值计算为行驶转弯半径RTR。由此,与仅根据中间点MP来计算行驶转弯半径RTR的情况相比,行驶辅助***20能够进一步提高行驶转弯半径RTR的计算精度。
上述的各实施方式的结构的功能、连接关系、个数、配置等可以在发明的范围和与发明的范围均等的范围内进行适当变更、删除等。也可以适当组合各实施方式。可以适当变更各实施方式的各步骤的顺序。
在上述的实施方式中,列举了将与车轮速度传感器18RL、18RR所检测的车轮13的转速对应的车轮速度脉冲作为旋转信息LRR、RRR的例子,但不限于此。旋转信息LRR、RRR只要是与车轮13的转速相关联的值即可,例如也可以是使车轮13旋转的马达和发动机等的转速(或旋转角度)。
在上述的实施方式中,列举了采用多个行驶转弯半径RTR的中央值作为行驶转弯半径RTR的例子,但所采用的行驶转弯半径RTR不限于此。例如,也可以采用多个行驶转弯半径RTR的平均值作为行驶转弯半径RTR。
在上述的实施方式中,列举了校正值是用于经由目标转向角或指示舵角来校正转向角的值的例子,但不限于此。例如,校正值只要是能够校正转向角的值即可,也可以是校正转向表84的目标转向角θc或与目标转向角θc相关联的设定转弯半径STR的值,在该情况下,也可以校正转向表84。
在上述的实施方式中,列举了校正部78计算1个校正值的例子,但不限于此。例如,校正部78可以分别计算左转弯用的校正值和右转弯用的校正值,生成包含与左转弯对应的校正值和与右转弯对应的校正值的校正数据90。
在上述的实施方式中,列举了校正部78根据自动运转中的设定路径SR的设定转弯半径STR来计算校正值的例子,但不限于此。例如,校正部78也可以根据与驾驶员运转的状态下的转向角相等的目标转向角θc相关联的设定转弯半径STR和行驶转弯半径RTR,来计算校正值。
在上述的实施方式中,列举了校正部78使舵角增减率平均值乘以校正系数α1、α2来计算校正值的例子,但不限于此。校正部78也可以使舵角增减率乘以校正系数α1、α2来计算校正值。
在上述的实施方式中,列举了推定部76基于根据旋转信息LRR、RRR而计算出的开始点SP、中间点MP、副中间点MPm以及结束点EP的坐标来计算行驶转弯半径RTR的例子,但行驶转弯半径RTR的计算方法不限于此。推定部76也可以根据开始点SP、中间点MP、副中间点MPm以及结束点EP中的至少3个地点的坐标来计算行驶转弯半径RTR。例如,推定部76也可以根据开始点SP、结束点EP以及开始点SP与结束点EP之间的行驶路径RR上的地点(不限于中间点MP)的坐标来计算行驶转弯半径RTR。在该情况下,行驶辅助***20也基于根据实测的旋转信息LRR、RRR而计算出的开始点SP和结束点EP的坐标来计算行驶转弯半径RTR,因此能够高精度地计算该行驶转弯半径RTR。
在上述的实施方式中,举例说明了并排停车(=横列停车)的入库的自动运转,但也可以将上述的实施方式应用于纵列停车或其他的行驶辅助中的自动运转。
在上述的实施方式中,列举了推定部76根据后面的车轮速度传感器18RL、18RR的旋转信息LRR、RRR来推定本车位置的例子,但也可以根据车轮速度传感器18FL、18FR的旋转信息来推定本车位置。
Claims (7)
1.一种行驶辅助***,具有:
第一检测部,该第一检测部检测作为与车辆的左侧车轮的旋转相关的信息的第一旋转信息;
第二检测部,该第二检测部检测作为与所述车辆的右侧车轮的旋转相关的信息的第二旋转信息;以及
处理部,该处理部根据所述第一旋转信息和所述第二旋转信息来推定所述车辆所行驶的行驶路径上的行驶转弯圆的行驶转弯半径。
2.根据权利要求1所述的行驶辅助***,其中,
所述处理部根据所述行驶转弯半径来计算用于校正转向部的转向角的校正值,所述转向部对所述车辆的转向轮进行操作。
3.根据权利要求2所述的行驶辅助***,其中,
所述处理部根据将舵角增减率或作为多个所述舵角增减率的平均值的舵角增减率平均值乘以小于1的第一校正系数而得到的临时校正值来计算所述校正值,该舵角增减率是朝向目标地点的设定路径上的设定转弯圆的设定转弯半径与所述行驶转弯半径的比率。
4.根据权利要求3所述的行驶辅助***,其中,
如果所述舵角增减率或所述舵角增减率平均值的偏差为预先设定的偏差阈值以上,则所述处理部根据将所述舵角增减率或所述舵角增减率平均值乘以比所述第一校正系数小的第二校正系数而得到的所述临时校正值来计算所述校正值。
5.根据权利要求1至4中的任意一项所述的行驶辅助***,其中,
所述处理部根据与朝向目标地点的设定路径上的设定转弯圆的设定转弯半径相关联的目标转向角、和检测出的转向部的检测转向角,而在所述行驶路径上设定开始点,
在所述设定转弯圆结束的所述行驶路径上的地点设定结束点,
基于根据所述第一旋转信息和所述第二旋转信息而计算出的所述开始点和所述结束点的坐标来推定所述行驶转弯半径。
6.根据权利要求5所述的行驶辅助***,其中,
所述处理部根据所述第一旋转信息和所述第二旋转信息而在作为开始点角度与结束点角度的平均角度的所述行驶路径上的地点设定中间点,该开始点角度是所述开始点的所述车辆的方向与基准方向的角度,该结束点角度是所述结束点的所述车辆的方向与所述基准方向的角度,
所述处理部基于根据所述第一旋转信息和所述第二旋转信息而计算出的所述开始点、所述中间点和所述结束点的坐标来推定所述行驶转弯半径。
7.根据权利要求6所述的行驶辅助***,其中,
所述处理部在所述行驶路径上的所述中间点的前后设定多个副中间点,
所述处理部根据多个临时行驶转弯半径来推定所述行驶转弯半径,该多个临时行驶转弯半径是基于根据所述第一旋转信息和所述第二旋转信息计算出的所述开始点、所述中间点、所述多个副中间点以及所述结束点的坐标而计算出的。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017-114462 | 2017-06-09 | ||
JP2017114462A JP6919349B2 (ja) | 2017-06-09 | 2017-06-09 | 走行支援システム |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109017983A true CN109017983A (zh) | 2018-12-18 |
CN109017983B CN109017983B (zh) | 2022-11-29 |
Family
ID=64562882
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810588968.9A Active CN109017983B (zh) | 2017-06-09 | 2018-06-08 | 行驶辅助*** |
Country Status (3)
Country | Link |
---|---|
US (1) | US10689030B2 (zh) |
JP (1) | JP6919349B2 (zh) |
CN (1) | CN109017983B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112078653A (zh) * | 2019-06-12 | 2020-12-15 | 现代自动车株式会社 | 车辆终端和用于通过该车辆终端控制转向的方法 |
CN112793579A (zh) * | 2021-04-12 | 2021-05-14 | 顺为智能科技(常州)有限公司 | 一种轮式车辆虚拟轮转向角测量方法 |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6532430B2 (ja) * | 2016-06-08 | 2019-06-19 | ハードロック工業株式会社 | 枢着装置、並びに、取付装置 |
JP7245069B2 (ja) * | 2019-02-18 | 2023-03-23 | 株式会社Subaru | 車両の走行制御装置 |
CN111645756B (zh) * | 2020-05-29 | 2021-10-08 | 摩登汽车有限公司 | 转向控制方法 |
US11718320B1 (en) * | 2020-08-21 | 2023-08-08 | Aurora Operations, Inc. | Using transmission sensor(s) in localization of an autonomous vehicle |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5991671A (en) * | 1997-10-02 | 1999-11-23 | Mitsubishi Denki Kabushiki Kaisha | Automatic traveling control system for vehicle |
CN1737499A (zh) * | 2004-08-20 | 2006-02-22 | 爱信精机株式会社 | 停车辅助装置 |
US20070146166A1 (en) * | 2005-12-28 | 2007-06-28 | Aisin Seiki Kabushiki Kaisha | Parking assist apparatus |
JP2009006878A (ja) * | 2007-06-28 | 2009-01-15 | Nissan Motor Co Ltd | 車線逸脱防止装置 |
CN101758809A (zh) * | 2008-12-25 | 2010-06-30 | 株式会社丰田自动织机 | 泊车辅助装置 |
US20110218706A1 (en) * | 2010-03-05 | 2011-09-08 | Honda Motor Co., Ltd. | Vehicle motion control apparatus |
CN102407849A (zh) * | 2010-08-23 | 2012-04-11 | 株式会社电装 | 基于移动对象的目标轨迹来支持移动对象的驾驶的设备 |
CN103963781A (zh) * | 2013-02-04 | 2014-08-06 | 福特全球技术公司 | 具有对象回避的拖车主动倒车辅助装置 |
US20150025732A1 (en) * | 2013-07-17 | 2015-01-22 | Electronics And Telecommunications Research Institute | Apparatus and method for controlling automatic parking |
CN106004996A (zh) * | 2016-06-23 | 2016-10-12 | 北京智行者科技有限公司 | 一种智能车转向控制方法及*** |
Family Cites Families (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002036991A (ja) * | 2000-07-27 | 2002-02-06 | Honda Motor Co Ltd | 駐車支援装置 |
DE60306024T2 (de) * | 2002-04-26 | 2007-01-04 | Jtekt Corp. | Verfahren und System zur Antriebskraftverteilung für ein Kraftfahrzeug mit Allradantrieb |
DE10256770A1 (de) * | 2002-12-05 | 2004-06-17 | Bayerische Motoren Werke Ag | Verfahren zum Lenken eines rückwärts in eine Parklücke einzuparkenden Fahrzeugs |
JP4045338B2 (ja) * | 2003-05-14 | 2008-02-13 | 学校法人金沢工業大学 | 4輪独立操舵車両の操舵制御方法 |
JP3883529B2 (ja) * | 2003-08-28 | 2007-02-21 | アイシン精機株式会社 | 車両後退支援装置 |
JP4167959B2 (ja) * | 2003-09-25 | 2008-10-22 | 日本精工株式会社 | 車両用操舵角推定装置 |
JP4513659B2 (ja) * | 2005-06-14 | 2010-07-28 | トヨタ自動車株式会社 | 車両の操舵装置 |
DE102005037468A1 (de) * | 2005-08-09 | 2007-02-15 | Robert Bosch Gmbh | Vorrichtung und Verfahren zur Unterstützung eines Einparkvorgangs eines Fahrzeugs |
JP4287452B2 (ja) * | 2006-09-12 | 2009-07-01 | 本田技研工業株式会社 | 車両の自動操舵装置 |
JP5126357B2 (ja) * | 2009-03-25 | 2013-01-23 | トヨタ自動車株式会社 | 車両の操舵装置 |
WO2010119740A1 (ja) * | 2009-04-17 | 2010-10-21 | ヤンマー株式会社 | 車両及びフィードバック制御方法 |
JP5303356B2 (ja) | 2009-05-21 | 2013-10-02 | 本田技研工業株式会社 | 車両の駐車支援システム |
US9205869B2 (en) * | 2010-08-16 | 2015-12-08 | Honda Motor Co., Ltd. | System and method for determining a steering angle for a vehicle and system and method for controlling a vehicle based on same |
KR101360424B1 (ko) * | 2011-12-09 | 2014-02-10 | 현대자동차주식회사 | 차량용 주차궤적 도출방법 |
FR2992937B1 (fr) * | 2012-07-06 | 2016-04-29 | Jtekt Europe Sas | Procede ameliore de determination de la position angulaire absolue du volant de direction d'un vehicule automobile |
EP2927079B1 (en) * | 2012-11-27 | 2018-01-31 | Nissan Motor Co., Ltd | Acceleration restriction device for vehicle and acceleration restriction method for vehicle |
WO2014167630A1 (ja) * | 2013-04-08 | 2014-10-16 | 三菱電機株式会社 | 操舵制御装置および操舵制御方法 |
JP5989729B2 (ja) * | 2014-09-12 | 2016-09-07 | アイシン精機株式会社 | 出庫支援装置 |
US9714031B2 (en) * | 2015-03-04 | 2017-07-25 | Ford Global Technologies, Llc | Park assist with tire radius consideration |
MX368086B (es) * | 2015-07-21 | 2019-09-19 | Nissan Motor | Dispositivo de plan de conduccion, dispositivo de apoyo de viaje, y metodo de plan de conduccion. |
KR101795151B1 (ko) * | 2015-10-05 | 2017-12-01 | 현대자동차주식회사 | 주차안내 장치 및 방법 |
JP6579441B2 (ja) * | 2016-01-12 | 2019-09-25 | 三菱重工業株式会社 | 駐車支援システム、駐車支援方法及びプログラム |
JP6682355B2 (ja) * | 2016-05-25 | 2020-04-15 | Ntn株式会社 | 車両の旋回制御装置 |
US10106193B2 (en) * | 2016-07-01 | 2018-10-23 | Ford Global Technologies, Llc | Enhanced yaw rate trailer angle detection initialization |
JP6760569B2 (ja) * | 2016-09-16 | 2020-09-23 | 日立オートモティブシステムズ株式会社 | 車両制御装置、車両制御方法および電動パワーステアリング装置 |
JP6787060B2 (ja) * | 2016-11-11 | 2020-11-18 | 株式会社ジェイテクト | 駆動力制御装置及び車両の制御方法 |
JP6279121B1 (ja) * | 2017-03-24 | 2018-02-14 | 株式会社ショーワ | 制御装置、および、ステアリング装置 |
US10730553B2 (en) * | 2017-09-27 | 2020-08-04 | Ford Global Technologies, Llc | Adaptive steering control for robustness to errors in estimated or user-supplied trailer parameters |
GB2568746B (en) * | 2017-11-28 | 2021-05-19 | Jaguar Land Rover Ltd | Parking assist method and apparatus |
-
2017
- 2017-06-09 JP JP2017114462A patent/JP6919349B2/ja active Active
-
2018
- 2018-06-07 US US16/002,283 patent/US10689030B2/en active Active
- 2018-06-08 CN CN201810588968.9A patent/CN109017983B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5991671A (en) * | 1997-10-02 | 1999-11-23 | Mitsubishi Denki Kabushiki Kaisha | Automatic traveling control system for vehicle |
CN1737499A (zh) * | 2004-08-20 | 2006-02-22 | 爱信精机株式会社 | 停车辅助装置 |
US20070146166A1 (en) * | 2005-12-28 | 2007-06-28 | Aisin Seiki Kabushiki Kaisha | Parking assist apparatus |
JP2009006878A (ja) * | 2007-06-28 | 2009-01-15 | Nissan Motor Co Ltd | 車線逸脱防止装置 |
CN101758809A (zh) * | 2008-12-25 | 2010-06-30 | 株式会社丰田自动织机 | 泊车辅助装置 |
US20110218706A1 (en) * | 2010-03-05 | 2011-09-08 | Honda Motor Co., Ltd. | Vehicle motion control apparatus |
CN102407849A (zh) * | 2010-08-23 | 2012-04-11 | 株式会社电装 | 基于移动对象的目标轨迹来支持移动对象的驾驶的设备 |
CN103963781A (zh) * | 2013-02-04 | 2014-08-06 | 福特全球技术公司 | 具有对象回避的拖车主动倒车辅助装置 |
US20150025732A1 (en) * | 2013-07-17 | 2015-01-22 | Electronics And Telecommunications Research Institute | Apparatus and method for controlling automatic parking |
CN106004996A (zh) * | 2016-06-23 | 2016-10-12 | 北京智行者科技有限公司 | 一种智能车转向控制方法及*** |
Non-Patent Citations (1)
Title |
---|
刘希柏,贾克亚,刘浩学等: "《中国道路安全行车指南》", 31 August 1995, 经济日报出版社 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112078653A (zh) * | 2019-06-12 | 2020-12-15 | 现代自动车株式会社 | 车辆终端和用于通过该车辆终端控制转向的方法 |
CN112078653B (zh) * | 2019-06-12 | 2023-06-30 | 现代自动车株式会社 | 车辆终端和用于通过该车辆终端控制转向的方法 |
CN112793579A (zh) * | 2021-04-12 | 2021-05-14 | 顺为智能科技(常州)有限公司 | 一种轮式车辆虚拟轮转向角测量方法 |
Also Published As
Publication number | Publication date |
---|---|
US10689030B2 (en) | 2020-06-23 |
US20180354552A1 (en) | 2018-12-13 |
JP2018203210A (ja) | 2018-12-27 |
CN109017983B (zh) | 2022-11-29 |
JP6919349B2 (ja) | 2021-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109017983A (zh) | 行驶辅助*** | |
JP6724425B2 (ja) | 駐車支援装置 | |
CN109383377B (zh) | 位置推测装置 | |
US20170029027A1 (en) | Parking assistance device, parking assistance method, and non-transitory computer readable medium storing program | |
JP2012001144A (ja) | 駐車支援装置 | |
CN109017761A (zh) | 停车辅助*** | |
WO2017212706A1 (ja) | 駐車評価装置 | |
JP2008285083A (ja) | 駐車支援装置 | |
US10676081B2 (en) | Driving control apparatus | |
WO2018198531A1 (ja) | 駐車支援装置 | |
JP2022023870A (ja) | 表示制御装置 | |
US11301701B2 (en) | Specific area detection device | |
WO2023054238A1 (ja) | 駐車支援装置 | |
WO2018025441A1 (ja) | 周辺監視装置 | |
JP2019131042A (ja) | 駐車支援装置 | |
JP2019127189A (ja) | 駐車支援装置 | |
US10846884B2 (en) | Camera calibration device | |
JP7062983B2 (ja) | 走行支援装置 | |
CN111194396A (zh) | 驾驶辅助装置 | |
WO2023090186A1 (ja) | 駐車支援装置 | |
JP2019022110A (ja) | 表示制御装置 | |
JP2021062727A (ja) | 駐車支援装置、駐車支援方法及び駐車支援プログラム | |
JP2021064868A (ja) | 駐車支援装置 | |
JP2021064149A (ja) | 画像処理装置 | |
CN110871779A (zh) | 用于控制扭矩转向的方法和装置 |
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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: Kariya City, Aichi Prefecture, Japan's Asahi 2 chome 1 GA Applicant after: AISIN Co.,Ltd. Address before: Kariya City, Aichi Prefecture, Japan's Asahi 2 chome 1 GA Applicant before: AISIN SEIKI Kabushiki Kaisha |
|
GR01 | Patent grant | ||
GR01 | Patent grant |