欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 201811582854X
申请人: 湖北工业大学
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种智能车自动避障装置控制方法,所述自动避障装置包括控制器(6),以及分别连接到控制器(6)的测距传感器A(4)、测距传感器B(3)、测距传感器C(5)、测距传感器D(7)、测距传感器E(1)和测量车轮角位移的编码器(2),其中,测距传感器A(4)位于车头的中间位置且朝向正前方,测距传感器B(3)位于车头偏右侧位置且朝向右前方,测距传感器C(5)位于车头偏左侧位置且朝向左前方,测距传感器D(7)和测距传感器E(1)设置在车身左右两侧且朝向道路的两侧,其特征在于,所述控制方法包括:若测距传感器A(4)检测到障碍物,而测距传感器B(3)和测距传感器C(5)均未检测到障碍物,执行以下步骤:步骤1‑1,控制智能车向左或右转向角度γ行驶;步骤1‑2,编码器(2)测量到智能车转向后的行驶距离达到L2时,控制智能车向相反方向偏转角度γ;

上述步骤1‑1~1‑2中,

式中,L1为测距传感器A(4)到障碍物的距离,d为道路宽度,L0为前轮中心点与测距传感器A(4)的水平距离;

若测距传感器A(4)和测距传感器C(5)检测到障碍物,测距传感器B(3)未检测到障碍物,执行以下步骤:步骤2‑1,控制智能车向右转向角度γ行驶;步骤2‑2,编码器(2)测量到智能车转向后的行驶距离达到L2时,控制智能车向左偏转角度γ;

若测距传感器A(4)和测距传感器B(3)检测到障碍物,测距传感器C(5)未检测到障碍物,执行以下步骤:步骤3‑1,控制智能车向左转向角度γ行驶;步骤3‑2,编码器(2)测量到智能车转向后的行驶距离达到L2时,控制智能车向右偏转角度γ;

上述步骤2‑1~3‑2中,

式中,L1为测距传感器A(4)到障碍物的距离,d为道路宽度,L0为前轮中心点与测距传感器A(4)的水平距离;

若测距传感器C(5)检测到障碍物,测距传感器A(4)和测距传感器B(3)未检测到障碍物,执行以下步骤:若测距传感器C(5)与障碍物的距离LC先递减再增大,控制智能车继续直线行驶;若测距传感器C(5)与障碍物的距离LC一直递减到 时仍不出现递增情况,则按以下步骤进行:步骤4‑1,控制智能车向右转向角度γ行驶;步骤4‑2,编码器(2)测量到智能车转向后的行驶距离达到L2时,控制智能车向左偏转角度γ;

上述步骤4‑1~4‑2中,

式中,L0为前轮中心点与测距传感器A(4)的水平距离,L3为前轮中心点与测距传感器C(5)的水平距离,L4为前轮中心点与障碍物的水平距离,d为道路宽度;

若测距传感器B(3)检测到障碍物,测距传感器A(4)和测距传感器C(5)未检测到障碍物,执行以下步骤:若测距传感器B(3)与障碍物的距离LB先递减再增大,控制智能车继续直线行驶;若测距传感器B(3)与障碍物的距离LB一直递减到 时仍不出现递增情况,则按以下步骤进行:步骤5‑1,控制智能车向左转向角度γ行驶;步骤5‑2,编码器(2)测量到智能车转向后的行驶距离达到L2时,控制智能车向右偏转角度γ;

上述步骤5‑1~5‑2中,

式中,L0为前轮中心点与测距传感器A(4)的水平距离,L5前轮中心点与测距传感器B(3)的水平距离,L6前轮中心点与障碍物的水平距离,d为道路宽度。

2.根据权利要求1所述的控制方法,其特征在于,在所述步骤1‑2之后,测距传感器D(7)的探测的距离LD和测距传感器E(1)探测的距离LE满足关系式 时,控制智能车向道路较宽一侧偏转角度γ,当编码器(2)测量到智能车第三次转向后的行驶的距离达到L2时,控制智能车再向相反方向偏转角度γ;其中,L2和γ的取值与步骤1‑1~1‑2中的一致。

3.根据权利要求1所述的控制方法,其特征在于,在所述步骤2‑2之后,测距传感器D(7)的探测的距离LD和测距传感器E(1)探测的距离LE满足关系式 时,控制智能车向左偏转角度γ,当编码器(2)测量到智能车第三次转向后的行驶的距离达到L2时,控制智能车再向右偏转角度γ;其中,L2和γ的取值与步骤2‑1~2‑2中的一致。

4.根据权利要求1所述的控制方法,其特征在于,在所述步骤3‑2之后,测距传感器D(7)的探测的距离LD和测距传感器E(1)探测的距离LE满足关系式 时,控制智能车向右偏转角度γ,当编码器(2)测量到智能车第三次转向后的行驶的距离达到L2时,控制智能车再向左偏转角度γ;其中,L2和γ的取值与步骤3‑1~3‑2中的一致。

5.根据权利要求1所述的控制方法,其特征在于,在所述步骤4‑2之后,测距传感器D(7)的探测的距离LD和测距传感器E(1)探测的距离LE满足关系式 时,控制智能车向左偏转角度γ,当编码器(2)测量到智能车第三次转向后的行驶的距离达到L2时,控制智能车再向右偏转角度γ;其中,L2和γ的取值与步骤4‑1~4‑2中的一致。

6.根据权利要求1所述的控制方法,其特征在于,在所述步骤5‑2之后,测距传感器D(7)的探测的距离LD和测距传感器E(1)探测的距离LE满足关系式 时,控制智能车向右偏转角度γ,当编码器(2)测量到智能车第三次转向后的行驶的距离达到L2时,控制智能车再向左偏转角度γ,其中,L2和γ的取值与步骤5‑1~5‑2中的一致。