欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2017111641116
申请人: 浙江工商大学
专利类型:发明专利
专利状态:已下证
专利领域: 道路、铁路或桥梁的建筑
更新日期:2024-12-26
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种使用超声波避障的潮汐车道变更方法,其特征在于:包括如下步骤:

S1:控制潮汐车道的信号灯,使潮汐车道入口处的信号灯转换为红灯,并启动第一组车道变更机器人;

S2:A墩(1)和B墩(3)分别进行上电初始化,并判断自身是否存在故障,故障判断包括蓄电池电量是否够用的判断、北斗模块(10)是否能够定位的判断、无线传输模块是否能正常传递信息以及隔离墩内所有的电机是否能够正常工作;若A墩(1)或B墩(3)存在故障,则对存在故障的A墩(1)或B墩(3)进行重启后再对该隔离墩进行故障判断,若A墩(1)或B墩(3)仍存在故障,则将存在故障的A墩(1)或B墩(3)的故障信息传递给路段控制基站,并点亮该隔离墩的警报灯,不对该隔离墩进行移动;若A墩(1)和B墩(3)均不存在故障,则判断A墩(1)和B墩(3)可以进行移动,并进入S3步骤;

S3:A墩(1)和B墩(3)分别获取目标位置信息,并将当前位置与目标位置的连接划分成若干份,每份的长度为10cm,获取划分后的分段目标位置信息;A墩(1)和B墩(3)以轮流运动每次运动10cm的方式向目标位置移动;

S4:A墩(1)和连接护栏(2)的连接处安装角度传感器(5),并且A墩(1)和B墩(3)的顶部安装有北斗模块(10),通过北斗模块(10)确定A墩(1)和B墩(3)的绝对位置,由此可以得知连接护栏(2)相对于地面的绝对位置和绝对角度,通过角度传感器(5)得知连接护栏(2)和A墩(1)的相对角度,再将其与连接护栏(2)的绝对角度结合得出A墩(1)相对于地面的相对角度和A墩(1)相对于地面的绝对角度,根据S3步骤中的A墩(1)当前位置和目标位置确定A墩(1)的运动方向,A墩(1)和主动轮之间装有增量式编码器(17),转动主动轮(18)使之回归零位,获得A墩(1)朝向信息和A墩(1)运动方向信息;

S5:A墩(1)首先打开自身的报警灯(11)并进行障碍判断,障碍判断的方式为超声波测距法,在A墩(1)每次运动前,B墩(3)上的超声波测距仪(8)沿连接护栏(2)的方向正对A墩(1),检测时向潮汐车道方向转动B墩(3)上的测距仪驱动电机(9),使B墩(3)上的超声波测距仪(8)的朝向与连接护栏(2)呈5度,在B墩(3)上的超声波测距仪(8)发射出声波后进行障碍判断,连接护栏(2)的长度为S,若测距仪转动电机转动的过程中超声波测距仪(8)测得的距离始终大于 则判断超声波测距仪(8)发出的声波并未被遮挡,即A墩(1)的运动路径上有一段10cm长的行程并无障碍,进入S6步骤中;若测距仪转动电机转动的过程中超声波测距仪(8)测得的距离出现过小于 的情况,则判断超声波测距仪(8)发出的声波被阻挡过,则延时3s后再次对A墩(1)进行障碍判断;

S6:松开A墩(1)和B墩(3)的锁定装置,转动A墩(1)上的定向电机带动主动轮(18)转动,使A墩(1)直接朝向目标位置运动;A墩(1)在定向电机的驱动下向分段目标位置方向进行直线运动,A墩(1)的运动距离为10cm,控制电机使A墩(1)直线运动10cm,在A墩(1)运动时,B墩(3)保持自由的跟随状态,在A墩(1)移动完10cm后,A墩(1)通过北斗模块(10)确定当前自身的当前位置信息,并将当前位置信息与步骤S5中获得的第一个分段位置信息进行对比,若A墩(1)的当前位置信息与第一个分段位置信息相重合,则A墩(1)运动到分段位置后关闭报警灯(11)并锁紧锁定装置,若A墩(1)的当前位置信息与第一个分段位置信息不重合,则A墩(1)继续运动直至A墩(1)的当前位置信息与第一个分段位置信息相重合;

S7:B墩(3)和连接护栏的连接处安装角度传感器(5),并且A墩(1)和B墩(3)的顶部安装有北斗模块(18),通过北斗模块(18)确定A墩(1)和B墩(3)的绝对位置,由此可以得知连接护栏(2)相对于地面的绝对位置和绝对角度,通过角度传感器(5)得知连接护栏和B墩(3)的相对角度,再将其与连接护栏的绝对角度结合得出B墩(3)相对于地面的相对角度和B墩(3)相对于地面的绝对角度,根据S3步骤中的B墩(3)当前位置和目标位置确定B墩(3)的运动方向,B墩(3)和主动轮之间装有增量式编码器(17),转动主动轮(18)使之回归零位,获得B墩(3)朝向信息和B墩(3)运动方向信息;

S8:在B墩(3)每次运动前,A墩(1)上的超声波测距仪(8)沿连接护栏(2)的方向直射到B墩(3)上,检测时向潮汐车道方向转动A墩(1)上的测距仪驱动电机(9),使A墩(1)上的超声波测距仪(8)的朝向与连接护栏(2)呈5度,在A墩(1)上的超声波测距仪(8)发射出声波后进行障碍判断,若测距仪驱动电机(9)转动的过程中超声波测距仪(8)测得的距离始终大于则判断超声波测距仪(8)发出的声波并未被遮挡,即B墩(3)的运动路径上有一段行程并无障碍,进入S8步骤中;若测距仪转动电机转动的过程中超声波测距仪(8)测得的距离出现过小于 的情况,则判断超声波测距仪(8)发出的声波被阻挡过,则延时3s后再次对B墩(3)进行障碍判断;

S9:转动B墩(3)上的定向电机带动主动轮(18)转动,使B墩(3)直接朝向目标位置运动;

B墩(3)在定向电机的驱动下向分段目标位置方向进行直线运动,B墩(3)的运动距离为

10cm,控制电机使B墩(3)直线运动10cm,在B墩(3)运动时,B墩(3)保持自由的跟随状态,在B墩(3)移动完10cm后,B墩(3)通过北斗模块(10)确定当前自身的当前位置信息,并将当前位置信息与步骤S5中获得的第一个分段位置信息进行对比,若B墩(3)的当前位置信息与第一个分段位置信息相重合,则B墩(3)运动到分段位置后关闭报警灯(11)并锁紧锁定装置,若B墩(3)的当前位置信息与第一个分段位置信息不重合,则B墩(3)继续运动直至B墩(3)的当前位置信息与第一个分段位置信息相重合;

S10:路段控制基站向A墩(1)和B墩(3)依次发送剩下的分段位置信息,并重复上述S5~S9步骤,直至A墩(1)和B墩(3)均达到目标位置,完成一组车道变更机器人的移动;

S11:第一组隔离墩组的移动完成后,剩下的隔离墩组依次重复上述S3~S10步骤,直至所有的隔离墩组均移动到潮汐车道的另一侧;

S12:控制潮汐车道的信号灯,使其新的入口方向为绿灯,完成整个潮汐车道的变换过程。