CN104411558A - 车辆的行驶控制装置 - Google Patents

车辆的行驶控制装置 Download PDF

Info

Publication number
CN104411558A
CN104411558A CN201280074528.2A CN201280074528A CN104411558A CN 104411558 A CN104411558 A CN 104411558A CN 201280074528 A CN201280074528 A CN 201280074528A CN 104411558 A CN104411558 A CN 104411558A
Authority
CN
China
Prior art keywords
vehicle
target trajectory
tentative
control
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
CN201280074528.2A
Other languages
English (en)
Other versions
CN104411558B (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.)
Toyota Motor Corp
Original Assignee
Toyota 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 Toyota Motor Corp filed Critical Toyota Motor Corp
Publication of CN104411558A publication Critical patent/CN104411558A/zh
Application granted granted Critical
Publication of CN104411558B publication Critical patent/CN104411558B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/14Adaptive cruise control
    • B60W30/143Speed control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60RVEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R21/00Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/10Path keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/10Path keeping
    • B60W30/12Lane keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18154Approaching an intersection
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18159Traversing an intersection
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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/112Roll movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • B60W2050/0001Details of the control system
    • B60W2050/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0008Feedback, closed loop systems or details of feedback error signal
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • B60W2050/0001Details of the control system
    • B60W2050/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0012Feedforward or open loop systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to overall vehicle dynamics
    • B60W2520/14Yaw
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to occupants
    • B60W2540/215Selection or confirmation of options
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2720/00Output or target parameters relating to overall vehicle dynamics
    • B60W2720/12Lateral speed
    • B60W2720/125Lateral acceleration

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • General Physics & Mathematics (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)

Abstract

基于由至少取得车辆前方的信息的装置所取得的信息所含的作为行驶路特定对象的白线(102、104)来求出车辆的目标轨迹并以使车辆沿着目标轨迹行驶的方式进行行驶轨迹控制的车辆的行驶控制装置。当车辆在行驶路被分成多个行驶路且无法基于白线求出目标轨迹的特定的区域(110)行驶时,基于与特定的区域相邻的区域的作为行驶路特定对象的白线(102、104)及车辆行驶过特定的区域之后应行驶的行驶路,对于特定的区域求出暂定的目标轨迹(116),以使车辆沿着暂定的目标轨迹行驶的方式进行暂定的行驶轨迹控制。

Description

车辆的行驶控制装置
技术领域
本发明涉及车辆的行驶控制装置,更详细而言涉及通过对转向轮的转向角进行控制而使车辆沿着目标轨迹(目标行驶线路)行驶的车辆的行驶控制装置。
背景技术
作为汽车等车辆的行驶控制装置,已知有以使车辆沿着目标轨迹行驶的方式控制行驶轨迹的行驶轨迹控制装置、通过使驾驶员识别车辆相对于车道的横向偏移量来防止车辆从车道脱离的车道维持装置。例如在日本特开2006-264624号公报中记载有后者的车道维持装置的一例。
发明内容
〔发明要解决的课题〕
如上述那样在行驶控制装置中,由CCD相机那样的拍摄装置取得车辆前方的信息,基于所取得的图像信息来确定车辆的前方的行驶路,基于确定出的行驶路来设定车辆应行驶的车道、车辆的目标轨迹。在这种情况下,通过对所取得的图像信息进行电子处理,来判定白线、护栏、中央隔离带、路肩等行驶路特定对象,由此进行行驶路的确定。
然而,例如在交叉口、Y字路、T字路那样行驶路被分成多个行驶路的所谓分岔点的区域中,存在用于判定行驶路的边界的白线那样的行驶路特定对象不存在的区域。在这样的区域中,无法基于行驶路特定对象确定行驶路,因此行驶控制装置无法继续进行基于行驶路特定对象的行驶控制。
本发明鉴于以往的行驶控制装置中的上述那样的问题而作出,本发明的主要课题在于提供一种以即使车辆在行驶路的分岔点的区域行驶的情况下也能够继续进行车辆的行驶控制的方式进行了改良的行驶控制装置。
〔用于解决课题的手段及发明效果〕
上述的主要的课题根据本发明,由如下的车辆的行驶控制装置实现,该车辆的行驶控制装置具有:外界信息取得单元,至少取得车辆前方的信息;及控制单元,基于由外界信息取得单元取得的信息所含的行驶路特定对象来求出车辆的目标轨迹,以使车辆沿着目标轨迹行驶的方式进行行驶轨迹控制,车辆的行驶控制装置的特征在于,将行驶路被分成多个行驶路且无法基于行驶路特定对象求出目标轨迹的区域作为特定的区域,当车辆在特定的区域行驶时,控制单元基于与特定的区域相邻的区域的行驶路特定对象及车辆行驶过特定的区域之后应行驶的行驶路,对于特定的区域求出暂定的目标轨迹,以使车辆沿着暂定的目标轨迹行驶的方式进行暂定的行驶轨迹控制。
根据上述的结构,当车辆在特定的区域行驶时,基于与特定的区域相邻的区域的行驶路特定对象及车辆行驶过特定的区域之后应行驶的行驶路,对于特定的区域求出暂定的目标轨迹。并且,以使车辆沿着暂定的目标轨迹行驶的方式进行暂定的行驶轨迹控制。因此,即使车辆在特定的区域行驶的情况下,也能够通过暂定的行驶轨迹控制来继续进行车辆的行驶控制。
另外,根据本发明,在上述的结构中,可以是,在已经从多个行驶路中选择了车辆应行驶的行驶路时,控制单元基于与特定的区域相邻的区域的行驶路特定对象及所选择的行驶路来设定假想的行驶路特定对象,并基于假想的行驶路特定对象来求出暂定的目标轨迹。
根据上述的结构,在已经从多个行驶路中选择了车辆应行驶的行驶路时,基于与特定的区域相邻的区域的行驶路特定对象及所选择的行驶路来设定假想的行驶路特定对象。并且,基于假想的行驶路特定对象来求出暂定的目标轨迹。因此,在车辆应行驶的行驶路已经被选择时,能够以使车辆能够在该选择的行驶路上行驶的方式求出特定的区域中的暂定的目标轨迹。
另外,根据本发明,在上述的结构中,可以是,在未从多个行驶路中选择车辆应行驶的行驶路时,控制单元基于车辆的行驶状况及驾驶员的驾驶操作来推定多个行驶路中的车辆应行驶的行驶路,基于与特定的区域相邻的区域的行驶路特定对象及推定出的行驶路来设定假想的行驶路特定对象,并基于假想的行驶路特定对象来求出暂定的目标轨迹。
根据上述的结构,在未从多个行驶路中选择车辆应行驶的行驶路时,基于车辆的行驶状况及驾驶员的驾驶操作来推定多个行驶路中的车辆应行驶的行驶路。而且,基于与特定的区域相邻的区域的行驶路特定对象及推定出的行驶路来设定假想的行驶路特定对象,并基于假想的行驶路特定对象来求出暂定的目标轨迹。因此,在车辆应行驶的行驶路未被选择的情况下,能够基于车辆的行驶状况及驾驶员的驾驶操作来求出特定的区域中的暂定的目标轨迹。
另外,根据本发明,在上述的结构中,可以是,控制单元基于假想的行驶路特定对象来判定特定的区域中的车辆的可行驶范围,基于行驶轨迹控制执行中的车辆的位置及可行驶范围来求出暂定的目标轨迹。
根据上述的结构,基于假想的行驶路特定对象来判定特定的区域中的车辆的可行驶范围,基于行驶轨迹控制执行中的车辆的位置及可行驶范围来求出暂定的目标轨迹。因此,能够基于行驶轨迹控制执行中的车辆的位置及可行驶范围来求出暂定的目标轨迹,由此,与未考虑行驶轨迹控制执行中的车辆的位置或可行驶范围的情况相比,能够适当地求出暂定的目标轨迹。
另外,根据本发明,在上述的结构中,可以是,行驶控制装置具有取得特定的区域的地图信息的地图信息取得单元,控制单元基于由地图信息取得单元取得的地图信息来设定假想的行驶路特定对象。
根据上述的结构,基于由地图信息取得单元取得的地图信息来设定假想的行驶路特定对象。因此,即使对于在外界信息取得单元为拍摄装置的情况下无法取得的范围,也能够设定假想的行驶路特定对象,由此能够更可靠地求出关于特定的区域的暂定的目标轨迹。
另外,根据本发明,在上述的结构中,可以是,当车辆需要在特定的区域转弯时,控制单元基于暂定的目标轨迹的半径来推定车身的最小转弯半径及最大转弯半径,在最小转弯半径或最大转弯半径未处于车辆的可行驶范围内时,以使最小转弯半径及最大转弯半径处于车辆的可行驶范围内的方式重新设定暂定的目标轨迹。
根据上述的结构,基于暂定的目标轨迹的半径来推定车身的最小转弯半径及最大转弯半径,在任一转弯半径未处于车辆的可行驶范围内时,以使双方的转弯半径处于车辆的可行驶范围内的方式重新设定暂定的目标轨迹。因此,能够以使车身在车辆的可行驶范围内进行转弯移动的方式根据需要来重新设定暂定的目标轨迹。
另外,根据本发明,在上述的结构中,可以是,控制单元将通过车辆的可行驶范围的轨迹中的、车辆的转弯横向加速度的大小及其变化率的大小的至少一方最小的轨迹作为暂定的目标轨迹。
根据上述的结构,将通过车辆的可行驶范围的轨迹中的、车辆的转弯横向加速度的大小及其变化率的大小的至少一方最小的轨迹作为暂定的目标轨迹。因此,能够求出通过车辆的可行驶范围且车辆的转弯横向加速度的大小及其变化率的大小的至少一方最小的暂定的目标轨迹,能够抑制车辆的乘坐舒适性的下降。
另外,根据本发明,在上述的结构中,可以是,控制单元基于暂定的行驶轨迹控制开始后的驾驶员的驾驶操作,在车辆的可行驶范围内对暂定的目标轨迹进行校正。
根据上述的结构,基于暂定的行驶轨迹控制开始后的驾驶员的驾驶操作,在车辆的可行驶范围内对暂定的目标轨迹进行校正。因此,在由驾驶员进行了驾驶操作的情况下,能够以反映驾驶员的意图的方式校正暂定的目标轨迹。
另外,根据本发明,在上述的结构中,可以是,在暂定的行驶轨迹控制开始后的驾驶员的驾驶操作量的大小为目标轨迹变更的基准值以上的时间持续了目标轨迹变更的基准时间以上时,控制单元基于驾驶员的驾驶操作来变更车辆应行驶的行驶路,基于与特定的区域相邻的区域的行驶路特定对象及变更后的行驶路,重新求出暂定的目标轨迹。
根据上述的结构,在暂定的行驶轨迹控制开始后的驾驶员的驾驶操作量的大小为目标轨迹变更的基准值以上的时间持续了目标轨迹变更的基准时间以上时,基于驾驶员的驾驶操作来变更车辆应行驶的行驶路。并且,基于与特定的区域相邻的区域的行驶路特定对象及变更后的行驶路,重新求出暂定的目标轨迹。因此,如驾驶员想要变更行进路的情况那样暂定的目标轨迹与驾驶员意图的行进路不同的情况下,能够按照驾驶员的意图来重新求出暂定的目标轨迹。
另外,根据本发明,在上述的结构中,可以是,控制单元在暂定的行驶轨迹控制中,通过反馈控制及前馈控制的至少一方来计算用于使车辆的轨迹成为暂定的目标轨迹的转向轮的暂定的目标转向角,并基于暂定的目标转向角来控制转向轮的转向角。
根据上述的结构,通过反馈控制及前馈控制的至少一方来计算用于使车辆的轨迹成为暂定的目标轨迹的转向轮的暂定的目标转向角,并基于暂定的目标转向角来控制转向轮的转向角。因此,能够以使车辆沿着暂定的目标轨迹行驶的方式控制转向轮的转向角。
另外,根据本发明,在上述的结构中,可以是,控制单元在车辆驶入特定的区域之前使行驶控制从行驶轨迹控制向暂定的行驶轨迹控制逐渐过渡。
根据上述的结构,在车辆驶入特定的区域之前使行驶控制从行驶轨迹控制向暂定的行驶轨迹控制逐渐过渡。因此,与在车辆驶入特定的区域时使行驶控制从行驶轨迹控制向暂定的行驶轨迹控制过渡的情况相比,能够可靠地降低因控制的过渡而使车辆的运行情况急剧变化或者使乘员感到不适的可能性。
另外,根据本发明,在上述的结构中,可以是,控制单元在车辆完成了特定的区域的行驶之后使行驶控制从暂定的行驶轨迹控制向行驶轨迹控制逐渐过渡。
根据上述的结构,在车辆完成了特定的区域的行驶之后使行驶控制从暂定的行驶轨迹控制向行驶轨迹控制逐渐过渡。因此,与在车辆完成特定的区域的行驶时使行驶控制从暂定的行驶轨迹控制向行驶轨迹控制过渡的情况相比,能够可靠地降低因控制的过渡而使车辆的运行情况急剧变化或使乘员感到不适的可能性。
另外,根据本发明,在上述的结构中,可以是,特定的区域是交叉口、T字路、分岔路中的任一个。
根据上述的结构,由于特定的区域是交叉口、T字路、分岔路中的任一个,因此车辆在上述特定的区域行驶时,能够可靠地进行暂定的行驶轨迹控制,从而继续进行行驶控制。
〔课题解决手段的优选的形态〕
根据本发明的一优选的形态,可以是,车辆具有使转向输入单元的操作位置与转向轮的转向角的关系变化的转向角可变装置,通过控制转向角可变装置来控制转向轮的转向角。
根据本发明的另一优选的形态,可以是,车辆具有导航装置,按照由导航装置设定的行驶路径来选择车辆应行驶的行驶路。
根据本发明的另一优选的形态,可以是,未选择车辆应行驶的行驶路时包括车辆不具有导航装置的情况及虽然车辆具有导航装置但是未通过导航装置设定行驶路径的情况。
根据本发明的另一优选的形态,可以是,在基于假想的行驶路特定对象而判定的行驶路的两侧部设定余量,由此来判定特定的区域中的车辆的可行驶范围。
根据本发明的另一优选的形态,可以是,在暂定的行驶轨迹控制开始后的驾驶员的驾驶操作量的大小为目标轨迹校正的基准值以上的时间持续了目标轨迹校正的基准时间以上时,校正暂定的目标轨迹。
根据本发明的另一优选的形态,可以是,使目标轨迹从通常的目标轨迹向暂定的目标轨迹逐渐变化,由此使行驶控制从行驶轨迹控制向暂定的行驶轨迹控制逐渐过渡。
根据本发明的另一优选的形态,可以是,使目标轨迹从暂定的目标轨迹向通常的目标轨迹逐渐变化,由此使行驶控制从暂定的行驶轨迹控制向行驶轨迹控制逐渐过渡。
附图说明
图1是表示适用于导航装置搭载车并构成为行驶轨迹控制装置的本发明的车辆的行驶控制装置的第一实施方式的简要结构图。
图2是表示第一实施方式的行驶轨迹控制例程的前半部分的通常流程图。
图3是表示第一实施方式的行驶轨迹控制例程的后半的通常流程图。
图4是表示图3的步骤300的基于导航信息的暂定的目标轨迹的设定例程的流程图。
图5是表示图3的步骤400的基于拍摄信息的暂定的目标轨迹的设定例程的流程图。
图6是表示在图3的步骤600中执行的从通常的轨迹控制向暂定的轨迹控制过渡的目标轨迹的设定例程的流程图。
图7是表示在图3的步骤800中执行的从暂定的轨迹控制向通常的轨迹控制过渡的目标轨迹的设定例程的流程图。
图8是表示适用于导航装置搭载车且以不进行基于拍摄信息的暂定的轨迹控制的方式构成的本发明的车辆的行驶控制装置的第二实施方式的行驶轨迹控制例程的后半部分的通常流程图。
图9是表示适用于未搭载导航装置的车辆而构成为行驶轨迹控制装置的本发明的车辆的行驶控制装置的第三实施方式的行驶轨迹控制例程的后半部分的通常流程图。
图10是表示分岔点的种类为交叉口的情况下的地图的决定及本车的当前地的推定的要领的说明。
图11是表示在分岔点为正交的十字路的情况下设定直行的可行驶范围的要领的说明图。
图12是表示在分岔点为未正交的十字路的情况下设定直行的可行驶范围的要领的说明图。
图13是表示在分岔点为正交的十字路的情况下设定左转弯的可行驶范围的要领的说明图。
图14是表示在分岔点为未正交的十字路的情况下设定左转弯的可行驶范围的要领的说明图。
图15是表示在车道为多个且分岔点为正交的十字路的情况下设定左转弯的可行驶范围的要领的说明图。
图16是表示在车道为多个且分岔点为未正交的十字路的情况下设定左转弯的可行驶范围的要领的说明图。
图17是表示在分岔点为正交的十字路的情况下设定右转弯的可行驶范围的要领的说明图。
图18是表示在分岔点为未正交的十字路的情况下设定右转弯的可行驶范围的要领的说明图。
图19是表示在车道为多个且分岔点为正交的十字路的情况下设定右转弯的可行驶范围的要领的说明图。
图20是表示在车道为多个且分岔点为未正交的十字路的情况下设定右转弯的可行驶范围的要领的说明图。
图21是表示在分岔点为正交的十字路的情况下设定U字形转弯的可行驶范围的要领的说明图。
图22是表示在分岔点为未正交的十字路的情况下设定U字形转弯的可行驶范围的要领的说明图。
图23是表示当车辆在正交的十字路的近前行驶时由CCD相机拍摄的范围的边界及通过拍摄而识别的十字路的范围的图。
图24是表示在生成地图之后车辆在正交的十字路上直行的情况的图。
图25是表示在生成地图之后车辆在正交的十字路上进行右转弯的情况的图。
图26是表示所生成的正交的十字路的地图的图。
图27是表示由于存在道路标识、道路标志而将图26所示的行进路中的可选择的行进路确定为直行的行进路及左转弯的行进路的状况的图。
图28是表示在图27所示的正交的十字路上车辆分别在直行的行进路及左转弯的行进路上行驶的情况下的暂定的目标轨迹的图。
图29是表示车辆沿着直行的暂定的目标轨迹及左转弯的暂定的目标轨迹行驶的情况下的判定用参数的绝对值的变化的坐标图。
图30是表示车速V与判定用参数的基准值的关系的坐标图。
图31是表示车辆迫近正交的十字路时设定的坐标系的图。
图32是表示暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标及角度相同但是x坐标互不相同的情况下的过渡的目标轨迹的一例的图。
图33是表示暂定的目标轨迹的终端及通常的目标轨迹的始端的x坐标及y坐标相同但是角度互不相同的情况下的过渡的目标轨迹的一例的图。
图34是表示暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标相同但是x坐标及角度分别互不相同的情况下的过渡的目标轨迹的一例的图。
图35是表示车辆通过正交的十字路时设定的坐标系的图。
图36是表示暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标及角度相同但是x坐标互不相同的情况下的过渡的目标轨迹的一例的图。
图37是表示暂定的目标轨迹的终端及通常的目标轨迹的始端的x坐标及y坐标相同但是角度互不相同的情况下的过渡的目标轨迹的一例的图。
图38是表示暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标相同但是x坐标及角度分别互不相同的情况下的过渡的目标轨迹的一例的图。
图39是表示基于车辆的重心G的目标轨迹的半径R而求出车身的最小转弯半径Rbi及车身的最大转弯半径Rbo的要领的说明图。
图40是表示在车辆在正交的十字路上进行左转弯的情况下将特定的区域划分为两个区间的要领及求出车身的最小转弯轨迹及最大转弯轨迹的要领的说明图。
图41是表示在车身的最小转弯轨迹未处于可行驶范围内的情况下考虑车身的转弯半径而重新设定暂定的目标轨迹的要领的说明图。
图42是表示在即使再设定暂定的目标轨迹而车身的最小转弯轨迹也未处于可行驶范围内的情况下考虑车身的转弯半径而再次重新设定暂定的目标轨迹的要领的说明图。
图43是表示目标轨迹的半径R、车辆的重心相对于目标轨迹的横向偏差Dy、车辆相对于目标轨迹的横摆角的说明图。
图44是表示基于车辆的目标横向加速度Gyt及车速V而用于计算暂定或过渡的轨迹控制用的左右前轮的目标转向角δt的映射的图。
图45是表示暂定的目标轨迹为在正交的十字路上进行左转弯的轨迹且由驾驶员减少左转弯方向的转向角的情况下的暂定的目标轨迹的校正的说明图。
图46是表示分岔点处的任务是在正交的十字路上进行左转弯且通过驾驶员以使转向角θ接近于0的方式进行变更的情况下的分岔点处的任务的变更的说明图。
具体实施方式
以下,参照附图,详细说明本发明的几个优选的实施方式。另外,下述的各实施方式是适用于车辆靠左侧通行的情况下的实施方式,但本发明也可以适用于靠右侧通行的车辆。
[第一实施方式]
图1是表示适用于导航装置搭载车且构成为行驶轨迹控制装置的本发明的车辆的行驶控制装置的第一实施方式的简要结构图。
在图1中,10表示搭载于车辆12的行驶轨迹控制装置,行驶轨迹控制装置10具有前轮用转向控制装置14。前轮用转向控制装置14构成与驾驶员的转向操作无关地能够使前轮转向的转向控制单元。而且,在车辆12上搭载制动力控制装置16,制动力控制装置16能够与驾驶员的制动操作无关地分别控制各车轮的制动力。
另外,在图1中,18FL及18FR分别表示车辆12的作为转向轮的左右的前轮,18RL及18RR分别表示左右的后轮。作为转向轮的左右的前轮18FL及18FR通过响应驾驶员对方向盘20的操作而被驱动的齿条小齿轮型的动力转向装置22,经由齿条24和转向横拉杆26L及26R进行转向。
方向盘20经由上转向轴28、转向角可变装置30、下转向轴32、万向接头34而与动力转向装置22的小齿轮轴36进行驱动连接。在图示的第一实施方式中,转向角可变装置30包含辅助转向驱动用的电动机38,该电动机38在壳体30A侧连接于上转向轴28的下端,在转子30B侧连接于下转向轴32的上端。
这样一来,转向角可变装置30相对于上转向轴28相对地驱动下转向轴32旋转,由此对左右的前轮18FL及18FR相对于方向盘20相对地进行辅助转向驱动。转向角可变装置30由电子控制装置40的转向控制部控制。
动力转向装置22是齿条同轴型的电动式的动力转向装置,具有电动机42和将电动机42的旋转转矩转换成齿条24的往复移动方向的力的例如滚珠丝杠式的转换机构44。动力转向装置22由电子控制装置40的转向辅助转矩控制部控制,产生相对于壳体46相对地驱动齿条24的转向辅助转矩。转向辅助转矩减轻驾驶员的转向负担,而且根据需要对转向角可变装置30产生的左右前轮的转向驱动进行辅助。
这样一来,转向角可变装置30与动力转向装置22互相协作地变更左右前轮相对于方向盘20的转向角的关系,并且转向角可变装置30构成与驾驶员的转向操作无关地使前轮进行转向的前轮用转向控制装置14的主要部分。
另外,动力转向装置22及转向角可变装置30的结构自身并不构成本发明的主旨,这些装置只要分别发挥上述的功能即可,在本技术领域中可以是公知的任意的结构。
制动力控制装置16包含制动装置50,通过制动装置50的液压回路52来控制轮缸54FL、54FR、54RL、54RR内的压力Pi(i=fl、fr、rl、rr)即制动压,由此来控制各车轮的制动力。虽然在图1中未示出,但是液压回路52包含储油器、油泵、各种阀装置等,各轮缸的制动压在通常时由根据驾驶员对制动踏板56的踏下操作而被驱动的主缸58控制。而且,根据需要通过电子控制装置40的制动力控制部来控制液压回路52,由此分别控制各轮缸的制动压。这样一来,制动装置50与驾驶员的制动操作无关地能够分别控制各车轮的制动力,作为制动力控制装置16的主要的装置发挥功能。
在上转向轴28设有检测该轴的旋转角度作为转向角θ的转向角传感器62及检测转向转矩Ts的转向转矩传感器64,将表示转向角θ及转向转矩Ts的信号向电子控制装置40输入。而且,将表示由旋转角度传感器66检测出的转向角可变装置30的相对旋转角度θre、即下转向轴32相对于上转向轴28的相对旋转角度的信号向电子控制装置40输入。
在图示的实施方式中,在车辆12的车室的上方前部设置对车辆12的前方进行拍摄的CCD相机68,将表示车辆12的前方的图像信息的信号从CCD相机68向电子控制装置40输入。也将由车速传感器70检测出的表示车速V的信号、由横向加速度传感器72检测出的表示车辆的横向加速度Gy的信号、及由横摆率传感器74检测出的表示车辆的横摆率γ的信号向电子控制装置40输入。另外,转向角传感器62、转向转矩传感器64、旋转角度传感器66分别以车辆向左转弯方向的转向或转舵的情况为正来检测转向角θ、转向转矩Ts、相对旋转角度θre。
在车辆12上设有用于选择是否进行也被称为车道保持辅助控制(LKA控制)的行驶轨迹控制的选择开关76、用于选择是否许可暂定的行驶轨迹控制的许可开关78。也将表示选择开关76及许可开关78的设定位置的信号向电子控制装置40输入。而且,在车辆12上搭载有导航装置80,电子控制装置40与导航装置80进行必要的信息的交接。
而且,将由图1未示出的压力传感器检测出的表示主缸压力Pm等的信号向电子控制装置40输入,电子控制装置40如行驶轨迹控制的状况那样将车辆的乘员所需的信息显示于显示装置82。显示装置82可以是导航装置80的监视器的一部分,而且,也可以是与导航装置80的监视器不同的显示装置。
另外,电子控制装置40的上述的各控制部分别可以包含微型计算机,该微型计算机具有CPU、ROM、RAM、输入输出端口装置且它们通过双向性的公用总线而相互连接。尤其是,ROM存储后述的行驶轨迹控制的程序、映射,并按照交叉口、Y字路、T字路等分岔点的各种类来存储道路所成的角度、车道数互不相同的多个地图。
电子控制装置40的转向控制部按照图2及图3所示的流程图进行行驶轨迹控制。尤其是转向控制部在选择开关76接通且能够进行通常的行驶轨迹控制时,计算用于进行通常的轨迹控制的左右前轮的目标转向角δt。即,转向控制部基于由CCD相机68取得的车辆12的前方的图像信息来确定行驶路,计算用于使车辆12沿着基于确定出的行驶路的目标轨迹行驶的左右前轮的通常的目标转向角δtn作为轨迹控制的目标转向角δt。
另外,电子控制装置40的转向控制部在虽然选择开关76接通但是车辆在特定的区域行驶而无法进行使车辆沿着通常的目标轨迹行驶的通常的轨迹控制时,如后面详细说明那样,进行暂定的轨迹控制。即,转向控制部设定车辆用于在特定的区域行驶的暂定的目标轨迹,并计算用于使车辆沿着暂定的目标轨迹行驶的左右前轮的暂定的目标转向角δtp作为轨迹控制的目标转向角δt。
另外,在本说明书中,“特定的区域”是指行驶路被分成多个行驶路的所谓分岔点且无法基于如白线那样的行驶路特定对象求出目标轨迹的区域。具体而言,“特定的区域”是交叉口、Y字路、T字路,“行驶路特定对象”是白线、护栏、中央隔离带、路肩那样通过判定行驶路的边界来确定行驶路用的对象。而且,“暂定的目标轨迹”是指以使车辆行驶过特定的区域之后能够在应行驶的行驶路上行驶的方式对于特定的区域所设定的目标轨迹。
而且,电子控制装置40的转向控制部使目标轨迹逐渐变化使得目标轨迹在通常的目标轨迹与暂定的目标轨迹之间切换时避免左右前轮的转向角急剧变化。即,转向控制部以使在目标轨迹切换时避免目标轨迹的行驶路的宽度方向的位置、朝向急剧变化的方式,求出用于使目标轨迹逐渐变化的过渡的目标轨迹,并基于过渡的目标轨迹进行过渡的轨迹控制。
尤其是转向控制部在能够进行通常的轨迹控制的状况下判定为之后需要将目标轨迹从通常的目标轨迹向暂定的目标轨迹切换时,在该阶段使用于从通常的目标轨迹向暂定的目标轨迹逐渐过渡的过渡的轨迹控制开始。相对于此,在目标轨迹从暂定的目标轨迹向通常的目标轨迹切换时,转向控制部在能够进行通常的轨迹控制的阶段使用于从暂定的目标轨迹向通常的目标轨迹逐渐过渡的过渡的轨迹控制开始。
而且,电子控制装置40的转向控制部计算与车辆12的左右前轮的目标转向角δt对应的目标小齿轮角度θpt,以使小齿轮36的角度成为目标小齿轮角度θpt的方式控制转向角可变装置30。
另外,用于使车辆沿着目标轨迹行驶的目标转向角δt的运算自身并未成为本发明的主旨,因此在目标轨迹为通常的目标轨迹、暂定的目标轨迹、过渡的目标轨迹中的任一个的情况下,都可以通过任意的要领进行。但是,如后面详细说明那样,优选推定车辆相对于目标轨迹的横向偏差及车辆相对于目标轨迹的横摆角、目标轨迹的半径,基于推定出的参数来计算转向轮的目标转向角。
<行驶轨迹控制的通常流程>
接着,参照图2及图3所示的通常流程图来说明第一实施方式的行驶轨迹控制例程。另外,图2及图3所示的流程图的控制通过图中未示出的点火装置开关的闭合而开始,每隔预定的时间重复执行。而且,在以下的说明所参照的附图中,根据需要而将导航装置简称为导航装置,将来自导航装置的导航信息简称为导航信息。
首先,在步骤10中,判别是否选择开关76接通且轨迹控制被许可。并且,在作出了肯定判别时,控制前进至步骤30,在作出了否定判别时,暂时结束图2所示的流程图的控制。另外,在执行由通常的轨迹控制、过渡的轨迹控制或暂定的轨迹控制产生的左右前轮的转向角的控制时,中止该控制。
在步骤30中,车辆未在特定的区域行驶,基于如白线那样的行驶路特定对象来求出目标轨迹,由此来判别是否能够进行通常的轨迹控制。并且,在作出了肯定判别时,控制前进至步骤70,在作出了否定判别时,控制前进至步骤50。
在步骤50中,与是否处于从通常的轨迹控制向暂定的轨迹控制的过渡中相关的标志Fnp及与是否处于从暂定的轨迹控制向通常的轨迹控制的过渡中相关的标志Fpn被重置为0,然后控制前进至步骤210。
在步骤70中,基于由CCD相机68取得的车辆12的前方的图像信息来确定行驶路,并基于确定出的行驶路来设定通常的轨迹控制的目标轨迹。
在步骤90中,判别是否进行暂定的轨迹控制。并且,在作出了否定判别时,控制前进至步骤130,在作出了肯定判别时,在步骤110中将标志Fnp重置为0,并将标志Fpn设置为1,然后控制前进至步骤210。
在步骤130中,通过标志Fnp或Fpn是否为1的判别,来判别是否进行后述的过渡的轨迹控制。并且,在作出了肯定判别时,控制前进至步骤910,在作出了否定判别时,控制前进至步骤150。
在步骤150中,判别在从当前起经过预先设定的时间时到达的区域、或从当前地起的预先设定的距离前方的区域是否存在特定的区域,即判别是否需要从通常的轨迹控制向暂定的轨迹控制的过渡。并且,在作出了肯定判别时,在步骤160中将标志Fnp设置为1,并将标志Fpn重置为0,然后控制前进至步骤210。相对于此,在作出了否定判别时,在步骤170中将标志Fnp及Fpn重置为0,然后控制前进至步骤190。
另外,在导航装置80处于工作中时,可以基于来自导航装置80的信息来判定特定的区域是否存在。而且,在导航装置80不处于工作中时,可以基于由CCD相机68取得的车辆12的前方的图像信息来判定特定的区域是否存在。而且,预先设定的时间或预先设定的距离可以固定,但是为了使目标轨迹在通常的目标轨迹与暂定的目标轨迹之间可靠地切换,可以以车速V越高则时间和距离越长的方式根据车速进行可变设定。
在步骤190中,计算用于使车辆沿着在上述的步骤70中设定的通常的目标轨迹行驶的左右前轮的通常的目标转向角δtn,以使左右前轮的转向角成为目标转向角δtn的方式控制转向角可变装置30。另外,通常的轨迹控制并未成为本发明的主旨,而且可以通过任意的要领执行,因此省略关于通常的轨迹控制的进一步的说明,但优选与暂定的轨迹控制等同样地进行。
在步骤210中,判别是否许可开关78接通且暂定的轨迹控制被许可。并且,在作出了肯定判别时,控制前进至步骤250,在作出了否定判别时,控制前进至步骤230。
在步骤230中,轨迹控制暂时结束,控制返回到步骤10。但是,在标志Fnp为1时,在标志Fnp成为0之前,控制前进至步骤190,继续进行通常的轨迹控制。
在步骤250中,判别暂定的目标轨迹是否已经被设定,在作出了肯定判别时,控制前进至步骤510,在作出了否定判别时,控制前进至步骤270。
在步骤270中,判别导航装置80是否处于工作中,在作出了否定判别时,控制前进至步骤400,在作出了肯定判别时,控制前进至步骤290。
在步骤290中,判别是否能够进行基于来自导航装置80的导航信息的暂定的轨迹控制,在作出了否定判别时,控制前进至步骤400,在作出了肯定判别时,控制前进至步骤300。例如,在导航装置80中设定目的地,因此,在设定目标的行驶路径的情况下作出肯定判别。
在步骤300中,如后面详细说明那样,按照图4所示的流程图,基于来自导航装置80的导航信息而设定暂定的目标轨迹。
在步骤400中,如后面详细说明那样,按照图5所示的流程图,基于由CCD相机68取得的车辆12的前方的图像信息来设定暂定的目标轨迹。
在步骤510中,判别标志Fnp是否为1,即是否为从通常的轨迹控制向暂定的轨迹控制的过渡中。并且,在作出了肯定判别时,控制前进至步骤600,在作出了否定判别时,控制前进至步骤710。
在步骤600中,为了顺畅地进行从通常的轨迹控制向暂定的轨迹控制的过渡,如后面详细说明那样,按照图6所示的流程图来设定从通常的轨迹控制向暂定的轨迹控制的过渡的目标轨迹。当步骤600完成时,控制前进至步骤910。
在步骤710中,判别标志Fpn是否为1,即是否为从暂定的轨迹控制向通常的轨迹控制的过渡中。并且,在作出了否定判别时,控制前进至步骤910,在作出了肯定判别时,控制前进至步骤800。
在步骤800中,为了顺畅地进行从暂定的轨迹控制向通常的轨迹控制的过渡,如后面详细说明那样,按照图7所示的流程图来设定从暂定的轨迹控制向通常的轨迹控制的过渡的目标轨迹。当步骤800完成时,控制前进至步骤910。
在步骤910中,如后面详细说明那样,基于左右前轮18FL、18FR的车轮速度Vfl、Vfr、左右后轮18RL、18RR的车轮速度Vrl、Vrr、左右前轮的转向角δ来推定本车的当前地。
在步骤930中,计算用于使车辆沿着在步骤300或400中设定的暂定的目标轨迹或在步骤600或800中设定的过渡的目标轨迹行驶的左右前轮的目标转向角δt。并且,通过与通常的轨迹控制的情况相同的要领,以使左右前轮的转向角δ成为目标转向角δt的方式控制转向角可变装置30,由此来执行暂定的轨迹控制或过渡的轨迹控制。
在步骤950中,如后面详细说明那样,以车辆的行驶路径反映驾驶员的意图的方式,根据需要,对应于驾驶员的转向操作来校正或变更通常的目标轨迹、过渡的轨迹控制或暂定的目标轨迹。
<基于导航信息的暂定的目标轨迹的设定>
接着,参照图4所示的流程图,说明上述的步骤300的基于导航信息的暂定的目标轨迹的设定。
首先,在步骤305中,判别从此通过的分岔点是否为由导航装置80设定的行驶路径上的分岔点。并且,在作出了否定判别时,在步骤310中在车辆进入到特定的区域的阶段中止轨迹控制,在作出了肯定判别时,控制前进至步骤315。
另外,在距当前地的距离为第一距离D1至第二距离D2的范围内存在分岔点的情况下,或者在从当前起的经过时间为第一时间T1至第二时间T2的时间通过的区域内存在分岔点的情况下,进行步骤305的判别。距离D1、D2及时间T1、T2可以是常数。但是,距离D1及D2优选以例如车速V越高则越大的方式根据车速进行可变设定。
在步骤315中,基于由CCD相机68取得的车辆12的前方的图像信息的白线等,从关于预先存储的分岔点的多个地图来选择,由此决定该分岔点的地图。而且,在步骤315中,通过推定距前方的图像信息中的两个特定的对象物例如交叉口的两个角的白线为止的距离,来推定地图上的本车的当前地。
例如,基于图像信息的白线等来判定分岔点的种类(交叉口、Y字路、T字路等),基于判定出的分岔点的种类来决定地图的种类(交叉口、Y字路、T字路等)。接着,从所决定的种类的多个地图,选择图像信息的白线等与地图上的白线等的一致程度最高的地图。另外,在该步骤中使用的地图可以不是预先存储的地图,而是基于从导航装置80供给的信息的地图。
图10是表示分岔点的种类为交叉口的情况下的地图的决定及本车的当前地的推定的要领的说明图。另外,在图10中,100表示地图,102及104分别表示道路的中央的白线及路肩的白线,106及108分别表示人行横道及车辆停止线。而且,在图10中,110表示不存在白线102及104等的特定的区域,112表示能够由CCD相机68取得的车辆12的前方的图像信息的范围的边界。
如图10所示,基于交叉口的角的路肩的白线104等,从预先存储的关于交叉口的多个地图进行选择,由此来决定该交叉口的地图。而且,基于图像信息来推定距两个角的路肩的白线104等的距离,并基于该推定结果来推定地图上的本车的当前地。
在步骤320、335、350、365中,基于由导航装置80设定的行驶路径,判定分岔点的行驶任务是否分别为直行、向左方向的转弯、向右方向的转弯、U字形转弯中的任一个。
尤其是在步骤320中,判别分岔点的行驶任务是否为直行。并且,在作出了否定判别时,控制前进至步骤335,在作出了肯定判别时,控制前进至步骤325。
在步骤325中,在地图上,当前车辆行驶的行驶路的白线等和/或车辆通过分岔点之后车辆行驶的行驶路的白线等延长到特定的区域,由此设定分岔点的直行的可行驶范围。
例如,图11是表示在分岔点为正交的十字路的情况下设定直行的可行驶范围的要领的说明图。另外,在图11及后述的其他图中,黑色圆圈表示沿车辆12的行驶方向观察而白线102及104消失的点,白色圆圈表示白线102及104恢复的点,114表示道路标志,该道路标志表示在道路的表面上标记的可行进的方向。
在图11中,当前车辆12行驶的行驶路的白线102及104向车辆的行驶方向作为假想的白线102A及104A而延长到特定的区域110。而且,在通过交叉口后,车辆行驶的行驶路的白线102及104向车辆的行驶方向的相反方向作为假想的白线102B及104B而延长到特定的区域110。另外,在图11中,102C及104C分别表示假想的白线102A及104A与假想的白线102B及104B的交点。
另外,在假想的白线102A与104A之间及假想的白线102B与104B之间,在从对应的白线向行驶路的中央侧位移了预先设定的余量的位置处设定直行的可行驶范围的边界线102m及104m。直行的可行驶范围是边界线102m与104m之间的范围。
另外,以上的直行的可行驶范围的设定并不局限于分岔点为正交的十字路的情况,例如如图12所示,在分岔点为未正交的十字路的情况下也同样。但是,在这种情况下,车辆的可行驶范围不是完全的直线状,在分岔点处倾斜一定角度。
另外,在分岔点为T字路的情况下,与在图11中左转弯侧的行驶路或右转弯侧的行驶路不存在的情况相同。同样,在分岔点为Y字路且行驶路径为接近于直行的一侧的情况下,与在图12中右转弯侧的行驶路不存在的情况实质上相同。
而且,在车道为多个的情况下,虽然在图中未示出,但是关于当前车辆行驶的车道及车辆通过了交叉口之后行驶的车道,通过上述的要领来设定直行的可行驶范围。
在步骤330中,例如设定暂定的目标轨迹作为通过直行的可行驶范围的中央的线。在图11及图12中,116表示作为将边界线102m及104m之间的中间点连结的线而设定的暂定的目标轨迹。
在步骤335中,判别分岔点处的行驶任务是否为向左方向的转弯即左转弯。并且,在作出了否定判别时,控制前进至步骤350,在作出了肯定判别时,控制前进至步骤340。
在步骤340中,在地图上,当前车辆行驶的行驶路的白线等及车辆在分岔点处向左方向进行了转弯之后车辆行驶的行驶路的白线等延长到特定的区域,由此设定分岔点处的左转弯的可行驶范围。
例如,图13是表示在分岔点为正交的十字路的情况下设定左转弯的可行驶范围的要领的说明图。
在图13中,当前车辆12行驶的行驶路的白线102及104作为假想的白线102D及104D而延长到特定的区域110。而且,车辆在交叉口进行了左转弯之后车辆行驶的行驶路的白线102及104作为假想的白线102E及104E而延长到特定的区域110。另外,在图13中,102F及104F分别表示假想的白线102D及104D与假想的白线102E及104E的交点。
另外,在假想的白线102D与104D之间及假想的白线102E与104E之间,在从对应的白线向行驶路的中央侧位移了预先设定的余量的位置设定左转弯的可行驶范围的边界线102m及104m。在这种情况下,转弯内轮侧的角部的余量的大小比其他区域大。左转弯的可行驶范围是边界线102m与104m之间的范围。
另外,以上的左转弯的可行驶范围的设定并不局限于分岔点为正交的十字路的情况,例如如图14所示,在分岔点为未正交的十字路的情况下也同样。但是,在这种情况下,车辆的可行驶范围不是呈直角折弯的形状,而在分岔点处成为以直角以外的角度折弯的形状。
另外,在分岔点为T字路的情况下,与在图13中右转弯侧的行驶路不存在的情况相同。同样,在分岔点为Y字路的情况下,与在图14中右转弯侧的行驶路不存在的情况实质上相同。
而且,在车道为多个的情况下,例如如与图13及图14分别对应的图15及图16所示,关于当前车辆行驶的车道及车辆进行了左转弯之后行驶的车道,通过上述的要领来设定左转弯的可行驶范围。在图15及图16中,118表示将车道分开的白线,118D及118E表示白线118延长到特定的区域110的假想的白线,118F表示假想的白线118D及118E的交点。另外,在图15及图16中,图示出车辆在右侧的车道上行驶的情况,但是车辆在左侧的车道上行驶的情况也同样。
另外,在假想的白线102D与118D之间及假想的白线102E与118E之间,在从对应的白线向行驶路的中央侧位移了预先设定的余量的位置设定左转弯的可行驶范围的边界线102m及118m。在这种情况下,转弯内轮侧的角部的余量的大小比其他区域大。左转弯的可行驶范围是边界线102m与118m之间的范围。
在步骤345中,例如设定暂定的目标轨迹作为通过左转弯的可行驶范围的中央的线。在图13及图14中,116是将边界线102m及104m之间的中间点连结的线,即表示作为角部呈圆弧状的线而设定的暂定的目标轨迹。而且,在图15及图16中,116是将边界线102m及118m之间的中间点连结的线,即表示作为角部呈圆弧状的线而设定的暂定的目标轨迹。
在步骤350中,判别分岔点处的行驶任务是否为向右方向的转弯、即右转弯。并且,在作出了否定判别时,控制前进至步骤365,在作出了肯定判别时,控制前进至步骤355。
在步骤355中,在地图上,当前车辆行驶的行驶路的白线等及车辆在分岔点处向右方向进行了转弯之后车辆行驶的行驶路的白线等延长到特定的区域,由此来设定分岔点处的右转弯的可行驶范围。
例如,图17是表示在分岔点为正交的十字路的情况下设定右转弯的可行驶范围的要领的说明图。
在图17中,当前车辆12行驶的道路的全部的白线102及104作为假想的白线102D及104D而延长到特定的区域110。而且,与当前车辆12行驶的道路交叉的道路的全部的白线102及104作为假想的白线102E及104E而延长到特定的区域110。另外,在图17中,102F及104F分别表示假想的白线102D及104D与假想的白线102E及104E的交点。
另外,将假想的白线的交点102F、104F、102F连结的线被设定为用于设定可行驶范围的转弯外侧的假想的白线120。而且,假想的白线120向转弯内侧移动了与白线102和白线104的间隔实质上相同的距离D所得到的线被设定为转弯内侧的假想的白线122。
另外,在假想的白线102D与104D之间及假想的白线120与122之间,在从对应的白线向行驶路的中央侧位移了预先设定的余量的位置处设定右转弯的可行驶范围的边界线102m及104m。右转弯的可行驶范围是边界线102m与104m之间的范围。
另外,以上的右转弯的可行驶范围的设定并不局限于分岔点为正交的十字路的情况,例如如图18所示,在分岔点为未正交的十字路的情况下也同样。但是,在这种情况下,车辆的可行驶范围不是整体折弯成直角的形状,而是整体在分岔点处以直角以外的角度折弯的形状。
另外,在分岔点为T字路的情况下,与在图17中左转弯侧的行驶路不存在的情况相同。同样,在分岔点为Y字路的情况下,与在图18中朝向的一侧的行驶路不存在的情况实质上相同。
而且,在车道为多个的情况下,例如如与图17及图18分别对应的图19及图20所示,关于当前车辆行驶的车道及车辆进行了右转弯之后行驶的车道,通过上述的要领来设定右转弯的可行驶范围。与图15及图16的情况同样,118表示将车道分开的白线,118D及118E表示白线118延长到特定的区域110的假想的白线。118F表示假想的白线118D及118E的交点。另外,在图19及图20中,图示出车辆在左侧的车道上行驶的情况,但是车辆在右侧的车道上行驶的情况也同样。
另外,将假想的白线的交点104F、118F、102F、104F连结的线被设定为用于设定可行驶范围的转弯外侧的假想的白线120。而且,假想的白线120向转弯内侧移动了与白线102和白线104的间隔实质上相同的距离D所得到的线被设定为转弯内侧的假想的白线122。
另外,在假想的白线102D与104D之间及假想的白线120与122之间,在从对应的白线向行驶路的中央侧位移了预先设定的余量的位置处设定右转弯的可行驶范围的边界线120m及122m。右转弯的可行驶范围是边界线120m与122m之间的范围。
在步骤360中,例如设定暂定的目标轨迹作为通过右转弯的可行驶范围的中央的线。在图17及图18中,116表示作为通过边界线102m及104m之间的实质上圆弧状的线、或将边界线102m及104m之间的中间点连结的线即角部呈圆弧状的线而设定的暂定的目标轨迹。而且,在图19及图20中,116表示作为将边界线120m及122m之间的中间点连结的线即角部呈圆弧状的线而设定的暂定的目标轨迹。
在步骤365中,判别分岔点处的行驶任务是否为U字形转弯。并且,在作出了否定判别时,在步骤370中,在车辆进入到特定的区域的阶段中止轨迹控制,在作出了肯定判别时,控制前进至步骤375。
在步骤375中,在地图上,各行驶路的白线等延长到特定的区域,由此来设定分岔点处的U字形转弯的可行驶范围。
例如,图21是表示在分岔点为正交的十字路的情况下设定U字形转弯的可行驶范围的要领的说明图。
在图21中,当前车辆12行驶的道路的全部的白线102及104作为假想的白线102D及104D而延长到特定的区域110。而且,与当前车辆12行驶的道路交叉的道路的中央的白线102及近前侧的路肩的白线104分别作为假想的白线102E及104E而延长到特定的区域110。另外,在图21中,102F及104F分别表示假想的白线102D及104D与假想的白线102E及104E的交点。而且,104G及104H分别表示相向车道侧的假想的白线104D与假想的白线102E及104E的交点。
另外,将假想的白线的交点104F、102F、104G、104H连结的线124及104D被设定为用于设定可行驶范围的转弯外侧的假想的白线。而且,转弯外侧的假想的白线向转弯内侧移动了与白线102和白线104的间隔实质上相同的距离所得到的线可以设定为转弯内侧的假想的白线,但也可以不设定该假想的白线。
另外,在从假想的白线104D、124、104D向转弯内侧位移了预先设定的余量的位置处设定U字形转弯的可行驶范围的边界线124m。U字形转弯的可行驶范围是能够从边界线124m在转弯内侧行驶的范围。
另外,以上的U字形转弯的可行驶范围的设定并不局限于分岔点为正交的十字路的情况,例如如图22所示,在分岔点为未正交的十字路的情况下也同样。但是,在这种情况下,车辆的可行驶范围的形状成为与分岔点为正交的十字路的情况不同的形状。
另外,在分岔点为T字路的情况下,与在图21中朝向侧或左转弯侧或右转弯侧的行驶路不存在的情况相同。同样,在分岔点为Y字路的情况下,与在图22中朝向侧或右转弯侧的行驶路不存在的情况实质上相同。此外,在车道为多个的情况下,也与车道为一个车道的情况同样地设定车辆的可行驶范围。但是,在这种情况下,与车辆在十字路上进行右转弯的情况同样,也设定转弯内侧的可行驶范围的边界线。
在步骤380中,暂定的目标轨迹被设定为与U字形转弯的可行驶范围的边界线124m相比通过转弯内侧的线。在图21及图22中,116表示作为与边界线124m相比通过转弯内侧的实质上圆弧状的线、或沿着边界线124m的线即角部呈圆弧状的线而设定的暂定的目标轨迹。
<基于拍摄信息的暂定的目标轨迹的设定>
接着,参照图5所示的流程图,说明上述的步骤400的基于拍摄信息的暂定的目标轨迹的设定。
首先,在步骤410中,基于由CCD相机68取得的车辆12的前方的图像信息来生成车辆的前方的分岔点的地图,并确定地图上的本车的当前地。另外,分岔点的地图基于在从通常的轨迹控制向暂定的轨迹控制的过渡开始的时刻由CCD相机68取得的图像信息来生成,但之后可以基于由CCD相机68取得的图像信息依次校正。
图23示出车辆12在正交的十字路的近前行驶时由CCD相机68拍摄的范围的边界112及通过拍摄而识别的十字路的范围126。在图23所示的十字路的情况下,首先对于范围126生成十字路的地图,并且确定地图上的本车的当前地。
另外,图24及图25分别表示在生成地图之后车辆12在正交的十字路上直行的情况及进行右转弯的情况。在这些图中,126F及126N分别表示在过渡的轨迹控制开始的时刻及当前时刻通过拍摄而识别的十字路的范围。在这些图中,范围126F及126N相互重叠的区域是以使地图的精度提高的方式根据需要而校正地图的信息的区域。而且,仅范围126N的区域是以使地图的范围扩大的方式根据需要而追加地图的信息的区域。
在步骤415中,基于在步骤410中生成的地图的白线等,对于特定的区域的周围的全部的道路,提取白线等之间的区域,由此提取车辆能够通行的区域作为行进路。
图26表示所生成的正交的十字路的地图128。在步骤415中,在地图128中,将当前车辆12行驶的行驶路排除,对于特定的区域110的周围的全部的道路,提取白线102与104之间的全部的区域作为行进路130。
在步骤420中,基于由CCD相机68取得的图像信息中包含的道路标识、道路标志,在步骤415中,确定提取出的行进路中的可选择的行进路。在这种情况下使用的道路标识、道路标志例如“仅可以直行及左转弯”、“禁止右转弯”、“禁止U字形转弯”、“禁止驶入”、“禁止车辆的通行”那样,表示车辆是否能够行进。而且,也可以使用当本车欲行进时道路标识、道路标志的上下看起来颠倒的行进路、即进行逆向行驶的行进路的道路标识、道路标志。
图27表示由于存在“仅可以直行及左转弯”或“禁止右转弯”及“禁止U字形转弯”的道路标识、道路标志而将图26所示的行进路130中的可选择的行进路确定为直行的行进路130A及左转弯的行进路130B的状况。另外,在图27及后述的图28中,×表示不可选择的行进路。
在步骤425中,判别是否确定了应行进的一条行进路,即,判别在步骤420中行进路是否被确定为一条。并且,在作出了肯定判别时,控制前进至步骤455,在作出了否定判别时,控制前进至步骤430。
在步骤430中,推定车辆在步骤420中确定出的各行进路上行驶的情况下的行驶轨迹的曲率、前轮的转向角、车辆的横向加速度、车辆的横摆率的大小的变化,并判定任一个的最大值是否超过基准值(正值)。并且,将上述判定用参数的任一个的大小的最大值未超过基准值的行进路判定为可行进的行进路。
图28表示在图27所示的十字路上车辆12分别在直行的行进路130A及左转弯的行进路130B上行驶的情况下的暂定的目标轨迹132A及132B。并且,推定车辆12分别沿着暂定的目标轨迹132A及132B行驶的情况下的上述判定用参数的绝对值的变化。图29的实线及虚线分别表示车辆12分别沿着暂定的目标轨迹132A及132B行驶的情况下的上述判定用参数的绝对值的变化的例子。
如图29所示,在车辆12沿着暂定的目标轨迹132A行驶的情况下,判定用参数的绝对值为基准值以下,而在车辆12沿着暂定的目标轨迹132B行驶的情况下,判定用参数的绝对值超过基准值。在这种情况下,将直行的行进路130A判定为可行进的行进路,而将左转弯的行进路130B判定为不可行进的行进路。
另外,判定用参数可以是行驶轨迹的曲率、前轮的转向角、车辆的横向加速度、车辆的横摆率中的一个或任意的组合。而且,基准值对于各判定用参数可以是固定值,但也可以例如如图30所示,以车速V越高则基准值越小的方式根据车速V进行可变设定。
在步骤435中,判别是否判定出应行进的一条行进路,即判别在步骤430中行进路是否被判定为一条。并且,在作出了肯定判别时,控制前进至步骤455,在作出了否定判别时,控制前进至步骤440。
在步骤440中,基于与行进路相关的乘员的意图表示和/或车辆在特定的区域行驶时的行驶状态的变化,从可选择的多个行进路中推定出应行进的一条行进路。
首先,判定与行进路相关的乘员的意图表示是否存在。例如,若方向指示灯被操作,则将方向指示灯被操作的一侧的行进路推定为应行进的一条行进路。而且,在由驾驶员将方向盘向右转弯方向或左转弯方向进行转向时,将该转向的一侧的行进路推定为应行进的一条行进路。而且,在检测出“左”、“直行”、“右”那样表示乘员希望的行进路的声音时,将检测出的方向的行进路推定为应行进的一条行进路。
另外,在判定为乘员没有与行进路相关的意图表示时,推定车辆在特定的区域行驶时产生的车辆的行驶状态的变化,将该变化最少的行进路推定为应行进的一条行进路。在这种情况下,所判定的行驶状态可以是例如车辆的行驶轨迹的曲率、左右前轮的转向角、车辆的横摆率、横向加速度那样的转弯状态量。另外,在行驶状态的变化没有差别的情况下,将直行或接近于直行的行进路推定为应行进的一条行进路。
在步骤445中,判别是否推定出应行进的一条行进路,即判别在步骤440中行进路是否被推定为一条。并且,在作出了肯定判别时,控制前进至步骤455,在作出了否定判别时,在步骤450中,与步骤310的情况同样在车辆进入到特定的区域的阶段中止轨迹控制。
在步骤455中,基于在步骤420、430或440中决定的应行进的一条行进路,来设定用于使车辆沿着该行进路行驶的暂定的目标轨迹。另外,暂定的目标轨迹的设定自身可以通过与基于上述的导航信息的暂定的目标轨迹的设定相同的要领来进行。
<从通常的轨迹控制向暂定的轨迹控制的过渡的目标轨迹的设定>
接着,参照图6所示的流程图,说明在图3所示的流程图的步骤600中执行的从通常的轨迹控制向暂定的轨迹控制的过渡的目标轨迹的设定。
首先,在步骤610中,判别过渡的目标轨迹是否已经被设定,在作出了肯定判别时,控制前进至步骤910,在作出了否定判别时,控制前进至步骤620。
在步骤620中,推定地图上的本车的当前地及行进方向,并基于本车的当前地及行进方向,在地图上设定从通常的轨迹控制向暂定的轨迹控制的过渡用的坐标系。
图31作为例示而示出在车辆临近正交的十字路时设定的坐标系。如图30所示,以使原点位于车辆12的当前地例如车辆的重心G、将x轴调整成车辆的车宽方向(右方向为正)、并将y轴调整成车辆的前后方向(行进方向为正)的方式设定坐标系。
在步骤630中,计算通常的目标轨迹的终端的位置(在步骤620中设定的坐标系的坐标(Xtne,Ytne))及终端的通常的目标轨迹的倾斜角角度(相对于y轴方向的角度αtne)。
在步骤640中,计算暂定的目标轨迹的始端的位置(在步骤620中设定的坐标系的坐标(Xtps,Ytps))及始端的暂定的目标轨迹的倾斜角(相对于y轴方向的角度αtps)。
在步骤650中,通过对通常的目标轨迹进行校正来设定用于将通常的目标轨迹与暂定的目标轨迹平滑地连接的过渡的目标轨迹。在这种情况下,过渡的目标轨迹可以基于例如坐标(Xtne,Ytne)及(Xtps,Ytps)、角度αtne及αtps、从车辆12的当前地到暂定的目标轨迹控制开始的位置为止的距离或行驶该距离所需的时间来设定。
图32示出暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标及角度αtne及αtps相同但是x坐标Xtne及Xtps互不相同的情况下的过渡的目标轨迹的一例。在这种情况下,如图32所示,以使通常的目标轨迹134的终端134E的x坐标Xtne与暂定的目标轨迹116的始端116S的x坐标Xtps一致的方式,通过校正通常的目标轨迹134来设定过渡的目标轨迹136。
另外,图33示出暂定的目标轨迹的终端及通常的目标轨迹的始端的x坐标及y坐标相同但是角度αtne及αtps互不相同的情况下的过渡的目标轨迹的一例。在这种情况下,如图33所示,以使终端134E的通常的目标轨迹134的倾斜角与始端116S的暂定的目标轨迹116的倾斜角一致的方式,通过校正通常的目标轨迹134来设定过渡的目标轨迹136。
图34示出暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标相同但是x坐标Xtne、Xtp及角度αtne、αtps分别互不相同的情况下的过渡的目标轨迹的一例。在这种情况下,如图34所示,以使终端134E的通常的目标轨迹134的x坐标及倾斜角与始端116S的暂定的目标轨迹116的x坐标及倾斜角分别一致的方式,来设定过渡的目标轨迹136。而且,即使在分岔点为正交的十字路以外的分岔点的情况下,也同样地设定过渡的目标轨迹136。
另外,虽然在图中未示出,但是除了图32至图34所示的状况之外,在通常的目标轨迹134的终端134E的y坐标Ytne与暂定的目标轨迹116的始端116S的y坐标Ytp不同的情况下,以使它们也一致的方式设定过渡的目标轨迹136。
<从暂定的轨迹控制向通常的轨迹控制的过渡的目标轨迹的设定>
接着,参照图7所示的流程图,说明在图3所示的流程图的步骤800中执行的从暂定的轨迹控制向通常的轨迹控制的过渡的目标轨迹的设定。
首先,在步骤810中,判别过渡的目标轨迹是否已经被设定,在作出了肯定判别时,控制前进至步骤910,在作出了否定判别时,控制前进至步骤820。
在步骤820中,推定地图上的本车的当前地及行进方向,并基于本车的当前地及行进方向,在地图上设定从暂定的轨迹控制向通常的轨迹控制的过渡用的坐标系。
图35作为例示而示出在车辆通过正交的十字路时设定的坐标系。如图35所示,与车辆临近正交的十字路的情况同样,以使原点位于车辆12的当前地例如车辆的重心、将x轴调整成车辆的车宽方向(右方向为正)整合、并将y轴调整成车辆的前后方向(行进方向为正)的方式设定坐标系。
在步骤830中,计算暂定的目标轨迹的终端的位置(在步骤820中设定的坐标系的坐标(Xtpe,Ytpe))及终端的暂定的目标轨迹的倾斜角(相对于y轴方向的角度αtpe)。
在步骤840中,计算通常的目标轨迹的始端的位置(在步骤820中设定的坐标系的坐标(Xtns,Ytns))及始端的通常的目标轨迹的倾斜角角度(相对于y轴方向的角度αtns)。
在步骤850中,通过校正通常的目标轨迹来设定用于将暂定的目标轨迹与通常的目标轨迹平滑地连接的过渡的目标轨迹。在这种情况下,过渡的目标轨迹可以基于例如坐标(Xtpe,Ytpe)及(Xtns,Ytns)、角度αtpe及αtns、预先设定的过渡的时间或过渡的距离来设定。另外,过渡的时间或过渡的距离可以固定,但也可以根据车速V进行可变设定。
图36示出暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标及角度αtpe及αtns相同但是x坐标Xtpe及Xtns互不相同的情况下的过渡的目标轨迹的一例。在这种情况下,通过将通常的目标轨迹134如图36所示那样校正来设定过渡的目标轨迹136。即,过渡的目标轨迹136以其始端的x坐标与暂定的目标轨迹116的终端116E的x坐标Xtpe一致、且过渡的目标轨迹136逐渐接近于通常的目标轨迹134而最终使两者的轨迹一致的方式被设定。
另外,图37示出暂定的目标轨迹的终端及通常的目标轨迹的始端的x坐标及y坐标相同但是角度αtne及αtps互不相同的情况下的过渡的目标轨迹的一例。在这种情况下,通过将通常的目标轨迹134如图37所示那样校正来设定过渡的目标轨迹136。即,过渡的目标轨迹136以使其始端的角度与暂定的目标轨迹116的终端116E的角度一致、且过渡的目标轨迹136的方向逐渐接近于通常的目标轨迹134的方向而最终使两者的轨迹一致的方式被设定。
图38示出暂定的目标轨迹的终端及通常的目标轨迹的始端的y坐标相同但是x坐标Xtne、Xtp及角度αtne、αtps分别互不相同的情况下的过渡的目标轨迹的一例。在这种情况下,通过将通常的目标轨迹134如图38所示那样校正来设定过渡的目标轨迹136。即,过渡的目标轨迹136以使其始端的角度与暂定的目标轨迹116的终端116E的角度一致、且过渡的目标轨迹136逐渐接近于通常的目标轨迹134而最终使两者的轨迹一致的方式被设定。
另外,虽然在图中未示出,但是除了图36至图38所示的状况之外,在暂定的目标轨迹116的始端116S的y坐标Ytps与通常的目标轨迹134的终端134E的y坐标Ytne不同的情况下,以使它们也一致的方式设定过渡的目标轨迹136。而且,即使在分岔点为正交的十字路以外的分岔点的情况下,也同样地设定过渡的目标轨迹136。
<伴随着转弯的暂定的目标轨迹的设定>
(1)车身的最小转弯半径及最大转弯半径
在上述的步骤345、360、380、455中,设定伴随着转弯的暂定的目标轨迹。在这些步骤中,暂定的目标轨迹优选设为通过可行驶范围内的轨迹中的、车辆的转弯横向加速度的大小及其变化率的大小的至少一方最小的轨迹。
另外,正如周知那样,在车辆进行转弯的情况下,产生转弯半径的内轮差及外轮差。转弯半径的内轮差及外轮差如车辆在交叉口等处进行转弯的情况那样,随着车辆的转弯半径变小而变大,伴随着转弯的暂定的目标轨迹需要考虑内轮差及外轮差来设定。
如图39所示,将车辆12的重心G与前轮车轴及后轮车轴之间的距离分别设为Lf及Lr,将车辆的轴距设为L(=Lf+Lr)。而且,将前轮及后轮的轮距分别设为Trf及Trr,将车身的宽度设为BW,将车身的前悬臂长度设为Lovf。而且,将在方向盘20进行最大限度转向的状态下车辆进行转弯时转弯外侧前轮的轮胎的胎面中心描绘的轨迹的半径Rfo定义为最小旋转半径Rmin。
另外,如图39所示,将通过后轮车轴的中心Or和车辆12的转弯中心Ov的直线设为基准线Lb,将通过车辆12的重心G和转弯中心Ov的直线Lg相对于基准线Lb所成的角度设为αg。车辆12的重心G的转弯半径Rg由下述的式1表示。
Rg=Lr/sinαg…(1)
另外,当将通过前轮车轴的中心Of和车辆12的转弯中心Ov的直线相对于基准线Lb所成的角度设为αf时,前轮车轴的中心Of的转弯半径Rfc及后轮车轴的中心Or的转弯半径Rrc分别由下述的式2及3表示。
Rfc=L/sinαf…(2)
Rrc=L/tanαf…(3)
转弯外侧前轮的转弯半径Rfo及转弯内侧前轮的转弯半径Rfi分别由下述的式4及5表示,转弯外侧后轮的转弯半径Rro及转弯内侧后轮的Rri分别由下述的式6及7表示。
Rfo=Rfc+Trf/2*cosαf…(4)
Rfi=Rfc-Trf/2*cosαf…(5)
Rro=Rrc+Trr/2…(6)
Rri=Rrc-Trr/2…(7)
车辆12的车身的各部中的转弯半径最小的是基准线Lb与车身的外形线交叉的点Pin,车身的最小转弯半径Rbi、即点Pin描绘的转弯轨迹的半径由下述的式8表示。
Rbi=Rrc-BW/2…(8)
另外,车辆12的车身的各部中的转弯半径最大的是车身的转弯外侧的前端角部的点Pout,点Pout与前轮车轴的中心Of之间的距离Lout由下述的式9表示。由此,车身的最大转弯半径Rbo、即点Pout描绘的转弯轨迹的半径实质上成为由下述的式10表示的值。
Lout={(BW/2)2+Lof2}1/2…(9)
Rbo=Rfc+Lout…(10)
另外,根据车辆12的重心G、前轮车轴的中心Of、后轮车轴的中心Or、车辆12的转弯中心Ov之间的距离的关系,下述的式11成立,因此角度αg由下述的式12表示。
tanαg=Lr/Rrc
=Lr/(L/tanαf)
=(Lr/L)*tanαf…(11)
αf=tan-1{tanαg/(Lr/L)}…(12)
根据上述式3及8,车身的最小转弯半径Rbi由下述的式13表示,根据上述式2及10,车身的最大转弯半径Rbo由下述的式14表示。但是,角度αg由下述的式15表示。
Rbi=Rrc-BW/2
=L/tanαf-BW/2
=L/tan[tan-1{tanαg/(Lr/L)}]-BW/2
=L/tanαg/(Lr/L)-BW/2
=(L2/Lr)tanαg-BW/2…(13)
Rbo=Rfc+Lout
=L/sinαf+{(BW/2)2+Lof2}1/2
=L/[sin{tan-1(tanαg/(Lr/L))}]+{(BW/2)2+Lof2}1/2
=L/[sin{tan-1(tanαg/(Lr/L))}]+{(BW/2)2+Rfc2}1/2
…(14)
αg=sin-1(Lr/Rg)…(15)
从以上的说明可知,若求出车辆12的重心G的转弯半径Rg,换言之,若求出重心G的目标轨迹的半径R,则按照上述式13及14,能够求出车身的最小转弯半径Rbi及车身的最大转弯半径Rbo。
(2)考虑了车身的转弯半径的暂定的目标轨迹的设定
将特定的区域110划分为多个区间,暂定的目标轨迹被设定为将各区间的可行驶范围的转弯内侧的边界线及转弯外侧的边界线之间的中间点连结的线、即角部呈圆弧状的线。在这种情况下,各区间的暂定的目标轨迹优选使用回旋曲线来设定,以使前轮的转向角的增减变化少,并能够确保车辆的良好的乘坐舒适性。
接着,对于各区间的暂定的目标轨迹求出各位置的半径R,按照上述式13及14,求出车身的最小转弯半径Rbi及车身的最大转弯半径Rbo,由此对于各区间求出车身的最小转弯轨迹及最大转弯轨迹。并且,在车身的最小转弯轨迹或最大转弯轨迹未处于可行驶范围内的情况下,以使最小转弯轨迹及最大转弯轨迹处于可行驶范围内的方式校正暂定的目标轨迹。
例如,图40表示在车辆在正交的十字路上进行左转弯的情况下将特定的区域110划分为两个区间的要领及求出车身的最小转弯轨迹及最大转弯轨迹的要领。在图40中,以十字路的角的位置为边界,将特定的区域110划分为最初的区间110A和接下来的区间110B。并且,140Ain及140Aout分别表示最初的区间110A的车身的最小转弯轨迹及最大转弯轨迹,140Bin及140Bout分别表示接下来的区间110B的车身的最小转弯轨迹及最大转弯轨迹。
图41(A)作为一例而表示车身的最小转弯轨迹未处于可行驶范围内的情况。在这种情况下,如图41(B)所示,最初的区间110A的暂定的目标轨迹的起点及接下来的区间110B的暂定的目标轨迹的终点向接近十字路的中心的位置移动,然后再次执行考虑了上述的车身的转弯半径的暂定的目标轨迹的设定。
另外,图42(A)表示即使暂定的目标轨迹的起点及终点向接近交叉口的中心的位置移动但车身的最小转弯轨迹也未移动到可行驶范围内的情况。在这种情况下,如图42(B)所示,最初的区间110A的暂定的目标轨迹的起点及接下来的区间110B的暂定的目标轨迹的终点向转弯外侧的位置移动,然后再次执行考虑了上述的车身的转弯半径的暂定的目标轨迹的设定。
在即使通过图42所示的处理而车身的最小转弯轨迹也未移动到可行驶范围内的情况下,以使车身的最小转弯轨迹移动到可行驶范围内的方式,将暂定的目标轨迹设定为圆弧的轨迹,或将特定的区域110划分成三个以上的区间。
另外,虽然图中未示出,但是在车身的最大转弯轨迹未处于可行驶范围内的情况下,最初的区间110A的暂定的目标轨迹的起点及接下来的区间110B的暂定的目标轨迹的终点向远离十字路的中心的位置移动。而且,在即使通过该移动而车身的最大转弯轨迹也未移动到可行驶范围内的情况下,使起点及终点向转弯内侧的位置移动。
<本车的当前地的推定>
接着,说明在上述的步骤910中执行的“本车的当前地的推定”。另外,通常的轨迹控制在识别了本车的当前地的状态下进行,因此本车的当前地的推定在暂定的轨迹控制及过渡的轨迹控制中进行。
当将前轮的转向角(将转向角θ除以总转向传动比所得到的值)设为δ时,车辆的横摆率γ及滑移角β分别由下述的式16及17表示。另外,车速V是由车速传感器70检测出的值,但也可以作为四轮的车轮速度的平均值而求出。而且,横摆率γ可以是由横摆率传感器74检测出的值。
γ=V/L*δ…(16)
β=Lr/L*δ…(17)
车辆的重心G的x坐标及y坐标的变化率dX/dt及dY/dt分别由下述的式18及19表示。由此,将车辆的当前地、即重心G的坐标(X,Y)推定为由下述的式20及21表示的值。另外,车辆的横摆角(参照图43)由下述的式22表示。
[数学式1]
X = V &Integral; 0 t cos ( &beta; + &phi; ) dt . . . ( 20 )
Y = V &Integral; 0 t sin ( &beta; + &phi; ) dt . . . ( 21 )
&phi; = &Integral; 0 t &gamma;dt . . . ( 22 )
另外,在控制开始时的车辆的重心G的位置不是坐标的原点的情况下,将控制开始时的车辆的重心G的坐标设为(X0,Y0),将车辆的横摆角设为车辆的当前地即重心G的坐标(X,Y)由下述的式23及24表示,车辆的横摆角由下述的式25表示。
[数学式2]
X = X 0 + V &Integral; 0 t cos ( &beta; + &phi; ) dt . . . ( 23 )
Y = Y 0 + V &Integral; 0 t sin ( &beta; + &phi; ) dt . . . ( 24 )
&phi; = &phi; 0 + &Integral; 0 t &gamma;dt . . . ( 25 )
<暂定或过渡的轨迹控制>
(1)目标轨迹的半径R等的推定
首先,如图43所示,推定车辆12的重心G的目标轨迹150、即暂定的目标轨迹或过渡的目标轨迹的半径R。而且,推定车辆12的重心G相对于目标轨迹150的横向偏差Dy,并推定车辆12相对于目标轨迹150的横摆角
(2)车辆的目标横向加速度Gyt的运算
首先,计算车辆的目标横摆角ψt作为与目标轨迹的半径R的符号相同且随着半径R的大小增大而增大的微小的值。并且,使用预先设定有Kr、Ky、Kp的增益,按照下述的式26来计算用于使车辆沿着目标轨迹行驶的车辆的目标横向加速度Gyt。另外,在下述的式26中,Dyt是横向偏差Dy的目标值,可以是0。
Gyt=Kr×R+Ky(Dyt-Dy)+Kp(ψt-ψ)…(26)
(3)目标转向角δt的运算及前轮的转向角的控制
基于车辆的目标横向加速度Gyt及车速V,根据图44所示的映射来计算暂定或过渡的轨迹控制用的左右前轮的目标转向角δt。并且,计算与目标转向角δt对应的小齿轮36的目标角度θpt,以使小齿轮36的角度成为目标角度θpt的方式控制转向角可变装置30,由此将前轮的转向角控制成目标转向角δt。在这种情况下,基于目标转向角δt,通过反馈控制及前馈控制中的至少一方来控制前轮的转向角。
<驾驶员协调控制>
接着,说明在上述的步骤950中作为驾驶员协调控制而执行的“目标轨迹校正控制”及“分岔点任务变更控制”。
(1)“目标轨迹校正控制”
例如,将暂定的轨迹控制开始时的转向角θ设为基准转向角θ0,计算暂定的轨迹控制中的转向角θ与基准转向角θ0之差作为驾驶员的转向操作量Δθ。并且,判别转向操作量Δθ的绝对值比第一基准值Δθ1大且比第二基准值Δθ2小的状况是否持续了基准时间Td1以上。在作出了否定判别时,不校正暂定的目标轨迹,但是在作出了肯定判别时,将暂定的目标轨迹向反映驾驶员的转向操作的一侧校正。另外,基准值Δθ1及Δθ2是正值,Δθ2大于Δθ1。而且基准时间Td1也是正值。
例如,图45是表示暂定的目标轨迹为在正交的十字路上进行左转弯的轨迹且由驾驶员减少左转弯方向的转向角的情况下的暂定的目标轨迹的校正的说明图。在图45中,116表示原始的暂定的目标轨迹,116A表示校正后的暂定的目标轨迹。通过两个暂定的目标轨迹的比较可知,将暂定的目标轨迹向反映驾驶员的转向操作的一侧校正。
另外,当车辆想要沿着校正后的暂定的目标轨迹行驶时,在判定为由于车辆与障碍物接触等而使车辆无法沿着校正后的暂定的目标轨迹行驶的情况下,不进行暂定的目标轨迹的校正而中止暂定的轨迹控制。
(2)“分岔点任务变更控制”
例如,判别转向操作量Δθ的绝对值比第三基准值Δθ3大且比第四的基准值Δθ4小的状况是否持续了基准时间Td2以上。在作出了否定判别时,不变更分岔点处的任务,但是在作出了肯定判别时,将分岔点处的任务变更为反映驾驶员的转向操作的任务。另外,基准值Δθ3及Δθ4是Δθ2以上的正值,Δθ4大于Δθ3。而且基准时间Td2也是正值。
例如,图46是表示分岔点处的任务为在正交的十字路上进行左转弯且通过驾驶员以使车辆直行的方式变更转向角θ的情况下的分岔点处的任务的变更的说明图。在图46中,116表示原始的暂定的目标轨迹,116B表示以使分岔点处的任务成为直行的方式进行校正后的暂定的目标轨迹。通过两个暂定的目标轨迹的比较可知,以能够实现驾驶员所希望的任务的方式校正暂定的目标轨迹。
另外,即使在这种情况下车辆想要沿着校正后的暂定的目标轨迹行驶时,在判定为脱离所设定的余量或车辆无法沿校正后的暂定的目标轨迹行驶的情况下,不变更暂定的目标轨迹,而中止暂定的轨迹控制。
另外,在暂定的目标轨迹为直行、右转弯、U字形转弯的情况下,当通过驾驶员将转向角向左转弯方向变更时,暂定的目标轨迹分别被变更为左转弯、直行、右转弯的暂定的目标轨迹。而且,在暂定的目标轨迹为左转弯、直行、右转弯的情况下,当通过驾驶员将转向角向右转弯方向变更时,暂定的目标轨迹分别被变更为直行、右转弯、U字形转弯的暂定的目标轨迹。
<第一实施方式的工作>
接着,关于车辆的各种行驶状况来说明如上述那样构成的第一实施方式的工作。
(1)车辆在没有分岔点的道路上行驶的情况
在这种情况下不需要暂定的轨迹控制,因此以使车辆沿着通常的目标轨迹行驶的方式执行通常的轨迹控制。即,在步骤10及30中作出肯定判别,在步骤70中设定通常的目标轨迹。而且,在步骤90、130及150中作出否定判别,在步骤170中将标志Fnp及Fpn重置为0,在步骤190中以使车辆沿着通常的目标轨迹行驶的方式执行通常的轨迹控制。
(2)车辆临近分岔点的情况
(2-1)许可开关78接通的情况
在这种情况下,执行用于从通常的轨迹控制向暂定的轨迹控制进行过渡的过渡的轨迹控制。即,在步骤10及30中作出肯定判别,在步骤70中设定通常的目标轨迹。而且,在步骤90及130中作出否定判别,但是在步骤150中作出肯定判别,在步骤160中将标志Fnp设置为1,并将标志Fpn重置为0。并且,在步骤210中作出肯定判别,但是在步骤250中作出否定判别。
在导航装置80处于工作中且能够进行基于导航信息的暂定的轨迹控制的情况下,在步骤270及290中作出肯定判别。由此,在步骤300中按照图4所示的流程图,基于导航信息来设定暂定的目标轨迹。
相对于此,在导航装置80不处于工作中的情况下,在步骤270中作出否定判别。而且,在虽然导航装置80处于工作中但是无法进行基于导航信息的暂定的轨迹控制的情况下,在步骤270中作出肯定判别,但是在步骤290中作出否定判别。由此,在上述情况下,在步骤400中按照图5所示的流程图,基于由CCD相机68取得的拍摄信息来设定暂定的目标轨迹。
另外,由于将标志Fnp设置为1,因此在步骤510中作出肯定判别,在步骤600中,按照图6所示的流程图来设定从通常的轨迹控制向暂定的轨迹控制的过渡的目标轨迹。并且,在步骤910中,推定本车的当前地,在步骤930中,以使车辆沿着过渡的目标轨迹行驶的方式执行过渡的轨迹控制。
(2-2)许可开关78断开的情况
在这种情况下,不执行从通常的轨迹控制向暂定的轨迹控制进行过渡用的过渡的轨迹控制。即,在步骤10及30中作出肯定判别,在步骤70中设定通常的目标轨迹。而且,在步骤90及130中作出否定判别,在步骤150中作出肯定判别,在步骤160中将标志Fnp设置为1,并将标志Fpn重置为0。并且,虽然在步骤210中作出否定判别,但是由于标志Fnp为1,因此在车辆即将开始分岔点处的行驶之前,不进行过渡的轨迹控制而继续进行步骤190的通常的轨迹控制。
(3)车辆在特定的区域行驶的情况
(3-1)许可开关78接通的情况
在这种情况下,由于是完成了从通常的轨迹控制向暂定的轨迹控制的过渡之后,因此执行暂定的轨迹控制。即,在步骤10中作出肯定判别,但是在步骤30中作出否定判别,在步骤50中将标志Fnp及Fpn重置为0。
并且,在步骤210及250中作出肯定判别,在步骤510及710中作出否定判别。并且,在步骤910中推定本车的当前地,在步骤930中以使车辆沿着暂定的目标轨迹行驶的方式执行暂定的轨迹控制。
(3-2)许可开关78断开的情况
在这种情况下不执行暂定的轨迹控制。即,与(3-1)的情况同样,在步骤10中作出肯定判别,但是在步骤30中作出否定判别,在步骤50中将标志Fnp及Fpn重置为0。
然而,由于许可开关78断开,因此在步骤210中作出否定判别。并且,标志Fnp为0,在步骤230中,中止轨迹控制并维持其状态,因此车辆在特定的区域行驶期间既不进行暂定的轨迹控制,也不进行通常的轨迹控制。
(4)车辆结束特定的区域的行驶的情况
(4-1)许可开关78接通的情况
在这种情况下,需要从暂定的轨迹控制向通常的轨迹控制的过渡,因此执行从暂定的轨迹控制向通常的轨迹控制的过渡的轨迹控制。即,在步骤10及30中作出肯定判别,在步骤70中设定通常的目标轨迹。而且,在步骤90中作出肯定判别,在步骤110中将标志Fnp重置为0,并将标志Fpn设置为1。
另外,在步骤210及250中作出肯定判别,在步骤510中作出否定判别,但是在步骤710中作出肯定判别。由此,在步骤800中,按照图7所示的流程图来设定从暂定的轨迹控制向通常的轨迹控制的过渡的目标轨迹。
当设定过渡的目标轨迹时,在步骤90中作出否定判别,并且在步骤130中作出肯定判别。并且,在步骤910中推定本车的当前地,在步骤930中以使车辆沿着过渡的目标轨迹行驶的方式执行过渡的轨迹控制。
另外,当过渡的轨迹控制完成时,即,当沿着过渡的目标轨迹的行驶完成时,在步骤90、130及150中进行否定判别。由此,在步骤170中将标志Fnp及Fpn重置为0,在步骤190中以使车辆沿着通常的目标轨迹行驶的方式执行通常的轨迹控制。
(4-2)许可开关78断开的情况
在这种情况下由于不执行暂定的轨迹控制,因此也不执行过渡的轨迹控制。由此,当能够进行通常的轨迹控制时,进行与上述(1)的情况同样的控制。即,在步骤10及30中作出肯定判别,在步骤70中设定通常的目标轨迹。而且,在步骤90、130及150中作出否定判别,在步骤170中将标志Fnp及Fpn重置为0,在步骤190中以使车辆沿着通常的目标轨迹行驶的方式执行通常的轨迹控制。
[第二实施方式]
图8是表示适用于导航装置搭载车且以不进行基于拍摄信息的暂定的轨迹控制的方式构成的本发明的车辆的行驶控制装置的第二实施方式的行驶轨迹控制例程的后半部分的通常流程图。另外,在图8中,对于与图3所示的步骤相同的步骤,标注与在图3中标注的步骤编号相同的步骤编号。这种情况对于后述的图9也同样。
从图8与图3的比较可知,在该第二实施方式中,不执行步骤400,在步骤270或290中作出了否定判别时,控制前进至步骤230。即,不进行基于拍摄信息的暂定的轨迹控制而轨迹控制暂时结束,控制返回到步骤10。但是,在标志Fnp为1时,在标志Fnp成为0之前控制前进至步骤190,继续进行通常的轨迹控制。
第二实施方式的其他步骤与上述的第一实施方式相同。由此,第二实施方式除了上述的“(2-1)许可开关78接通的情况”及“(3-1)许可开关78接通的情况”之外,与上述的第一实施方式同样地工作。
在第二实施方式中,在导航装置80不处于工作中的情况下,在步骤270中作出否定判别。而且,在导航装置80处于工作中但是不能进行基于导航信息的暂定的轨迹控制的情况下,在步骤270中作出肯定判别,但是在步骤290中作出否定判别。由此,在上述的情况下,不执行步骤400,不进行基于由CCD相机68取得的拍摄信息的暂定的目标轨迹的设定。
因此,根据第二实施方式,除了在导航装置80不处于工作中的情况下、不能进行基于导航信息的暂定的轨迹控制的情况下不进行暂定的轨迹控制这一点之外,能够得到与上述的第一实施方式同样的作用效果。
[第三实施方式]
图9是表示适用于未搭载导航装置的车辆且作为行驶轨迹控制装置而构成的本发明的车辆的行驶控制装置的第三实施方式的行驶轨迹控制例程的后半部分的通常流程图。
在该第三实施方式中,不执行步骤270、290、300,在步骤250中作出了否定判别时,即,在判别为暂定的目标轨迹还未被设定时,控制前进至步骤400。由此,按照图5所示的流程图,基于由CCD相机68取得的车辆12的前方的图像信息来设定暂定的目标轨迹。
第三实施方式的其他步骤与上述的第一实施方式相同。由此,第三实施方式除了未设定基于导航信息的暂定的目标轨迹这一点之外,与上述的第一实施方式同样地工作。
在第二实施方式中,在暂定的目标轨迹还未被设定的情况下,在步骤250中作出否定判别。由此,执行步骤400,基于由CCD相机68取得的拍摄信息来设定暂定的目标轨迹。
因此,根据第三实施方式,除了不进行基于导航信息的暂定的轨迹控制这一点之外,能够得到与上述的第一实施方式同样的作用效果。
以上详细地说明了本发明的特定的实施方式,但本发明没有限定为上述的实施方式,在本发明的范围内能够进行其他的各种实施方式的情况对于本领域技术人员来说不言自明。
例如,在上述的各实施方式中,车辆的目标轨迹为线,但也可以设定为具有宽度的目标行驶范围作为车辆可行驶的区域,并以使车辆在该范围内行驶的方式进行控制。
另外,在上述的各实施方式的说明中,虽然在特定的区域不存在行驶路特定对象,但也可以是分岔点包含优先道路且存在表示优先道路的白线等部分的行驶路特定对象。在这种情况下,可以使用部分的行驶路特定对象作为用于设定暂定的目标轨迹的暂定的行驶路特定对象。
另外,在上述的各实施方式中,在车辆驶入特定的区域之前,行驶轨迹控制从通常的轨迹控制向暂定的轨迹控制逐渐过渡,而且在车辆完成了特定的区域的行驶之后,行驶轨迹控制从暂定的轨迹控制向通常的轨迹控制逐渐过渡。然而,上述过渡的至少一方可以在特定的区域进行,而且,上述过渡的至少一方也可以在特定的区域及特定的区域外的区域这两方进行。
另外,在上述的各实施方式中,在从暂定的轨迹控制向通常的轨迹控制进行过渡时,计算通常的目标轨迹。然而,也可以校正成,在执行暂定的轨迹控制的状况下,当车辆行驶预定的距离或预定的时间时,在判定为需要从暂定的轨迹控制向通常的轨迹控制进行过渡的阶段,计算通常的目标轨迹。
另外,在上述的各实施方式中,计算用于将车辆的轨迹作为目标轨迹的转向轮的目标转向角作为前馈控制的目标转向角。然而,转向轮的目标转向角可以作为反馈控制的目标转向角而被计算,而且,也可以基于反馈控制的目标转向角及前馈控制的目标转向角而被计算作为最终的目标转向角。
另外,在上述的各实施方式中,用于将车辆的轨迹作为目标轨迹的控制是转向轮的转向角的控制。然而,用于将车辆的轨迹作为目标轨迹的控制可以是左右轮的制驱动力差的控制,也可以是转向轮的转向角的控制与左右轮的制驱动力差的控制的组合。

Claims (13)

1.一种车辆的行驶控制装置,具有:
外界信息取得单元,至少取得车辆前方的信息;及
控制单元,基于由所述外界信息取得单元取得的信息所含的行驶路特定对象来求出车辆的目标轨迹,以使车辆沿着目标轨迹行驶的方式进行行驶轨迹控制,
所述车辆的行驶控制装置的特征在于,
将行驶路被分成多个行驶路且无法基于所述行驶路特定对象求出目标轨迹的区域作为特定的区域,当车辆在特定的区域行驶时,所述控制单元基于与所述特定的区域相邻的区域的行驶路特定对象及车辆行驶过所述特定的区域之后应行驶的行驶路,对于所述特定的区域求出暂定的目标轨迹,以使车辆沿着所述暂定的目标轨迹行驶的方式进行暂定的行驶轨迹控制。
2.根据权利要求1所述的车辆的行驶控制装置,其特征在于,
在已经从所述多个行驶路中选择了车辆应行驶的行驶路时,所述控制单元基于与所述特定的区域相邻的区域的行驶路特定对象及所选择的行驶路来设定所述假想的行驶路特定对象,并基于所述假想的行驶路特定对象来求出暂定的目标轨迹。
3.根据权利要求1所述的车辆的行驶控制装置,其特征在于,
在未从所述多个行驶路中选择车辆应行驶的行驶路时,所述控制单元基于车辆的行驶状况及驾驶员的驾驶操作来推定所述多个行驶路中的车辆应行驶的行驶路,基于与所述特定的区域相邻的区域的行驶路特定对象及推定出的行驶路来设定所述假想的行驶路特定对象,并基于所述假想的行驶路特定对象来求出暂定的目标轨迹。
4.根据权利要求2或3所述的车辆的行驶控制装置,其特征在于,
所述控制单元基于所述假想的行驶路特定对象来判定所述特定的区域中的车辆的可行驶范围,基于所述行驶轨迹控制执行中的车辆的位置及所述可行驶范围来求出暂定的目标轨迹。
5.根据权利要求2或3所述的车辆的行驶控制装置,其特征在于,
所述行驶控制装置具有取得所述特定的区域的地图信息的地图信息取得单元,所述控制单元基于由所述地图信息取得单元取得的地图信息来设定所述假想的行驶路特定对象。
6.根据权利要求4所述的车辆的行驶控制装置,其特征在于,
当车辆需要在所述特定的区域转弯时,所述控制单元基于所述暂定的目标轨迹的半径来推定车身的最小转弯半径及最大转弯半径,在所述最小转弯半径或所述最大转弯半径未处于所述车辆的可行驶范围内时,以使所述最小转弯半径及所述最大转弯半径处于所述车辆的可行驶范围内的方式重新设定暂定的目标轨迹。
7.根据权利要求4所述的车辆的行驶控制装置,其特征在于,
所述控制单元将通过所述车辆的可行驶范围的轨迹中的、车辆的转弯横向加速度的大小及其变化率的大小的至少一方最小的轨迹作为暂定的目标轨迹。
8.根据权利要求4所述的车辆的行驶控制装置,其特征在于,
所述控制单元基于暂定的行驶轨迹控制开始后的驾驶员的驾驶操作,在所述车辆的可行驶范围内对所述暂定的目标轨迹进行校正。
9.根据权利要求1~8中任一项所述的车辆的行驶控制装置,其特征在于,
在暂定的行驶轨迹控制开始后的驾驶员的驾驶操作量的大小为目标轨迹变更的基准值以上的时间持续了目标轨迹变更的基准时间以上时,所述控制单元基于驾驶员的驾驶操作来变更车辆应行驶的行驶路,基于与所述特定的区域相邻的区域的行驶路特定对象及变更后的行驶路,重新求出暂定的目标轨迹。
10.根据权利要求1~9中任一项所述的车辆的行驶控制装置,其特征在于,
所述控制单元在暂定的行驶轨迹控制中,通过反馈控制及前馈控制的至少一方来计算用于使车辆的轨迹成为暂定的目标轨迹的转向轮的暂定的目标转向角,并基于所述暂定的目标转向角来控制转向轮的转向角。
11.根据权利要求1~10中任一项所述的车辆的行驶控制装置,其特征在于,
所述控制单元在车辆驶入所述特定的区域之前使行驶控制从行驶轨迹控制向暂定的行驶轨迹控制逐渐过渡。
12.根据权利要求1~11中任一项所述的车辆的行驶轨迹控制装置,其特征在于,
所述控制单元在车辆完成了所述特定的区域的行驶之后使行驶控制从暂定的行驶轨迹控制向行驶轨迹控制逐渐过渡。
13.根据权利要求1~12中任一项所述的车辆的行驶控制装置,其特征在于,
所述特定的区域是交叉口、T字路、分岔路的任一个。
CN201280074528.2A 2012-07-06 2012-07-06 车辆的行驶控制装置 Active CN104411558B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2012/067387 WO2014006759A1 (ja) 2012-07-06 2012-07-06 車両の走行制御装置

Publications (2)

Publication Number Publication Date
CN104411558A true CN104411558A (zh) 2015-03-11
CN104411558B CN104411558B (zh) 2017-09-22

Family

ID=49881546

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201280074528.2A Active CN104411558B (zh) 2012-07-06 2012-07-06 车辆的行驶控制装置

Country Status (5)

Country Link
US (1) US9399464B2 (zh)
EP (1) EP2871107B1 (zh)
JP (1) JP5924508B2 (zh)
CN (1) CN104411558B (zh)
WO (1) WO2014006759A1 (zh)

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107054361A (zh) * 2015-09-25 2017-08-18 株式会社斯巴鲁 车辆的转向控制装置
CN107628028A (zh) * 2016-07-19 2018-01-26 株式会社万都 车辆辅助驾驶装置
CN107963077A (zh) * 2017-10-26 2018-04-27 东软集团股份有限公司 一种车辆通过路口的控制方法、装置及系统
CN108068693A (zh) * 2016-11-18 2018-05-25 丰田自动车株式会社 驾驶辅助装置
CN108885108A (zh) * 2016-01-14 2018-11-23 福特全球技术公司 基于操纵难度的u形转弯辅助
CN109815558A (zh) * 2019-01-04 2019-05-28 东南大学 一种大型车辆交叉口转向席卷路径的确定方法
CN110027555A (zh) * 2018-01-12 2019-07-19 本田技研工业株式会社 行驶轨迹确定装置和自动驾驶装置
CN110494903A (zh) * 2017-03-30 2019-11-22 本田技研工业株式会社 车辆控制装置和车辆控制方法
CN110530390A (zh) * 2019-09-16 2019-12-03 哈尔滨工程大学 一种在狭窄环境下的非质点车辆路径规划方法
CN110998691A (zh) * 2017-08-02 2020-04-10 日产自动车株式会社 行驶辅助方法及行驶辅助装置
CN111174801A (zh) * 2018-11-09 2020-05-19 阿里巴巴集团控股有限公司 导航引导线的生成方法和装置以及电子设备
CN111319676A (zh) * 2018-12-17 2020-06-23 本田技研工业株式会社 行驶轨迹确定装置和自动驾驶装置
CN111532269A (zh) * 2019-02-05 2020-08-14 本田技研工业株式会社 车辆控制装置
CN112373472A (zh) * 2021-01-14 2021-02-19 长沙理工大学 一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法
CN113826153A (zh) * 2019-05-15 2021-12-21 日产自动车株式会社 车辆的行驶控制方法及行驶控制装置

Families Citing this family (37)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6119634B2 (ja) * 2014-02-21 2017-04-26 トヨタ自動車株式会社 車両の自動運転制御方法
JP6176264B2 (ja) 2015-01-19 2017-08-09 トヨタ自動車株式会社 自動運転車両システム
CN104655872B (zh) * 2015-02-13 2017-12-19 盐城工学院 汽车车速测控方法及系统
DE102015214736A1 (de) * 2015-08-03 2017-02-09 Zf Friedrichshafen Ag Verfahren zum Parametrieren von Schaltungen und Verfahren zur Durchführung von Schaltungen
US10982961B2 (en) * 2015-10-16 2021-04-20 Hitachi Automotive Systems, Ltd. Vehicle control system and vehicle control device
US10144453B2 (en) 2016-04-13 2018-12-04 Cnh Industrial America Llc System and method for controlling a vehicle
EP3254918B1 (en) * 2016-06-07 2023-05-24 Volvo Car Corporation Adaptive cruise control system and vehicle comprising an adaptive cruise control system
JP6696862B2 (ja) * 2016-08-25 2020-05-20 トヨタ自動車株式会社 自動運転システム
JP7016214B2 (ja) * 2016-11-29 2022-02-04 アルパイン株式会社 走行可能領域設定装置および走行可能領域設定方法
JP6832164B2 (ja) * 2017-01-13 2021-02-24 本田技研工業株式会社 運転補助装置及び運転補助方法
CN110446641B (zh) * 2017-03-22 2022-09-06 本田技研工业株式会社 车辆控制装置和车辆控制方法
JP6799150B2 (ja) * 2017-05-25 2020-12-09 本田技研工業株式会社 車両制御装置
JP2019144691A (ja) * 2018-02-16 2019-08-29 本田技研工業株式会社 車両制御装置
US11203353B2 (en) * 2018-03-09 2021-12-21 Mitsubishi Heavy Industries, Ltd. Steering control system, steering system, car, steering control method and recording medium
JP7070827B2 (ja) * 2018-03-12 2022-05-18 オムロン株式会社 運転評価装置、車載機、これらを備えた運転評価システム、運転評価方法、及び運転評価プログラム
JP6961536B2 (ja) * 2018-06-08 2021-11-05 日立Astemo株式会社 車載装置
EP3831679B1 (en) * 2018-08-03 2023-10-04 Nissan Motor Co., Ltd. Traveling trajectory correction method, traveling control method, and traveling trajectory correction device
JP7136043B2 (ja) * 2018-08-31 2022-09-13 株式会社デンソー 交差点内の走行軌道データ生成装置及び走行軌道データ生成プログラム
JP7014106B2 (ja) * 2018-09-04 2022-02-01 トヨタ自動車株式会社 車両制御システム
EP3887762B1 (en) * 2018-11-26 2024-05-15 Mobileye Vision Technologies Ltd. Lane mapping and navigation
JP7251294B2 (ja) * 2019-04-25 2023-04-04 株式会社アドヴィックス 車両の走行制御装置
JP7310272B2 (ja) * 2019-04-25 2023-07-19 株式会社アドヴィックス 車両の制御装置
US10915766B2 (en) * 2019-06-28 2021-02-09 Baidu Usa Llc Method for detecting closest in-path object (CIPO) for autonomous driving
JP7389605B2 (ja) * 2019-10-01 2023-11-30 日立Astemo株式会社 操舵制御装置
US11754408B2 (en) * 2019-10-09 2023-09-12 Argo AI, LLC Methods and systems for topological planning in autonomous driving
JP2020109421A (ja) * 2020-03-30 2020-07-16 アイシン・エィ・ダブリュ株式会社 推奨領域特定システム、推奨領域特定プログラム、記録媒体および推奨領域特定方法
JP7189514B2 (ja) 2020-06-02 2022-12-14 トヨタ自動車株式会社 制振制御装置及び制振制御方法
JP7183237B2 (ja) * 2020-10-23 2022-12-05 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
JP7422248B2 (ja) * 2020-11-27 2024-01-25 日産自動車株式会社 走行制御方法及び走行制御装置
JP7411593B2 (ja) * 2021-02-10 2024-01-11 本田技研工業株式会社 運転支援装置
EP4309969A4 (en) 2021-03-17 2024-06-26 Nissan Motor Co., Ltd. DRIVING CONTROL METHOD AND DRIVING CONTROL DEVICE FOR A VEHICLE
US11745726B2 (en) * 2021-06-30 2023-09-05 Zoox, Inc. Estimating angle of a vehicle wheel based on non-steering variables
US11794756B2 (en) 2021-06-30 2023-10-24 Zoox, Inc. Estimating vehicle velocity based on variables associated with wheels
US11872994B2 (en) * 2021-10-30 2024-01-16 Zoox, Inc. Estimating vehicle velocity
CN114179805B (zh) * 2021-12-10 2023-12-19 北京百度网讯科技有限公司 一种行驶方向确定方法、装置、设备以及存储介质
WO2024089810A1 (ja) * 2022-10-26 2024-05-02 本田技研工業株式会社 移動体制御システム、その制御方法、プログラム、及び移動体
CN117058280B (zh) * 2023-10-11 2023-12-19 成都古河云科技有限公司 一种三维交通车辆实时轨迹还原拟合方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006344133A (ja) * 2005-06-10 2006-12-21 Toyota Motor Corp 道路区画線検出装置
JP2007313978A (ja) * 2006-05-24 2007-12-06 Toyota Motor Corp 運転支援装置
CN101246010A (zh) * 2007-02-13 2008-08-20 爱信艾达株式会社 车道判定装置以及车道判定方法
JP2009012672A (ja) * 2007-07-06 2009-01-22 Toyota Motor Corp 車両の走行制御装置
CN101970273A (zh) * 2008-03-12 2011-02-09 本田技研工业株式会社 车辆行驶辅助装置、车辆、车辆行驶辅助程序
WO2011064825A1 (ja) * 2009-11-27 2011-06-03 トヨタ自動車株式会社 運転支援装置および運転支援方法

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5172317A (en) 1988-08-10 1992-12-15 Honda Giken Kogyo Kabushiki Kaisha Automatic travelling apparatus
JP2603523B2 (ja) 1988-08-10 1997-04-23 本田技研工業株式会社 自動走行装置
JP3548459B2 (ja) * 1998-11-20 2004-07-28 富士通株式会社 案内情報提示装置,案内情報提示処理方法,案内情報提示プログラムを記録した記録媒体,案内用スクリプト生成装置,案内情報提供装置,案内情報提供方法および案内情報提供プログラム記録媒体
JP3692910B2 (ja) 2000-06-27 2005-09-07 日産自動車株式会社 車線追従走行制御装置
JP2005180986A (ja) * 2003-12-17 2005-07-07 Honda Motor Co Ltd ナビ装置及びナビサーバ
US7899617B2 (en) * 2005-02-17 2011-03-01 Denso Corporation Navigation system providing route guidance in multi-lane road according to vehicle lane position
JP2006264624A (ja) 2005-03-25 2006-10-05 Daimler Chrysler Ag 車線維持支援装置
JP2006273230A (ja) 2005-03-30 2006-10-12 Aisin Aw Co Ltd 車両制御装置及び車両制御方法
JP4779638B2 (ja) * 2005-12-20 2011-09-28 アイシン・エィ・ダブリュ株式会社 走行予測システム
JP4501879B2 (ja) * 2006-03-20 2010-07-14 株式会社デンソー 経路選択装置および経路選択用プログラム
JP4862630B2 (ja) * 2006-11-27 2012-01-25 株式会社デンソー 車間距離制御装置
JP2009075010A (ja) * 2007-09-21 2009-04-09 Denso It Laboratory Inc 経路長算出装置、経路長算出方法、経路長算出プログラム及び車両用空調装置ならびに移動物体搭載機器の制御装置
JP2009085613A (ja) 2007-09-27 2009-04-23 Aisin Aw Co Ltd ナビゲーション装置及びプログラム
US8498808B2 (en) * 2008-01-18 2013-07-30 Mitac International Corp. Method and apparatus for hybrid routing using breadcrumb paths
JP4979644B2 (ja) 2008-07-09 2012-07-18 本田技研工業株式会社 ナビゲーション装置および車両の走行安全装置
JP5200926B2 (ja) 2008-12-26 2013-06-05 トヨタ自動車株式会社 運転支援装置
DE112009005499B4 (de) * 2009-10-22 2021-06-17 Toyota Jidosha Kabushiki Kaisha Fahrsteuerung für ein Hybridfahrzeug
JP5327333B2 (ja) * 2009-10-30 2013-10-30 トヨタ自動車株式会社 車両の走行制御装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006344133A (ja) * 2005-06-10 2006-12-21 Toyota Motor Corp 道路区画線検出装置
JP2007313978A (ja) * 2006-05-24 2007-12-06 Toyota Motor Corp 運転支援装置
CN101246010A (zh) * 2007-02-13 2008-08-20 爱信艾达株式会社 车道判定装置以及车道判定方法
JP2009012672A (ja) * 2007-07-06 2009-01-22 Toyota Motor Corp 車両の走行制御装置
CN101970273A (zh) * 2008-03-12 2011-02-09 本田技研工业株式会社 车辆行驶辅助装置、车辆、车辆行驶辅助程序
WO2011064825A1 (ja) * 2009-11-27 2011-06-03 トヨタ自動車株式会社 運転支援装置および運転支援方法

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107054361B (zh) * 2015-09-25 2018-10-09 株式会社斯巴鲁 车辆的转向控制装置
CN107054361A (zh) * 2015-09-25 2017-08-18 株式会社斯巴鲁 车辆的转向控制装置
CN108885108B (zh) * 2016-01-14 2022-05-10 福特全球技术公司 基于操纵难度的u形转弯辅助
CN108885108A (zh) * 2016-01-14 2018-11-23 福特全球技术公司 基于操纵难度的u形转弯辅助
CN107628028A (zh) * 2016-07-19 2018-01-26 株式会社万都 车辆辅助驾驶装置
CN108068693B (zh) * 2016-11-18 2021-01-15 丰田自动车株式会社 驾驶辅助装置
CN108068693A (zh) * 2016-11-18 2018-05-25 丰田自动车株式会社 驾驶辅助装置
CN110494903A (zh) * 2017-03-30 2019-11-22 本田技研工业株式会社 车辆控制装置和车辆控制方法
CN110998691A (zh) * 2017-08-02 2020-04-10 日产自动车株式会社 行驶辅助方法及行驶辅助装置
CN110998691B (zh) * 2017-08-02 2022-07-01 日产自动车株式会社 行驶辅助方法及行驶辅助装置
CN107963077B (zh) * 2017-10-26 2020-02-21 东软集团股份有限公司 一种车辆通过路口的控制方法、装置及系统
US10928825B2 (en) 2017-10-26 2021-02-23 Neusoft Reach Automotive Technology (Shanghai) Co., Ltd. Method, device and system for controlling vehicle passing through intersection
CN107963077A (zh) * 2017-10-26 2018-04-27 东软集团股份有限公司 一种车辆通过路口的控制方法、装置及系统
CN110027555B (zh) * 2018-01-12 2022-03-22 本田技研工业株式会社 行驶轨迹确定装置和自动驾驶装置
CN110027555A (zh) * 2018-01-12 2019-07-19 本田技研工业株式会社 行驶轨迹确定装置和自动驾驶装置
CN111174801B (zh) * 2018-11-09 2023-08-22 阿里巴巴集团控股有限公司 导航引导线的生成方法和装置以及电子设备
CN111174801A (zh) * 2018-11-09 2020-05-19 阿里巴巴集团控股有限公司 导航引导线的生成方法和装置以及电子设备
CN111319676A (zh) * 2018-12-17 2020-06-23 本田技研工业株式会社 行驶轨迹确定装置和自动驾驶装置
US11449058B2 (en) 2018-12-17 2022-09-20 Honda Motor Co., Ltd. Traveling track determination processing and automated drive device
CN109815558A (zh) * 2019-01-04 2019-05-28 东南大学 一种大型车辆交叉口转向席卷路径的确定方法
CN109815558B (zh) * 2019-01-04 2022-05-03 东南大学 一种大型车辆交叉口转向席卷路径的确定方法
CN111532269A (zh) * 2019-02-05 2020-08-14 本田技研工业株式会社 车辆控制装置
CN113826153A (zh) * 2019-05-15 2021-12-21 日产自动车株式会社 车辆的行驶控制方法及行驶控制装置
CN113826153B (zh) * 2019-05-15 2024-01-02 日产自动车株式会社 车辆的行驶控制方法及行驶控制装置
US11926320B2 (en) 2019-05-15 2024-03-12 Nissan Motor Co., Ltd. Vehicle travel control method and vehicle travel control device
CN110530390A (zh) * 2019-09-16 2019-12-03 哈尔滨工程大学 一种在狭窄环境下的非质点车辆路径规划方法
CN112373472A (zh) * 2021-01-14 2021-02-19 长沙理工大学 一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法

Also Published As

Publication number Publication date
EP2871107A1 (en) 2015-05-13
EP2871107B1 (en) 2023-10-25
JP5924508B2 (ja) 2016-05-25
EP2871107A4 (en) 2018-03-14
JPWO2014006759A1 (ja) 2016-06-02
CN104411558B (zh) 2017-09-22
WO2014006759A1 (ja) 2014-01-09
US20150134204A1 (en) 2015-05-14
US9399464B2 (en) 2016-07-26

Similar Documents

Publication Publication Date Title
CN104411558A (zh) 车辆的行驶控制装置
JP5747998B2 (ja) 車両の走行軌跡制御装置
JP5737197B2 (ja) 車両の走行軌跡制御装置
DE102017108782B4 (de) Fahrtsteuerungsvorrichtung für Fahrzeug
US6675096B2 (en) Vehicle controlling apparatus and method
JP6185482B2 (ja) 車両の走行制御装置
US9145165B2 (en) Drive controlling apparatus for a vehicle
JP7000765B2 (ja) 車両の走行制御装置
US9707996B2 (en) Vehicle drive-control device
US6567749B2 (en) Vehicle controlling apparatus and method
CN106476653A (zh) 车辆的控制装置及车辆的控制方法
US11097743B2 (en) Method and system for controlling a vehicle by determining a location of an optimum perceived yaw center
US20110264328A1 (en) Method for improving the driving stability of a vehicle
JP5341469B2 (ja) 車両の制御装置
CN106143211A (zh) 电动汽车及其弯道车速控制方法、系统
US20230041499A1 (en) Method for determining the current angle of lateral inclination of a roadway
JP6020097B2 (ja) 車両の走行制御装置
JP6496588B2 (ja) 車両挙動制御装置

Legal Events

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