欢迎来到利索能及~ 联系电话:18621327849
利索能及
我要发布
收藏
专利号: 2017111640556
申请人: 浙江工商大学
专利类型:发明专利
专利状态:已下证
专利领域: 道路、铁路或桥梁的建筑
更新日期:2024-10-29
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种利用红外避障的潮汐车道变更机器人,其特征在于:包括A墩(1)、B墩(2)和连接护栏(3),连接护栏(3)的两端分别铰接在A墩(1)的中心轴和B墩(2)的中心轴上;

所述A墩(1)和B墩(2)上均设置有北斗模块(10)、嵌入式控制模块、报警灯(11)、太阳能电池板(19)、铅酸蓄电池(14)、LoRa模块、底盘(16)和外壳(7),嵌入式控制模块通过LoRa模块连接路段控制基站,铅酸蓄电池(14)固定在底盘(16)上,底盘(16)套装在外壳(7)底部,底盘(16)上设置有凸块,外壳(7)底部设置有与底盘(16)上的凸块相配合的凹槽,外壳(7)上还固定有底盘驱动电机(12),底盘驱动电机(12)连接滚珠丝杠,底盘(16)上设置有与所述滚珠丝杠相配合的丝杠螺母,所述丝杠螺母套装在所述滚珠丝杠上,底盘驱动电机(12)带动滚珠丝杠转动时驱动底盘(16)在外壳(7)的底部上下运动;所述外壳(7)上端设置有报警灯(11),外壳(7)的外表面设置有太阳能电池板(19),太阳能电池板(19)通过太阳能充电电路连接铅酸蓄电池(14),所述北斗模块(10)均设置在外壳(7)内部,移动机构和锁定机构均设置在底盘(16)上;

所述A墩(1)和B墩(2)的底盘(16)上均还安装有三个定向轮、一个定向电机、红外线测距仪(8)和测距仪驱动电机(9),三个定向轮包括一个主动轮(18)和两个从动轮(15),定向电机连接主动轮(18)被驱动所述主动轮(18)转动,通过主动轮(18)运动带动A墩(1)或B墩(2)的运动,所述主动轮(18)上安装有增量式编码器(17),出厂时使增量式编码器(17)的零位、隔离墩的运动方向和主动轮(18)的朝向这三个方向保持一致;测距仪驱动电机(9)固定在外壳(7)上,测距仪驱动电机(9)连接红外线测距仪(8)并带动所述红外线测距仪(8)的转动,外壳(7)上开设有水平槽口,连接护栏(3)穿过水平槽口连接中心轴且红外线测距仪(8)透过水平槽口照射到隔离墩外部;

所述A墩(1)和B墩(2)上还安装有电子罗盘(6)和罗盘驱动电机(4),罗盘驱动电机(4)固定在壳体上,罗盘驱动电机(4)连接电子罗盘(6)并驱动电子罗盘(6)在水平面上旋转来校准角度,电子罗盘(6)在转动后根据电子罗盘(6)所在的角度辨别出A墩(1)或B墩(2)所在的角度。

2.一种利用红外避障的潮汐车道变更方法,其特征在于:包括如下步骤:

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

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

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

S4:A墩(1)的罗盘驱动电机(4)启动,带动A墩(1)上的电子罗盘(6)转动一圈,确定A墩(1)的朝向,根据S3步骤中的A墩(1)当前位置和目标位置确定A墩(1)的运动方向,A墩(1)和主动轮(18)之间装有增量式编码器(17),转动主动轮(18)使之回归零位,获得A墩(1)朝向信息和A墩(1)运动方向信息;

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

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

S7:B墩(2)的罗盘驱动电机(4)启动,带动B墩(2)上的电子罗盘(6)转动一圈,确定B墩(2)的朝向,根据S3步骤中的B墩(2)当前位置和目标位置确定B墩(2)的运动方向,B墩(2)和主动轮(18)之间装有增量式编码器(17),转动主动轮(18)使之回归零位,获得B墩(2)朝向信息和B墩(2)运动方向信息;

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

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

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

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

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

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

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