车道偏离防止系统和方法 本申请要求 2008 年 3 月 21 日提交的日本专利申请第 2008-073508 号和 2008 年 11 月 19 日提交的日本专利申请第 2008-295197 号的优先权, 且它们每一个通过引用整体结 合于此。
技术领域
本发明涉及车道偏离防止系统和方法。背景技术 日本公开的专利申请第 2003-112540 号公开了一种车道偏离防止装置, 其中, 当 探测到从驾驶车道偏离的趋势时, 借助于左 / 右车轮不同的制动力, 产生横摆力矩, 使得主 车辆的行驶路线被沿着避免偏离的方向修正。
发明内容 在本发明的实施例中的车道偏离防止系统具有用于探测驾驶车道的探测器和确 定主车辆是否具有从探测器所探测的驾驶车道偏离的趋势的判断装置。 当判断装置判断存 在偏离趋势时, 计算沿着避免偏离方向上的目标横摆力矩, 并且同时, 当为主车辆预测的估 计横向加速度小于阈值时, 该阈值可以基于为主车辆预测的估计减速度来提供, 通过减小 所计算的目标横摆力矩来校正它。而且, 车道偏离防止系统可以具有控制器, 该控制器根 据用横摆力矩计算装置计算的目标横摆力矩, 在主车辆的左 / 右车轮之间施加不同的制动 力。
在本发明另一实施例中的车道偏离防止系统具有用于探测驾驶车道的探测装置 和确定主车辆是否具有从所述探测装置探测的驾驶车道偏离的趋势的判断装置。 该系统具 有横摆力矩计算装置, 该横摆力矩计算装置如下工作 : 当判断装置判断存在偏离趋势时, 计 算沿着避免偏离方向上的目标横摆力矩, 并且同时, 当为主车辆预测的估计横向加速度小 于阈值时, 该阈值可以基于为主车辆预测的估计减速度来提供, 通过减小所计算的目标横 摆力矩来修正它。 而且, 该系统可以包括控制装置, 该控制装置基于所述横摆力矩计算装置 计算的目标横摆力矩在主车辆的左 / 右车轮之间施加不同的制动力。
在本发明的再一实施例中, 车道偏离防止方法包括以下特征 : 探测驾驶车道 ; 确 定主车辆是否具有从所述驾驶车道偏离的趋势 ; 当确定存在偏离趋势时, 计算沿着避免偏 离方向上的目标横摆力矩 ; 当为主车辆预测的估计横向加速度小于阈值时, 该阈值可以基 于为主车辆预测的估计减速度来提供, 通过减小所计算的目标横摆力矩来修正它, 并且根 据已经修正后的目标横摆力矩, 在主车辆的左 / 右车轮之间施加不同的制动力。
附图说明
图 1 是示出本发明的车道偏离防止系统的示意图 ;
图 2 是示出车道偏离防止控制过程的流程图 ;图 3 是用于计算阈值 Xa 的曲线 ; 图 4 是用于计算增益 K2 的曲线 ; 图 5 是用于计算极限值 Msm 的曲线 ; 图 6 是用于计算控制时间 TLDP 的曲线 ; 图 7 是用于计算增益 Kv 的曲线 ; 图 8 是示出估计横向加速度相对于不同车速下的横摆角速度变化的特征曲线 ; 图 9 是示出在前进时间 (headway time) 之后从车道中间的横向偏移量的视图。具体实施方式
在前面提到的现有技术中, 当由于在左 / 右车轮之间的制动力不同而产生横向力 矩时, 除了横向加速度之外, 减速度 ( 通常是纵向加速度 ) 作用在车辆上。如果减速度大于 横向加速度, 驾驶员感觉到大于横向加速度的减速度。于是, 虽然出于修正主车辆行驶路 线的目的而进行控制 ( 控制来防止车道偏离 ), 但是, 驾驶员有可能将其误解为车辆减速控 制。
在下面的实施例中, 示出了这样的方案, 该方案涉及帮助驾驶员意识到车道偏离 防止控制已经开始。
下面, 参照附图解释本发明的实施方式。
图 1 是示出根据本发明的车道偏离防止系统的示意图。
用于车辆动态控制 (VDC) 等的制动执行器 3 位于刹车总泵 1 和每个各种刹车分泵 2i(I = FL、 FR、 RL、 RR) 之间。制动执行器 3 包括电磁阀、 泵和其他液压装置。控制器 4 控 制液压装置的驱动, 来独立于驾驶员的制动操作, 而控制每个刹车分泵 2i 的液压力。
而且, 这个系统包括摄像机 5, 用于拍摄车辆前面的区域。基于摄像机所捕捉的图 像数据, 摄像机 5 内的图像处理器识别白线和其他车道标记, 来探测驾驶车道, 且同时它为 在驾驶车道内的主车辆计算横摆角 φ、 从驾驶车道的中心的横向位移 X、 以及驾驶车道的 曲率 ρ。所产生的各种相关信号输入到控制器 4 中。当在路面上没有白线时, 驾驶车道也 可以根据路侧 (side of the road)、 护栏 (guardrail)、 路边 (curb) 等来估计。
输入到控制器 4 中的还有用压力传感器 10 探测的总泵压力 Pm、 转向角传感器 11 探测的转向角 δ、 车速传感器 12 探测的每个车轮的速度 Vwi, 以及转向指示灯开关 13 的工 作状态。还输入到控制器 4 中的是从导航装置 14 获取的各种道路信息 ; 车辆的纵向加速 度; 估计横向加速度 Xg 和横摆角 φ’ 。
各种类型的数据具有左 / 右方向性, 且左方向总是取作正, 而右方向总是取作负。 即, 当左转时横摆角 φ 和转向角 δ 取作正, 且当向右转是取作负, 且当从驾驶车道的中心 向左偏移时横向位移 X 取作正, 而当向右偏移时取作负。
另外, 该系统具有报警装置 20。 该报警装置 20 根据从控制器 4 输出的报警信号产 生报警声音或者点亮报警灯。
在下面的第一实施例中, 参照图 2 所示的流程图解释根据计时器中断控制器 4 执 行的算法和逻辑运算, 该计时器中断以规定间隔发生。
首先, 在步骤 S1 读取各种类型的数据。
然后, 在步骤 S2, 计算非驱动车轮 ( 从车轮 ) 的平均车速, 作为车速, 如下面所示。而且, 如果可能的话, 这可以从防滑控制和导航信息中获取。
在前轮驱动的情况下 : V = (VWRL+VWRR)/2
在后轮驱动的情况下 : V = (VWFL+VWFR)/2
然后, 在步骤 3, 对主车辆相对于驾驶车道的偏离趋势进行判断。
首先, 如下面所描述的, 在前进时间 (headway time)Tt 消逝之后, 计算从驾驶车 道中心的横向偏移, 作为估计横向偏移 Xs。在此, 前进时间指的是固定距离 ( 前看距离 (look-ahead distance)) 由车速 V 除得到的值。
Xs = Tt×V×(φ+Tt×V×ρ)+X
在图 9 中, α 表示主车辆的当前位置, 而 β 表示在前进时间 Tt 之后主车辆的位 置。
然后, 估计横向位移 |Xs| 与阈值 XL 相比较。 如果比较结果是 |Xs| < XL, 确定主车 辆不具有车道偏离趋势, 并且偏离标志被复位为 Fd = 0。 另一方面, 当判断结构是 |Xs| ≥ XL 时, 确定主车辆具有相对于驾驶车道偏离的趋势, 并且偏离标志被设定为 Fd = 1。 在这种情 况下, 偏离方向也可以从估计横向位移 Xs 的符号 (±) 来探测。
例如, 阈值 XL 如下计算。在此, 假设 L 表示车道宽度, H 表示车辆的宽度。在此, 车 道宽度 L 可以从所捕捉的图像数据或者导航信息来获取。 XL = (L-H)/2
然后, 在步骤 S4, 确定主车辆是否需要减速。
在此确定主车辆的车道偏离趋势的程度, 即, 估计横向位移 Xs 和阈值 XL 之间的差 ΔX( = |Xs|-XL), 超过阈值 Xa。如果比较结果是 ΔX < Xa, 确定主车辆不需要减速, 并且 减速标志复位成 Fr = 0。另一方面, 如果比较结果是 ΔX ≥ Xa, 确定主车辆需要减速, 且减 速标志设定为 Fr = 1。
例如, 参照图 3 的曲线, 阈值 Xa 可以设定成与车辆行驶路线的曲率 ρ 相对应。通 常, 曲率 ρ 的值越大, 阈值 Xa 越小。
然后, 在步骤 S5, 计算目标横摆力矩 Ms。
首先, 当偏离标志 Fd = 0 时, Ms = 0。
另一方面, 当偏离标志 Fd = 1 时, 如下进行计算。在此 K1 表示取决于各种车辆参 数的增益, 而 K2 表示根据车速 V 确定的增益。通常, 车速 V 越高, K2 的值越小, 如图 4 所示。
Ms = K1×K2×(|Xs|-XL)
即, 车道偏离趋势的程度 (|Xs|-XL) 越大, 所计算的目标横摆力矩 M 的值越大。
如下所示, 计算通过目标横摆力矩 M 产生的估计横向加速度 GH 和估计减速度 GT。 在 此, Ky 表示横摆角速度和横摆力矩的换算系数, 而 Kg 表示减速度和横摆力矩的换算系数。
GH = Mx×V×Ky
GT = Ms×Kg
在另一个实施例中, 对估计减速度 GT 是否大于估计横向加速度 GH 进行确定。如果 比较结果 GH ≥ GT, 确定驾驶员没有感觉到减速度比横向加速度更显著, 且保持目标横摆力 矩 Ms 原样不变。另一方面, 如果判断结果是 GH < GT, 确定驾驶员感觉到减速度比横向加速 度更显著, 并且如下面将描述的, 目标横摆力矩 Ms 被修正为小于计算的目标横摆力矩 Ms 的 值 ( 下面称为极限值 Msm)(Msm < Ms)。即, 当判断结果是 GH < GT 时, 目标横摆力矩 Ms 通
过减小它来修正。
Ms = Msm(GH < GT)
参照图 5 所示的曲线, 极限值 Msm 根据车速 V 来确定。即, 车速 V 越低, 极限值 Msm 越小。这个极限值 Msm 表示确保驾驶员不会感觉到减速度比横向加速度更显著的横摆力矩 的极限。
然后, 参照图 6 所示的曲线, 控制时间 TLDP 根据 Ms 和 Msm 之间的差 (Ms-Msm) 来设 定, 即, 差 (Ms-Msm) 越大, 控制时间 TLDP 越长。
然后, 在步骤 S6 确定驾驶员改变车道的意图。
首先, 当转向指示灯开关为 ON 时, 对所指示的方向是否与偏离方向匹配进行判 断, 如果 YES, 确定驾驶员意图改变车道, 因此, 偏离标志复位为 Fd = 0。 另一方面, 如果 NO, 确定驾驶员并未意图改变车道, 由此保持偏离标志 Fd 的当前状态。
另一方面, 当转向指示灯开关为 OFF 时, 对转向角 |θ| 是否超过阈值 θs 进行确 定。如果判断结果是 |θ| ≥ θs, 确定驾驶员意图改变车道, 且偏离标志 Fd 复位为 0。如 果判断结果为 |θ| < θs, 确定驾驶员没有意图改变车道, 且保持偏离标志 Fd 的当前状态。
然后, 在步骤 S7 计算对各个车轮的目标液压力 PFL-PRR。 首先, 如果偏离标志 Fd = 0, 确定主车辆没有偏离趋势, 制动执行器 3 的驱动操作 被停止, 且下面所示的总泵压力被供给到各个分泵。在此, Pmr 表示基于前 / 后制动力的理 想分配的后车轮总泵压力。
PFL = PFR = Pm
PRL = PRR = Pmr
而且, 如果出于在避免偏离方向上修正行驶路线的目的, 偏离标志 Fd = 1, 计算左 / 右车轮之间的制动力差 ΔPf 和 ΔPr。
首先, 对目标横摆力矩 Ms 是否超过规定值 Ms1 来进行确定。 如下所示, 判断结果是 Ms < Ms1, 计算左 / 右前车轮之间的制动力差 ΔPf 和左 / 右后车轮之间的制动力差 ΔPr。 在此, T 表示胎面。为了方便, 假设它对于前 / 后车轮是相同的。而且, KR 表示在后车轮处 将制动力换算成液压力的系数, 且它取决于各种制动参数。
ΔPf = 0
ΔPr = 2×KR×|Ms|/T
另一方面, 如果判断结果是 Ms ≥ Ms1, 如下所示计算左 / 右前车轮之间的制动力差 ΔPf 和左 / 右后车轮之间的制动力差 ΔPr。在此 KF 表示在前车轮处将制动力换算成液压 力的系数, 且它取决于各种制动参数。
ΔPf = 2×KF×(|Ms|-Ms1)/T
ΔPr = 2×Kr×Ms1/T
于是, 当偏离方向是向左时, 计算对于各个刹车分泵的目标液压力 PFL-PRR, 以便施 加向右的横摆力矩, 如下所示。另一方面, 当偏离方向是向右时, 左 / 右应该反转, 以便施加 向左的横摆力矩。
PFL = Pm
PFR = Pm+ΔPf
PRL = Pmr
PRR = Pmr+ΔPr
如果减速标志 Fr = 0, 前述的目标液压力 PFL-PRR 是满意的。当减速标志 Fr = 1 时, 如下所示, 计算额外的制动力 Rg 以进行减速。在此, Kv 表示对应于车速 V 的增益。例 如, 如图 7 所示, 通常, 车速 V 越高, Kv 的值越小。在此 Kg 是取决于各个车辆参数的增益。
Pg = Kv×Kg×(|Xs|-XL-Xa)
于是, 当减速标志 Fr = 1 时, 如下所示计算各个刹车分泵的目标液压力 PFL-PRR。 在 此, Pgr 表示基于前 / 后车轮的制动力理想分配, 用于后车轮的额外后车轮制动力。
PFL = Pm+(Pg/2)
PFR = Pm+ΔPf+(Pg/2)
PRL = Pmr+(Pgr/2)
PRR = Pmr+ΔPr+(Pgr/2)
在此, 控制制动执行器 3, 以在各个刹车分泵中, 如至少一个左车轮和至少一个右 车轮中, 产生目标液压力 PFL-PRR, 并且同时开启报警装置 20, 来警告驾驶员主车辆的偏离趋 势。然后, 处理流程返回到规定的主程序。
当减速标志 Fr = 1 时, 可以采用不仅制动力单独增加, 而且发动机的输出功率在 同时减小以便减小驱动力的方案。 也可以采用下面的方案 : 当在避免偏离方向上进行行驶路线修正时, 不需要发出 警报。反之, 用于发出警报的阈值和用于修正行驶路线的阈值相对于估计横向位移 Xs 来单 独确定。 在这个方案中, 用于警报的阈值相对低, 使得在开始修正行驶路线的操作之前就产 生警报。
操作的实施例
现在, 假设探测到主车辆有向右的偏离趋势, 且计算向左的目标横摆力矩 Ms。 当由 于在左 / 右车轮之间制动力不同而产生横摆力矩时, 除了横向加速度之外, 减速度 ( 通常是 纵向加速度 ) 也作用在车辆上。如果在这种情况下减速度大于横向加速度, 虽然进行控制 来修正主车辆的行驶路线, 但是驾驶员会感觉到车道偏离控制是为了使车辆减速。
在此, 当计算出目标横摆力矩 Ms 时, 根据这个目标横摆力矩 Ms, 预先估计在修正 主车辆的行驶路线时作用在车辆上的估计横向加速度 GH 和估计减速度 GT。然后车道偏离 防止系统可以执行比较, 来确定是否应该修正所产生的横摆力矩, 以防止或者最小化驾驶 员的为了使车辆减速而进行车道偏离控制的这种感受。例如, 这种比较可以通过横摆力矩 计算装置或者车道偏离防止系统的装置进行。
例如, 可以将估计横向加速度 GH 与阈值相比较。这个阈值可以具有多个值。在另 一实施例中, 阈值可以根据估计减速度 GT 来确定。 在另一实施例中, 阈值可以通过车道偏离 系统来确定或者阈值可以具有预定值。在另一实施例中, 阈值可以具有与估计减速度 GT 相 同的值。在这些实施例的任一个中, 当估计横向加速度 GH 低于阈值时, 确定所产生的横摆 力矩必须被修正, 诸如通过减小所产生的横摆力矩, 从而防止或者最小化驾驶员的为了使 车辆减速而进行车道偏离控制的这种感觉。
在另一实施例中, 所获得的横向加速度 GH 和减速度 GT 的估计值可以相互比较。类 似的, 估计横向加速度 GH 可以与阈值相比较, 该阈值与估计减速度 GT 具有相同值。如果估 计横向加速度 GH 超过估计减速度 GT, 驾驶员不会被大于横向加速度的减速度所作用, 且驾
驶员相对感受到横向加速度。于是, 借助于与目标横摆力矩 Ms 相对应的左 / 右车轮之间的 制动力差来进行行驶路线的修正。
另一方面, 当估计横向加速度 GH 小于估计减速度 GT 时, 或者阈值具有与估计的减 速度 GT 相同的值时, 通过将目标横摆力矩 Ms 减小到比所计算的目标横摆力矩 Ms 小的值 ( 极限值 Msm) 来修正这个目标横摆力矩 Ms。结果, 根据避免偏离方向, 对左 / 右车轮中所 述侧 ( 在此是左车轮侧 ) 上的至少一个车轮, 减小制动力。由此, 如图 8 所示, 当横向加速 度小于减速度时, 在横摆角速度 ( 即, 横摆力矩 ) 被减小时横向加速度中的减小和减速度中 的减小导致减速度中的减小更大。 换句话说, 通过减小目标横摆力矩 Ms, 可以减小减速度对 横向加速度的比。于是, 当主车辆的行驶路线相应地已经通过将其减小到极限值 Msm 来修 正的目标横摆力矩 Ms 予以修正时, 驾驶员将容易感受到横向加速度, 将容易认识到偏离防 止控制正在进行。即, 可以防止驾驶员将该控制误认为用于减速的控制。
如上面已经解释的, 当 GH 小于阈值, 或 GH < GT 时, 可以通过减小目标横摆力矩 Ms 来减小估计减速度 GT 对估计横向加速度 GH 的比。在此, 为了确保驾驶员感受到实际的横向 加速度, 优选的是极限值 Ms 具有适当的值, 使得减速度对横向加速度的比保持小于一个规 定的比。这个值变化且取决于车速 V。图 8 是示出随着横摆角速度、 横向加速度和减速度 之间的关系的视图。在图中, 实线 L1、 L2 和 L3 表示对于低车速 ( 例如 60km/h)、 中等车速 ( 例如 100km/h) 和高车速 ( 例如, 140km/h) 的横向加速度值, 而虚线表示减速度。即, 对于 相同的横摆角速度 ( 即, 横摆力矩 ), 车速越低, 横向加速度越小, 且减速度对横向加速度的 比越大。为了抑制减速度对横向加速度的比增加, 对于低车速 V, 极限值 Msm 必须较小。通 过对低车速 V 设定较小的极限值 Msm, 可以抑制减速度对横向加速度的比增加, 使得驾驶员 可以容易感受到实际的横向加速度。
而且, 当通过减小目标横摆力矩 Ms 来修正它时, 在行驶路线修正的性能方面具 有相应的效果。于是, 修正主车辆行驶路线所需的时间对应于目标横摆力矩 Ms 的减小量 (Ms-Msm) 予以延长。即, 一旦所计算的目标横摆力矩 Ms 通过减小它来予以修正, 施加到车 辆的预测横摆力矩将不足够。于是, 这个不足将通过延长控制时间来抵消。结果, 保持了行 驶路线修正的性能, 且车辆可以可靠地从其偏离趋势中返回。
额外的实施例
在一个实施方式中, 当判断结果显示 GH 小于阈值, 或者 GH < GT, 通过减小目标横摆 力矩 Ms 来修正它。但是, 本发明不局限于这个示例性方案。在另一实施例中, 可以采用这 样的方案, 使得当 GH < GT 且估计减速度 GT 和估计横向加速度 GH 之间的差超过规定值时, 通 过减小目标横摆力矩 Ms 来修正它。在这种情况下, 相对于目标横摆力矩 Ms, 极限值 Msm 可 以设定为使得估计减速度 GT 和估计横向加速度 GH 之间的差小于规定值这样的一个值。在 此, 针对该差的所述规定值是驾驶员感受到减速度比横向加速度更明显的值。这个规定值 可以借助于试验和现有技术中使用的其他方法来确定。
也可以采用下面的示例性方案 : 当 GH < GT 且估计减速度 GT 对估计横向加速度 GH 的比超过规定值时, 通过减小目标横摆力矩 Ms 来修正它。在这种情况下, 相对于目标横摆 力矩 Ms, 极限值 Msm 可以设定为使得估计减速度 GT 对估计横向加速度 GH 的比小于规定值 这样的一个值。在此, 针对该比的所述规定值是驾驶员感受到减速度比横向加速度更明显 的值。这个规定值可以事先借助于试验和现有技术中使用的其他方法来确定。在这些方案中, 正如在本实施方式中的, 优选的是, 在车速 V 较低时, 极限值 Msm 被 设定成较小的值。
也可以采用下面的示例性方案 : 涉及到减小的修正的确定是借助于差来进行的, 且极限值 Msm 被定义为一个比值。反之, 涉及到减小的修正的确定是借助于比来进行的, 且 极限值 Msm 被定义为一个差值。
效果
如上面所解释的, 在步骤 S5 中执行的过程对应于横摆力矩计算装置所执行的过 程, 而步骤 S7 中的过程对应于控制装置所执行的过程。
(1) 在第一实施例中, 当为主车辆估计的横向加速度小于阈值时, 所计算的目标横 摆力矩是通过减小它来修正的。
结果, 当主车辆的行驶路线被修正时, 减速度对横向加速度的比可以被减小, 使得 驾驶员可以容易感觉到横向加速度。于是, 可以防止驾驶员错误地判断该控制是为了使车 辆减速而进行的。
(2) 在操作的实施例中, 随着主车辆的车速降低, 目标横摆力矩被修正的量增加。 换句话说, 随着主车辆车速降低, 目标横摆力矩以增加的量予以减小。于是, 驾驶员可以容 易感觉到横向加速度。 (3) 在另一实施例中, 当估计横向加速度低于估计减速度且估计横向加速度与估 计减速度之间的差超过规定值时, 目标横摆力矩通过减小它来予以修正。
结果, 通过减小来修正目标横摆力矩的时间可以被优化, 以匹配驾驶员的感受。
(4) 在第一实施例中, 目标横摆力矩可以通过减小它来予以修正, 使得估计横向加 速度和估计减速度之间的差小于规定值。
结果, 可以减小减速度相对于横向加速度的比, 允许驾驶员感觉到横向加速度。 于 是, 可以防止驾驶员错误感受到控制是为了使车辆减速而进行的。
(5) 在额外的实施例中, 当估计横向加速度低于估计减速度, 且估计减速度对估计 横向加速度的比超过事先设定的规定值时, 目标横摆力矩通过减小它来予以修正。
结果, 可以使得通过减小它来予以修正目标横摆力矩的时间被优化来匹配驾驶员 的感受。
(6) 在第一实施例中, 目标横摆力矩可以通过减小它来予以修正, 使得估计减速度 对估计横向加速度的比小于规定值。
结果, 可以减小减速度对横向加速度的比, 并且使得驾驶员能够感受到横向加速 度。于是, 可以防止驾驶员错误地感觉到控制是为了使车辆减速而进行的。
(7) 在操作的实施例中, 当目标横摆力矩通过计算装置或者手段来减小到较小的 值时, 为修正主车辆的行驶路线分配的时间可以被延长。
结果, 可以保持行驶路线修正性能并且可靠的从偏离趋势中恢复。
在此描述的过程用计算机来执行。 例如, 为车辆使用而设计的计算机, 如车辆内包 括的或者所承载的计算机可以用于在此描述的过程。在另一实施例中, 车辆可以被提供有 具有 80MHz 32 位 RISC 微处理器的计算机, 来执行在此描述的过程。
本发明的实施方式不局限于在此提供的描述。例如, 一个实施方式的特征和部件 可以与另一个实施方式的特征和部件一起使用或者替代。
虽然已经通过参照本发明的特定实施方式来描述了本发明, 本发明并不局限于上 述实施方式。鉴于上面的教导, 上述实施方式的修改和变型对本领域技术人员来说是显而 易见的。本发明的范围参照所附的权利要求书来限定。