欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2013103902313
申请人: 江苏大学
专利类型:发明专利
专利状态:已下证
专利领域: 测量;测试
更新日期:2023-08-11
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种应用于温室的自主移动车辆超声波导航方法,其特征在于包括以下步骤:

步骤1,上位机通过无线数传模块向自主移动车辆发射启动请求信号,移动车辆接收到请求信号后,ARM嵌入式控制器初始化,启动驱动程序,设置导航系统总定时器时间为T1,使每隔时间T1自主移动车辆向四周发射超声波,考虑到自主移动车辆与左右垄侧墙壁的距离狭窄,设定T1在0.1s—0.5s之间,此时直接启动驱动程序,驱动电机运动带动车辆前进;

步骤2,移动车辆向前移动时,总定时器从零计时,到达时间T1时,进入定时中断子程序,设置所有超声波发射装置的初始时间为t0,ARM嵌入式控制器经驱动电路控制超声波测距传感器(7)发射超声波,所有超声波发射装置发射完成后,停止发射,返回程序;

步骤3,当超声波测距传感器A(71)、超声波测距传感器B(72)、超声波测距传感器C(73)、超声波测距传感器D(74)、超声波测距传感器E(75)和超声波测距传感器F(76)开始接收到回波时,此处设等待接收超声波时间为T2,考虑到超声波传播速度与狭窄垄间的距离,设定T2在0.02s—0.08s之间,在自主移动车辆的前后方无障碍时,超声波测距传感器C(73)和超声波测距传感器F(76)检测不到回波时,读取时间自动赋值为T2,等待时间结束后,启动外部中断子程序,关闭所有的超声波发射装置中断定时器;读取超声波测距传感器A(71)、超声波测距传感器B(72)、超声波测距传感器C(73)、超声波测距传感器D(74)、超声波测距传感器E(75)和超声波测距传感器F(76)接收到超声波回波后的记录时间分别为t1、t2、t3、t4、t5、t6,6个超声波测距传感器从发射超声波到接收超声波的时间依次分别为(t1-t0)、(t2-t0)、(t3-t0)、(t4-t0)、(t5-t0)、(t6-t0);

为补偿温室温度对超声波在空气中速度的影响,所安装的温度检测模块能实时的检测出当前的温室的温度T,则超声波速度在温室中的传播速度为:步骤4,计算自主移动车辆各超声波测距传感器安装的测量点处与对应垄侧墙壁的距离为:

D1=V×(t1-t0)/2

D2=V×(t2-t0)/2

D3=V×(t3-t0)/2

D4=V×(t4-t0)/2

D5=V×(t5-t0)/2

D6=V×(t6-t0)/2

步骤5,计算自主移动车辆当前的航向偏差ΔX与航向偏角Δθ:

步骤6,在自主移动车辆前超声波测距传感器所测自主移动车辆前测量点与障碍的实际距离大于等于自主移动车辆前测量点与障碍物最小安全距离且后超声波测距传感器所测自主移动车辆后测量点与障碍的实际距离大于等于自主移动车辆后测量点与障碍物最小安全距离情况下,当Δθ=0且ΔX=0时,继续运行左右伺服电机,无需角度调整;而当Δθ≠0或ΔX≠0时,ARM嵌入式控制器通过左右伺服电机驱动器调整左右伺服电机速度,以消除前进的航向偏差与偏角,以自主移动车辆前进方向为基准,且定义Δθ>0时,移动车辆当前方向是向右偏的,移动车辆上的ARM控制器控制左右伺服电机速度进行左转向调整,Δθ<0时,与Δθ>0时情况相反;以自主移动车辆前进方向为基准,且定义ΔX>0时,自主移动车辆重心与右垄靠近,移动车辆需要左移调整,ΔX<0时,与ΔX>0的情况相反;在自主移动车辆前超声波测距传感器所测自主移动车辆前测量点与障碍的实际距离小于自主移动车辆前测量点与障碍物最小安全距离或后超声波测距传感器所测自主移动车辆后测量点与障碍的实际距离大于等于自主移动车辆后测量点与障碍物最小安全距离情况下,ARM嵌入式控制器控制驱动电机停止转动,自主移动车辆垄间准备后退时,在自主移动车辆后退的过程中,超声波检测的方法与自主移动车辆前进时相同;

步骤7,自主移动车辆自身调整完成后,将相关运行状态经无线数传模块反馈到上位机,此时自主移动车辆总定时时间设定为0,返回步骤1。