CN111538343A - 一种机器人设置交通规则的系统、方法及存储介质 - Google Patents
一种机器人设置交通规则的系统、方法及存储介质 Download PDFInfo
- Publication number
- CN111538343A CN111538343A CN202010570337.1A CN202010570337A CN111538343A CN 111538343 A CN111538343 A CN 111538343A CN 202010570337 A CN202010570337 A CN 202010570337A CN 111538343 A CN111538343 A CN 111538343A
- Authority
- CN
- China
- Prior art keywords
- lane
- robot
- boundary
- point
- area
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 43
- 238000007726 management method Methods 0.000 claims abstract description 18
- 230000004888 barrier function Effects 0.000 claims abstract description 14
- 230000033001 locomotion Effects 0.000 claims abstract description 9
- 238000004364 calculation method Methods 0.000 claims description 15
- 230000008569 process Effects 0.000 claims description 5
- 230000001105 regulatory effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 2
- 238000005034 decoration Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0285—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种机器人设置交通规则的系统、方法和存储介质,通过操作终端在地图上需要设置交通规则的区域设定车道区域及车道分界线,机器人的车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向,将车道分界线及车道分界线两侧的车道区域边界线设置为被占用格栅,并划定逆行方向分界线,设置为被占用格栅,形成障碍图层,机器人的路径规划模块接受障碍图层信息,不会规划路径至被占用格栅,使机器人按照车道方向行驶,不会逆行。本申请能够给移机器人设定交通规则,规定车道行驶方向,且禁止逆行,保证了机器人在复杂场景中工作的安全,提高机器人与行人、叉车等混行的安全性,同时保证了移动机器人路径规划的灵活性。
Description
技术领域
本发明涉及机器人控制技术领域,尤其涉及一种机器人设置交通规则的系统、方法及存储介质。
背景技术
机器人根据传感器实时感知环境,并通过路径算法规划行驶路径。
但是,机器人在实际工作时,多台机器人或者行人、叉车等同时在同一区域运行时,由于混行、逆行等情况容易引发交通堵塞或事故,而实际运行环境一般没有交通管理设备,比如隔离带、护栏等,如果增加交通管理设备,会导致成本增加,并且影响行人、叉车等通行。而现有技术中,针对此类复杂情况没有提供如何制定交通规则的方案。
有鉴于此,特提出本发明。
发明内容
针对上述现有技术中存在的技术问题,本申请的目的在于提供一种机器人设置交通规则的系统、方法及存储介质。
为实现本发明的目的,本发明提出如下技术解决方案:
第一方面,本发明实施例提供了一种机器人设置交通规则的系统,包括:机器人、操作终端,所述机器人和所述操作终端通讯,所述操作终端读取所述机器人的地图信息,通过所述操作终端在地图上需要设置交通规则的区域设定车道区域及车道分界线,将所述车道区域及车道分界线信息发送给所述机器人,
所述机器人还包括车道管理模块和路径规划模块,所述车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向,将所述车道分界线及车道分界线两侧的车道区域边界线设置为被占用格栅,并划定逆行方向分界线,设置为被占用格栅,形成障碍图层,所述路径规划模块接受障碍图层信息,不会规划路径至被占用格栅,使所述机器人按照车道方向行驶,不会逆行。
进一步地,所述机器人还包括处理器、存储器,所述存储器中存储上述系统的程序、数据,所述处理器处理或运行上述系统的程序、数据。
进一步地,所述操作终端包括安装了应用程序的电脑、平板电脑、智能手机等可与所述机器人通讯或连接的设备。
第二方面,本发明实施例还提供了一种机器人设置交通规则的方法,包括以下步骤:
通过操作终端在地图上需要设置交通规则的区域设定车道区域及车道分界线,将所述车道区域及车道分界线信息发送给机器人,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向,将所述车道分界线及车道分界线两侧的车道区域边界线设置为被占用格栅,并划定逆行方向分界线,设置为被占用格栅,形成障碍图层,路径规划模块接受障碍图层信息,不会规划路径至被占用格栅,使所述机器人按照车道方向行驶,不会逆行。
在一种实施例中,通过操作终端在地图上设定需要设置交通规则的车道区域及车道分界线,具体包括,所述操作终端将地图信息绘制在画布上,捕获画布的点击事件,通过捕获点击的两个点作为对角点生成矩形车道区域,通过车道区域的顶点计算获得车道分界线。
进一步地,所述车道区域及所述车道分界线可以根据需要进行编辑,更改区域形状或车道分界线位置。
在一种实施例中,更改区域形状或车道分界线位置,具体包括,通过捕获绘制在画布上的车道区域顶点与车道分界线端点上的移动事件,捕获移动位置,将顶点或端点移动到目标位置。
进一步地,在同一地图上可以设置一个或多个车道区域。
在一种实施例中,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向前,建立以机器人中心为原点的笛卡尔坐标系A,具体包括,以平行于车道分界线的直线为横轴,以垂直于车道分界线的直线为纵轴,通过计算坐标系A相对于地图坐标系的旋转角度确定横轴、纵轴方向,形成笛卡尔坐标系A。
进一步地,计算坐标系A相对于地图坐标系的旋转角度,具体包括:通过计算车道分界线与地图坐标系横轴负方向的夹角,以该夹角作为坐标系A相对于地图坐标系的旋转角度。
在一种实施例中,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向前,进一步还包括,对地图坐标系下的车道区域及车道分界线上的点的坐标值转换为机器人中心为原点的坐标系A下的坐标值。
在一种实施例中,根据机器人中心与车道分界线上的点的位置关系划分车道方向,具体包括:
(1)当机器人在车道区域内部或车道分界线两端所在的车道区域边界线上时,选择车道分界线上的任一点,若该点纵坐标值为正数时,当前车道方向为横轴正方向,若该点纵坐标值为负数时,当前车道方向为横轴负方向;
(2)当机器人在车道区域外部时,选择车道分界线上的任一点,若该点横坐标值为负数时,允许行驶的车道方向为横轴负方向,若该点横坐标值为正数时,允许行驶的车道方向为横轴正方向,该种情况划分车道方向需配合逆行方向分界线使用,方可实现机器人靠其中一侧行驶,保证不会逆行;
(3)当机器人位于车道分界线上或者车道分界线两侧的车道区域边界线上时,将机器人手动推离或遥控驶离车道分界线或者车道分界线两侧的车道区域边界线后,机器人再根据在车道区域内部、车道区域外部的情况进行车道方向划分。
在一种实施例中,划定逆行方向分界线,具体包括:
(1)当机器人在车道区域内部时,选择车道分界线上距离机器人最近的点P0,在车道分界线逆行方向上选择距离点P0预定距离的点T0,以该点T0为基准点,做垂直于车道分界线的直线与当前车道区域相交,取机器人所在一侧车道区域边线的交点S0,S0与T0点连成的线段为逆行方向分界线;当所述预定距离大于P0点与车道分界线逆行方向端点形成的线段的距离时,即机器人距离逆行方向车道区域边界较近,或位于车道分界线两端所在的车道区域边界线上,视为在车道区域内部,则取当前车道区域内车道分界线上逆行方向的端点R1,以及距离R1点最近的且非机器人所在一侧区域的顶点Q0,Q0与R1连成的线段,为逆行方向分界线,保证机器人的可通过性;
(2)当机器人在车道区域外部时,选择离机器人最近的两个车道区域分别计算,选择该车道区域内车道分界线上离机器人最近的端点R0,若该点R0的横坐标值为负数时,选择R0点所在的车道区域距离R0最近且纵坐标值较小的顶点Q0,R0与Q0形成的线段,为逆行方向分界线;若该点R0的横坐标值为正数时,选择R0点所在的车道区域距离R0最近且纵坐标值较大的顶点Q0,R0与Q0形成的线段,为逆行方向分界线;若地图上仅有一个车道区域,则选择1个车道区域进行上述计算。
进一步地,在车道分界线逆行方向上选择距离点P0预定距离的点T0,所述预定距离根据实际应用进行预先设置或修改。
进一步地,所述车道方向及逆行方向分界线可以根据实际应用选择或修改,
例如,所述车道方向可以根据如下方式选择或修改:
(1)当机器人在车道区域内部时,选择车道分界线上的任一点,若该点纵坐标值为正数时,当前车道方向为横轴负方向,若该点纵坐标值为负数时,当前车道方向为横轴正方向;
(2)当机器人在车道区域外部时,选择车道分界线上的任一点,若该点横坐标值为负数时,允许行驶的车道方向为横轴正方向,若该点横坐标值为正数时,允许行驶的车道方向为横轴负方向;
(3)当机器人位于车道分界线上或者车道分界线两侧的车道区域边界线上时,将机器人手动推离或遥控驶离车道分界线或者车道分界线两侧的车道区域边界线后,机器人再根据在车道区域内部、车道区域外部的情况进行车道方向划分;
所述逆行方向分界线根据如下方式选择或修改:
(1)当机器人在车道区域内部时,选择车道分界线上距离机器人最近的点P0’,在车道分界线逆行方向上选择距离点P0’预定距离的点T0’,以该点T0’为基准点,做垂直于车道分界线的直线与当前车道区域相交,取机器人所在一侧车道区域边线的交点S0’,S0’与T0’点连成的线段为逆行方向分界线;当所述预定距离大于P0’点与车道分界线逆行方向端点形成的线段的距离时,即机器人距离逆行方向车道区域边界较近,或位于车道分界线两端所在的车道区域边界线上,视为在车道区域内部,则取当前车道区域内车道分界线上逆行方向的端点R1’,以及距离R1’点最近的且非机器人所在一侧区域的顶点Q0’,Q0’与R1’连成的线段,为逆行方向分界线,保证机器人的可通过性;
(2)当机器人在车道区域外部时,选择离机器人最近的两个车道区域分别计算,选择该车道区域内车道分界线上离机器人最近的端点R0’,若该点R0’的横坐标值为负数时,选择R0’点所在的车道区域距离R0’最近且纵坐标值较大的顶点Q0’,R0’与Q0’形成的线段,为逆行方向分界线;若该点R0’的横坐标值为正数时,选择R0’点所在的车道区域距离R0’最近且纵坐标值较小的顶点Q0’,R0’与Q0’形成的线段,为逆行方向分界线;若地图上仅有一个车道区域,则选择1个车道区域进行上述计算。
第三方面,本发明实施例还提供了一种机器人设置交通规则的存储介质,包括计算机可读存储介质,存储上述设置交通规则的系统、方法的程序和数据。
与现有技术相比,本发明利用上述系统、方法及存储介质,具有如下优势或有益效果:
本发明提出的机器人设置交通规则的方案,给机器人设定运行的交通规则,在地图上需要设置交通规则的区域设定车道区域及车道分界线,规定车道行驶方向,且禁止逆行,保证了机器人在复杂场景中工作的安全,提高机器人与行人、叉车等混行的安全性,同时保证了机器人路径规划的灵活性。
附图说明
图1所示为本申请实施例1的设置交通规则的系统示意图;
图2所示为本申请实施例2的设置交通规则的方法的流程图;
图3所示为本申请实施例2建立机器人中心为原点的笛卡尔坐标系的示意图;
图4所示为本申请实施例2划分车道区域及车道分界线的示意图;
图5所示为本申请实施例2机器人在车道区域内部一种划分车道方向的示意图;
图6所示为本申请实施例2机器人在车道区域内部另一种划分车道方向的示意图;
图7所示为本申请实施例2机器人在车道区域外部一种划分车道方向的示意图;
图8所示为本申请实施例2机器人在车道区域外部另一种划分车道方向的示意图;
图9所示为本申请实施例2机器人在车道区域内部一种划分逆行方向分界线的示意图;
图10所示为本申请实施例2机器人在车道区域内部另一种划分逆行方向分界线的示意图;
图11所示为本申请实施例2机器人在车道区域外部时划分逆行方向分界线的示意图。
具体实施方式
以下结合附图和具体实施例对本发明作进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
应当说明的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本申请的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用属于“包含”和/ 或“包括”时,其指明存在特征、步骤、操作、部件或者模块、组件和/ 或它们的组合。
为了方便描述,术语“第1”“第2”等仅用于描述目的,而不能理解为指示或暗示或技术特征的特定数量,“首”“末”等不能理解为指示或暗示的技术特征的特定顺序。
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
应当理解,本发明的方案可以通过硬件、软件或其他设备单个或多个组合实现,在以下实施例的说明中,本发明的方法及步骤可以通过储存在存储介质中包括但不限于硬盘、可移动存储设备、磁盘、光盘等来实现。
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
实施例1
如图1所示,本发明实施例提供了一种机器人设置交通规则的系统,包括:机器人1、操作终端2,所述机器人1和所述操作终端2通讯,所述操作终端2读取所述机器人1的地图信息,通过所述操作终端2在地图上需要设置交通规则的区域设定车道区域及车道分界线,将所述车道区域及车道分界线信息发送给所述机器人1,
需要说明的是,所述机器人1还包括车道管理模块11和路径规划模块12,所述车道管理模块11根据根据机器人1中心与车道分界线上的点的位置关系划分车道方向,将所述车道分界线及车道分界线两侧的车道区域边界线设置为被占用格栅,并划定逆行方向分界线,设置为被占用格栅,形成障碍图层,所述路径规划模块12接受障碍图层信息,不会规划路径至被占用格栅,使所述机器人1按照车道方向行驶,不会逆行。
进一步地,所述机器人1还包括处理器14、存储器13,所述存储器13中存储上述系统的程序、数据,所述处理器14处理或运行上述系统的程序、数据,处理器14、存储器13可以为1个或多个。
进一步地,所述操作终端2包括安装了应用程序的电脑、平板电脑、智能手机等可与所述机器人1通讯或连接的设备。
实施例2
如图2所示,与上述系统相应地,本发明实施例还提供了一种机器人设置交通规则的方法,包括以下步骤:
通过操作终端在地图上需要设置交通规则的区域设定车道区域及车道分界线,将所述车道区域及车道分界线信息发送给机器人,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向,将所述车道分界线及车道分界线两侧的车道区域边界线设置为被占用格栅,并划定逆行方向分界线,设置为被占用格栅,形成障碍图层,路径规划模块接受障碍图层信息,不会规划路径至被占用格栅,使所述机器人按照车道方向行驶,不会逆行。
进一步地,如图4所示,通过操作终端在地图上设定需要设置交通规则的车道区域及车道分界线,具体包括,所述操作终端将地图信息绘制在画布上,捕获画布的点击事件,通过捕获点击的两个点作为对角点生成矩形车道区域,通过车道区域的顶点计算获得车道分界线,步骤如下:
(1)车道区域的第1、第3点为捕获点击,第2点、第3点的坐标值通过计算获得,如下:
第2点的横坐标P2_x = P3_x(第3点横坐标),纵坐标P2_y = P1_y(第1点纵坐标);
第4点的横坐标P4_x = P1_x(第1点横坐标),纵坐标P4_y = P3_y(第3点纵坐标);
(2)通过车道区域的坐标值计算获得车道分界线的首点、末点坐标值,如下:
车道分界线首点的横坐标Pstart_x = P4_x,纵坐标Pstart_y = (P4_y + P1_y)/2;
末点的横坐标Pend_x = P3_x, 纵坐标Pend_y = (P3_y + P2_y)/2
通过以上计算,将获得的端点P1、P2、P3、P4、Pstart、Pend绘制在画布上,发送给机器人。
进一步地,所述车道区域及所述车道分界线可以根据需要进行编辑,更改区域形状或车道分界线位置。
进一步地,更改区域形状或车道分界线位置,具体包括,通过捕获绘制在画布上的车道区域顶点与车道分界线端点上的移动事件,捕获移动位置,将顶点或端点移动到目标位置。
进一步地,在同一地图上可以设置一个或多个车道区域。
进一步地,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向前,建立以机器人中心为原点的笛卡尔坐标系A,具体包括,以平行于车道分界线的直线为横轴,以垂直于车道分界线的直线为纵轴,,通过计算车道分界线与地图坐标系横轴负方向的夹角θ,地图坐标系逆时针旋转角度θ,形成笛卡尔坐标系A。
进一步地,计算坐标系A相对于地图坐标系的旋转角度,具体包括:通过计算车道分界线与地图坐标系横轴负方向的夹角,以该夹角作为坐标系A相对于地图坐标系的旋转角度,按如下公式一进行计算:
其中,θ为车道分界线与地图坐标系横轴负方向的夹角,pstart_x、pstart_y为车道分界线首点在地图坐标系下的横坐标、纵坐标值,pend_x、pend_y为车道分界线末点在地图坐标系下的横坐标、纵坐标值。
需要说明的是,本技术领域的技术人员应当理解,在其他实施方式中,可以选择车道分界线与地图坐标系横轴正方向、纵轴负方向或纵轴正方向的夹角作为坐标系A相对于地图坐标系的旋转角度,从而确定横轴、纵轴的方向,该种实施方式可获得相似的实施效果,本方案选择的车道分界线与地图坐标系横轴负方向的夹角作为旋转角度,便于后续计算,为本方案的优选方式,其他实施方式相应的技术方案在本发明的基础上本领域技术人员容易获得,应视为本发明的保护范围,在此不做详细说明描述。
进一步地,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向前,进一步还包括,对地图坐标系下的车道区域及车道分界线上的点的坐标值转换为机器人中心为原点的坐标系A下的坐标值,按如下公式二、公式三转换:
其中,out.x为转换后的横坐标值,out.y为转换后的纵坐标值,x0为机器人相对于地图坐标系的横坐标值,y0为机器人相对于地图坐标系的纵坐标值,in.x为地图坐标系下的待转换点的横坐标值,in.y为地图坐标系下的待转换点的纵坐标值,θ为车道分界线与地图坐标系横轴负方向的夹角。
进一步地,根据机器人中心与车道分界线上的点的位置关系划分车道方向,具体包括:
(1)当机器人在车道区域内部或车道分界线两端所在的车道区域边界线上时,选择车道分界线上的任一点,优选地,选择车道分界线上距离机器人最近的点P0,若该点P0纵坐标值为正数时,当前车道方向为横轴正方向,若该点P0纵坐标值为负数时,当前车道方向为横轴负方向;
(2)当机器人在车道区域外部时,选择车道分界线上的任一点,优选地,选择车道分界线上距离机器人最近的端点R0,若该点R0横坐标值为负数时,允许行驶的车道方向为横轴负方向,若该点R0横坐标值为正数时,允许行驶的车道方向为横轴正方向,该种情况划分车道方向需配合逆行方向分界线使用,方可实现机器人靠其中一侧行驶,保证不会逆行;
(3)当机器人位于车道分界线上或者车道分界线两侧的车道区域边界线上时,将机器人手动推离或遥控驶离车道分界线或者车道分界线两侧的车道区域边界线后,机器人再根据在车道区域内部、车道区域外部的情况进行车道方向划分。
进一步地,划定逆行方向分界线,具体包括:
(1)当机器人在车道区域内部时,选择车道分界线上距离机器人最近的点P0,在车道分界线逆行方向上选择距离点P0预定距离的点T0,以该点T0为基准点,做垂直于车道分界线的直线与当前车道区域相交,取机器人所在一侧车道区域边线的交点S0,S0与T0点连成的线段为逆行方向分界线;当所述预定距离大于P0点与车道分界线逆行方向端点形成的线段的距离时,即机器人距离逆行方向车道区域边界较近,或位于车道分界线两端所在的车道区域边界线上,视为在车道区域内部,则取当前车道区域内车道分界线上逆行方向的端点R1,以及距离R1点最近的且非机器人所在一侧区域的顶点Q0,Q0与R1连成的线段,为逆行方向分界线,保证机器人的可通过性;
(2)当机器人在车道区域外部时,选择离机器人最近的两个车道区域分别计算,选择该车道区域内车道分界线上离机器人最近的端点R0,若该点R0的横坐标值为负数时,选择R0点所在的车道区域距离R0最近且纵坐标值较小的顶点Q0,R0与Q0形成的线段,为逆行方向分界线;若该点R0的横坐标值为正数时,选择R0点所在的车道区域距离R0最近且纵坐标值较大的顶点Q0,R0与Q0形成的线段,为逆行方向分界线;若地图上仅有一个车道区域,则选择1个车道区域进行上述计算。
进一步地,在车道分界线逆行方向上选择距离点P0预定距离的点T0,所述预定距离根据实际应用进行预先设置或修改。
进一步地,所述车道方向及逆行方向分界线可以根据实际应用选择或修改,本领域技术人员能够理解,可以根据实际需要选择车道方向,例如,可以按照如下方式确定:
(1)当机器人在车道区域内部或车道分界线两端所在的车道区域边界线上时,选择车道分界线上的任一点,选择车道分界线上距离机器人最近的点P0’,若该点P0’纵坐标值为正数时,当前车道方向为横轴负方向,若该点P0’纵坐标值为负数时,当前车道方向为横轴正方向;
(2)当机器人在车道区域外部时,选择车道分界线上的任一点,选择车道分界线上距离机器人最近的端点R0’,若该点R0’横坐标值为负数时,允许行驶的车道方向为横轴正方向,若该点R0’横坐标值为正数时,允许行驶的车道方向为横轴负方向,该种情况划分车道方向需配合逆行方向分界线使用,方可实现机器人靠其中一侧行驶,保证不会逆行;
(3)当机器人位于车道分界线上或者车道分界线两侧的车道区域边界线上时,将机器人手动推离或遥控驶离车道分界线或者车道分界线两侧的车道区域边界线后,机器人再根据在车道区域内部、车道区域外部的情况进行车道方向划分;
相应地,与上述对应的划定逆行方向分界线的方法,按照如下步骤确定:
(1)当机器人在车道区域内部时,选择车道分界线上距离机器人最近的点P0’,在车道分界线逆行方向上选择距离点P0’预定距离的点T0’,以该点T0’为基准点,做垂直于车道分界线的直线与当前车道区域相交,取机器人所在一侧车道区域边线的交点S0’,S0’与T0’点连成的线段为逆行方向分界线;当所述预定距离大于P0’点与车道分界线逆行方向端点形成的线段的距离时,即机器人距离逆行方向车道区域边界较近,或位于车道分界线两端所在的车道区域边界线上,视为在车道区域内部,则取当前车道区域内车道分界线上逆行方向的端点R1’,以及距离R1’点最近的且非机器人所在一侧区域的顶点Q0’,Q0’与R1’连成的线段,为逆行方向分界线,保证机器人的可通过性;
(2)当机器人在车道区域外部时,选择离机器人最近的两个车道区域分别计算,选择该车道区域内车道分界线上离机器人最近的端点R0’,若该点R0’的横坐标值为负数时,选择R0’点所在的车道区域距离R0’最近且纵坐标值较大的顶点Q0’,R0’与Q0’形成的线段,为逆行方向分界线;若该点R0’的横坐标值为正数时,选择R0’点所在的车道区域距离R0’最近且纵坐标值较小的顶点Q0’,R0’与Q0’形成的线段,为逆行方向分界线。若地图上仅有一个车道区域,则选择1个车道区域进行上述计算;
按照上述方法确定的车道方向以及逆行方向分界线同样可以使机器人按照规定的方向行驶,且不会逆行,获得相似的实施效果,上述方法应视为本发明的保护范围。
相应地,本发明实施例还提供了一种机器人设置交通规则的存储介质,包括计算机可读存储介质,存储上述设置交通规则的系统、方法的程序和数据,存储介质可以为一个或多个。
以上所述仅是本发明的优选实施方式,应当指出的是,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (17)
1.一种机器人设置交通规则的系统,其特征在于,包括:机器人、操作终端,所述机器人和所述操作终端通讯,所述操作终端读取所述机器人的地图信息,通过所述操作终端在地图上需要设置交通规则的区域设定车道区域及车道分界线,将所述车道区域及车道分界线信息发送给所述机器人,
所述机器人还包括车道管理模块和路径规划模块,所述车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向,将所述车道分界线及车道分界线两侧的车道区域边界线设置为被占用格栅,并划定逆行方向分界线,设置为被占用格栅,形成障碍图层,所述路径规划模块接受障碍图层信息,不会规划路径至被占用格栅,使所述机器人按照车道方向行驶,不会逆行。
2.根据权利要求1所述的一种机器人设置交通规则的系统,其特征在于,所述机器人还包括处理器、存储器,所述存储器中存储根据权利要求1所述系统的程序、数据,所述处理器处理或运行根据权利要求1所述系统的程序、数据。
3.根据权利要求1所述的一种机器人设置交通规则的系统,其特征在于,所述操作终端包括安装了应用程序的电脑、平板电脑、智能手机等可与所述机器人通讯或连接的设备。
4.一种机器人设置交通规则的方法,其特征在于,包括以下步骤:
通过操作终端在地图上需要设置交通规则的区域设定车道区域及车道分界线,将所述车道区域及车道分界线信息发送给机器人,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向,将所述车道分界线及车道分界线两侧的车道区域边界线设置为被占用格栅,并划定逆行方向分界线,设置为被占用格栅,形成障碍图层,路径规划模块接受障碍图层信息,不会规划路径至被占用格栅,使所述机器人按照车道方向行驶,不会逆行。
5.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,通过操作终端在地图上设定需要设置交通规则的车道区域及车道分界线,具体包括,所述操作终端将地图信息绘制在画布上,捕获画布的点击事件,通过捕获点击的两个点作为对角点生成矩形车道区域,通过车道区域的顶点计算获得车道分界线。
6.根据权利要求5所述的一种机器人设置交通规则的方法,其特征在于,所述车道区域及所述车道分界线可以根据需要进行编辑,更改区域形状或车道分界线位置。
7.根据权利要求6所述的一种机器人设置交通规则的方法,其特征在于,更改区域形状或车道分界线位置,具体包括,通过捕获绘制在画布上的车道区域顶点与车道分界线端点上的移动事件,捕获移动位置,将顶点或端点移动到目标位置。
8.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,在同一地图上可以设置一个或多个车道区域。
9.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向前,建立以机器人中心为原点的笛卡尔坐标系A,具体包括,以平行于车道分界线的直线为横轴,以垂直于车道分界线的直线为纵轴,通过计算坐标系A相对于地图坐标系的旋转角度确定横轴、纵轴方向,形成笛卡尔坐标系A。
10.根据权利要求9所述的一种机器人设置交通规则的方法,其特征在于,计算坐标系A相对于地图坐标系的旋转角度,具体包括:通过计算车道分界线与地图坐标系横轴负方向的夹角,以该夹角作为坐标系A相对于地图坐标系的旋转角度。
11.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,车道管理模块根据机器人中心与车道分界线上的点的位置关系划分车道方向前,进一步还包括,对地图坐标系下的车道区域及车道分界线上的点的坐标值转换为机器人中心为原点的坐标系A下的坐标值。
12.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,根据机器人中心与车道分界线上的点的位置关系划分车道方向,具体包括:
(1)当机器人在车道区域内部或车道分界线两端所在的车道区域边界线上时,选择车道分界线上的任一点,若该点纵坐标值为正数时,当前车道方向为横轴正方向,若该点纵坐标值为负数时,当前车道方向为横轴负方向;
(2)当机器人在车道区域外部时,选择车道分界线上的任一点,若该点横坐标值为负数时,允许行驶的车道方向为横轴负方向,若该点横坐标值为正数时,允许行驶的车道方向为横轴正方向;
(3)当机器人位于车道分界线上或者车道分界线两侧的车道区域边界线上时,将机器人手动推离或遥控驶离车道分界线或者车道分界线两侧的车道区域边界线后,机器人再根据在车道区域内部、车道区域外部的情况进行车道方向划分。
13.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,划定逆行方向分界线,具体包括:
(1)当机器人在车道区域内部时,选择车道分界线上距离机器人最近的点P0,在车道分界线逆行方向上选择距离点P0预定距离的点T0,以该点T0为基准点,做垂直于车道分界线的直线与当前车道区域相交,取机器人所在一侧车道区域边界线的交点S0,S0与T0点连成的线段为逆行方向分界线;当所述预定距离大于P0点与车道分界线逆行方向端点形成的线段的距离时,即机器人距离逆行方向车道区域边界线较近,或位于车道分界线两端所在的车道区域边界线上,视为在车道区域内部,则取当前车道区域内车道分界线上逆行方向的端点R1,以及距离R1点最近的且非机器人所在一侧区域的顶点Q0,Q0与R1连成的线段,为逆行方向分界线,保证机器人的可通过性;
(2)当机器人在车道区域外部时,选择离机器人最近的两个车道区域分别计算,选择该车道区域内车道分界线上离机器人最近的端点R0,若该点R0的横坐标值为负数时,选择R0点所在的车道区域距离R0最近且纵坐标值较小的顶点Q0,R0与Q0形成的线段,为逆行方向分界线;若该点R0的横坐标值为正数时,选择R0点所在的车道区域距离R0最近且纵坐标值较大的顶点Q0,R0与Q0形成的线段,为逆行方向分界线,若地图上仅有一个车道区域,则选择1个车道区域进行上述计算。
14.根据权利要求13所述的一种机器人设置交通规则的方法,其特征在于,在车道分界线逆行方向上选择距离点P0预定距离的点T0,所述预定距离根据实际应用进行预先设置或修改。
15.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,所述车道方向及逆行方向分界线可以根据实际应用选择或修改。
16.根据权利要求4所述的一种机器人设置交通规则的方法,其特征在于,所述车道方向根据如下方式选择或修改:
(1)当机器人在车道区域内部或车道分界线两端所在的车道区域边界线上时,选择车道分界线上的任一点,若该点纵坐标值为正数时,当前车道方向为横轴负方向,若该点纵坐标值为负数时,当前车道方向为横轴正方向;
(2)当机器人在车道区域外部时,选择车道分界线上的任一点,若该点横坐标值为负数时,允许行驶的车道方向为横轴正方向,若该点横坐标值为正数时,允许行驶的车道方向为横轴负方向;
(3)当机器人位于车道分界线上或者车道分界线两侧的车道区域边界线上时,将机器人手动推离或遥控驶离车道分界线或者车道分界线两侧的车道区域边界线后,机器人再根据在车道区域内部、车道区域外部的情况进行车道方向划分;
所述逆行方向分界线根据如下方式选择或修改:
(1)当机器人在车道区域内部时,选择车道分界线上距离机器人最近的点P0’,在车道分界线逆行方向上选择距离点P0’预定距离的点T0’,以该点T0’为基准点,做垂直于车道分界线的直线与当前车道区域相交,取机器人所在一侧车道区域边线的交点S0’,S0’与T0’点连成的线段为逆行方向分界线;当所述预定距离大于P0’点与车道分界线逆行方向端点形成的线段的距离时,即机器人距离逆行方向车道区域边界较近,或位于车道分界线两端所在的车道区域边界线上,视为在车道区域内部,则取当前车道区域内车道分界线上逆行方向的端点R1’,以及距离R1’点最近的且非机器人所在一侧区域的顶点Q0’,Q0’与R1’连成的线段,为逆行方向分界线,保证机器人的可通过性;
(2)当机器人在车道区域外部时,选择离机器人最近的两个车道区域分别计算,选择该车道区域内车道分界线上离机器人最近的端点R0’,若该点R0’的横坐标值为负数时,选择R0’点所在的车道区域距离R0’最近且纵坐标值较大的顶点Q0’,R0’与Q0’形成的线段,为逆行方向分界线;若该点R0’的横坐标值为正数时,选择R0’点所在的车道区域距离R0’最近且纵坐标值较小的顶点Q0’,R0’与Q0’形成的线段,为逆行方向分界线;若地图上仅有一个车道区域,则选择1个车道区域进行上述计算。
17.一种机器人设置交通规则的存储介质,其特征在于,包括计算机可读存储介质,存储根据权利要求1所述的一种机器人设置交通规则的系统、权利要求4-16任一所述的一种机器人设置交通规则的方法的程序和数据。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010570337.1A CN111538343B (zh) | 2020-06-22 | 2020-06-22 | 一种机器人设置交通规则的系统、方法及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010570337.1A CN111538343B (zh) | 2020-06-22 | 2020-06-22 | 一种机器人设置交通规则的系统、方法及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111538343A true CN111538343A (zh) | 2020-08-14 |
CN111538343B CN111538343B (zh) | 2020-09-25 |
Family
ID=71978341
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010570337.1A Active CN111538343B (zh) | 2020-06-22 | 2020-06-22 | 一种机器人设置交通规则的系统、方法及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111538343B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112284393A (zh) * | 2020-10-23 | 2021-01-29 | 苏州大学 | 一种智能移动机器人全局路径规划方法和系统 |
CN113485378A (zh) * | 2021-08-18 | 2021-10-08 | 昆山市工研院智能制造技术有限公司 | 基于交通规则的移动机器人路径规划方法、系统及存储介质 |
CN115326057A (zh) * | 2022-08-31 | 2022-11-11 | 深圳鹏行智能研究有限公司 | 路径规划方法、装置、机器人以及可读存储介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103324192A (zh) * | 2012-03-23 | 2013-09-25 | 苏州宝时得电动工具有限公司 | 边界设置方法及边界设置系统 |
US20140129027A1 (en) * | 2012-11-02 | 2014-05-08 | Irobot Corporation | Simultaneous Localization And Mapping For A Mobile Robot |
CN106774335A (zh) * | 2017-01-03 | 2017-05-31 | 南京航空航天大学 | 基于多目视觉和惯导的导引装置、地标布局及导引方法 |
CN107063242A (zh) * | 2017-03-24 | 2017-08-18 | 上海思岚科技有限公司 | 具虚拟墙功能的定位导航装置和机器人 |
CN108983763A (zh) * | 2017-06-05 | 2018-12-11 | 上海汽车集团股份有限公司 | 一种路径规划的方法、装置及车载终端 |
CN109213163A (zh) * | 2018-09-06 | 2019-01-15 | 青岛港国际股份有限公司 | 自动化码头qctp作业中agv路径优化方法和系统 |
CN109813325A (zh) * | 2017-11-22 | 2019-05-28 | 通用汽车环球科技运作有限责任公司 | 可行车道路线规划 |
CN110806731A (zh) * | 2019-10-22 | 2020-02-18 | 上海木蚁机器人科技有限公司 | 一种多台agv协作方法、系统、agv及可读存储介质 |
CN110986951A (zh) * | 2019-12-11 | 2020-04-10 | 广州市技田信息技术有限公司 | 一种基于惩罚权重的路径规划方法、导航格以及栅格地图 |
-
2020
- 2020-06-22 CN CN202010570337.1A patent/CN111538343B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103324192A (zh) * | 2012-03-23 | 2013-09-25 | 苏州宝时得电动工具有限公司 | 边界设置方法及边界设置系统 |
US20140129027A1 (en) * | 2012-11-02 | 2014-05-08 | Irobot Corporation | Simultaneous Localization And Mapping For A Mobile Robot |
CN106774335A (zh) * | 2017-01-03 | 2017-05-31 | 南京航空航天大学 | 基于多目视觉和惯导的导引装置、地标布局及导引方法 |
CN107063242A (zh) * | 2017-03-24 | 2017-08-18 | 上海思岚科技有限公司 | 具虚拟墙功能的定位导航装置和机器人 |
CN108983763A (zh) * | 2017-06-05 | 2018-12-11 | 上海汽车集团股份有限公司 | 一种路径规划的方法、装置及车载终端 |
CN109813325A (zh) * | 2017-11-22 | 2019-05-28 | 通用汽车环球科技运作有限责任公司 | 可行车道路线规划 |
CN109213163A (zh) * | 2018-09-06 | 2019-01-15 | 青岛港国际股份有限公司 | 自动化码头qctp作业中agv路径优化方法和系统 |
CN110806731A (zh) * | 2019-10-22 | 2020-02-18 | 上海木蚁机器人科技有限公司 | 一种多台agv协作方法、系统、agv及可读存储介质 |
CN110986951A (zh) * | 2019-12-11 | 2020-04-10 | 广州市技田信息技术有限公司 | 一种基于惩罚权重的路径规划方法、导航格以及栅格地图 |
Non-Patent Citations (2)
Title |
---|
夏茂栩: "叉车式多AGV的路径规划", 《CNKI》 * |
李狮伟: "船用汽轮机智能车间AGV动态调度与路径规划研究", 《CNKI》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112284393A (zh) * | 2020-10-23 | 2021-01-29 | 苏州大学 | 一种智能移动机器人全局路径规划方法和系统 |
WO2022083292A1 (zh) * | 2020-10-23 | 2022-04-28 | 苏州大学 | 一种智能移动机器人全局路径规划方法和系统 |
CN113485378A (zh) * | 2021-08-18 | 2021-10-08 | 昆山市工研院智能制造技术有限公司 | 基于交通规则的移动机器人路径规划方法、系统及存储介质 |
CN113485378B (zh) * | 2021-08-18 | 2024-01-16 | 昆山市工研院智能制造技术有限公司 | 基于交通规则的移动机器人路径规划方法、系统及存储介质 |
CN115326057A (zh) * | 2022-08-31 | 2022-11-11 | 深圳鹏行智能研究有限公司 | 路径规划方法、装置、机器人以及可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN111538343B (zh) | 2020-09-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111538343B (zh) | 一种机器人设置交通规则的系统、方法及存储介质 | |
CN111103887B (zh) | 一种基于多传感器的多移动机器人调度系统设计方法 | |
CN111813101B (zh) | 机器人路径规划方法、装置、终端设备及存储介质 | |
CN110874102A (zh) | 一种移动机器人虚拟安全防护区域保护系统以及方法 | |
CN109318899B (zh) | 自动驾驶车辆的弯道行驶方法、装置、设备和存储介质 | |
CN106681331A (zh) | 一种基于测地线理论的栅格路径规划方法 | |
Wang et al. | Two 4D models effective in reducing false alarms for struck-by-equipment hazard prevention | |
CN109683617A (zh) | 一种自动驾驶方法、装置及电子设备 | |
CN111750860A (zh) | 往返式路径规划方法、装置及电子设备 | |
CN113793534B (zh) | 一种确定车路协同环境下行车风险场的方法和装置 | |
CN114326713A (zh) | 基于二维码导航的多agv移动机器人路径优化方法 | |
CN113485378A (zh) | 基于交通规则的移动机器人路径规划方法、系统及存储介质 | |
CN111427331B (zh) | 无人驾驶车辆的感知信息展示方法、装置和电子设备 | |
CN115962787B (zh) | 地图更新、自动驾驶控制方法、设备、介质及车辆 | |
WO2023174096A1 (zh) | 自主移动机器人的调度方法、系统、电子设备和存储介质 | |
CN112362063A (zh) | 基于碰撞类型划分的多机器人路径规划方法和系统 | |
CN113822995B (zh) | 移动设备导航地图的创建方法、装置及存储介质 | |
CN115416693A (zh) | 一种基于时空走廊的自动驾驶轨迹规划方法及系统 | |
CN112445220B (zh) | 自动导引车的控制方法及装置、存储介质及电子设备 | |
CN115496312A (zh) | 车辆调度方法、装置、计算机设备和存储介质 | |
CN114518760B (zh) | 一种基于风险区管理的无人车导航方法以及系统服务器 | |
CN207027520U (zh) | 一种机械臂移动路径规划系统 | |
CN115562296B (zh) | 一种基于混合控制策略的机器人调度方法、系统及装置 | |
CN112747752A (zh) | 基于激光里程计的车辆定位方法、装置、设备和存储介质 | |
CN112154395A (zh) | 飞行控制方法、系统、无人飞行器及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: A system, method and storage medium for robot to set traffic rules Effective date of registration: 20221129 Granted publication date: 20200925 Pledgee: China Construction Bank Corporation Tianjin Development Branch Pledgor: TIANJIN ALLIANS TECHNOLOGY CO.,LTD. Registration number: Y2022980023935 |
|
PE01 | Entry into force of the registration of the contract for pledge of patent right |