CN114918915B - 一种自动扶梯激光识别防跌装置及其算法 - Google Patents
一种自动扶梯激光识别防跌装置及其算法 Download PDFInfo
- Publication number
- CN114918915B CN114918915B CN202210497358.4A CN202210497358A CN114918915B CN 114918915 B CN114918915 B CN 114918915B CN 202210497358 A CN202210497358 A CN 202210497358A CN 114918915 B CN114918915 B CN 114918915B
- Authority
- CN
- China
- Prior art keywords
- escalator
- robot
- laser
- distance
- algorithm
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 claims description 8
- 238000001914 filtration Methods 0.000 claims description 4
- 238000002310 reflectometry Methods 0.000 claims description 3
- 230000002265 prevention Effects 0.000 abstract description 6
- 230000000694 effects Effects 0.000 abstract description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02B—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO BUILDINGS, e.g. HOUSING, HOUSE APPLIANCES OR RELATED END-USER APPLICATIONS
- Y02B50/00—Energy efficient technologies in elevators, escalators and moving walkways, e.g. energy saving or recuperation technologies
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及机器人防跌技术领域,尤指一种自动扶梯激光识别防跌装置及其算法,包括反光板、激光雷达和机器人,所述反光板分别贴在自动扶梯对称的左侧和右侧,所述激光雷达安装在机器人的正前方,所述激光雷达设置的高度与反光板的离地高度相同,所述激光雷达通过扫描周围环境,上报点云数据到机器人导航系统,通过算法处理点云数据,从而远距离识别出自动扶梯并且提前控制机器人停止运行。本发明基于机器人导航系统,采用激光和反光板的组合方式,实现准确无误差识别自动扶梯,并计算出机器人相对扶梯的坐标,通过激光雷达识别反光板达到识别自动扶梯的效果,实现自动扶梯防跌,准确度和精度均有很大提升。
Description
技术领域
本发明涉及机器人防跌技术领域,尤指一种自动扶梯激光识别防跌装置及其算法。
背景技术
现有的机器人防跌技术方案中,对于悬空环境处理一般比较好,但是对于自动扶梯,往往无法处理。若自动扶梯一直处于运行状态,当机器人走到自动扶梯上时,会出现被扶梯带着运行的情况,所以现有的技术方案,无法处理这种情形。
发明内容
为解决上述问题,本发明提供一种动扶梯激光识别防跌装置,可以远距离识别出自动扶梯,实现提前控制机器人停止运行,实现自动防跌。
为实现上述目的,本发明采用的技术方案是:一种自动扶梯激光识别防跌装置,包括反光板、激光雷达和机器人,所述反光板分别贴在自动扶梯对称的左侧和右侧,所述激光雷达安装在机器人的正前方,所述激光雷达设置的高度与反光板的离地高度相同,所述激光雷达通过扫描周围环境,上报点云数据到机器人导航系统,通过算法处理点云数据,计算出激光距离自动扶梯的长度为D1,对D1进行判断,如果D1小于预设数值,则发送控制指令,停止机器人运行,从而实现远距离识别出自动扶梯并且提前控制机器人停止运行。
进一步地,所述反光板为高反射率材质的条形状反光板,并且长度为10cm,宽为5cm,所述反光板分别贴在自动扶梯的左右两侧且间隔为100cm。
其中,所述反光板横向贴在自动扶梯两侧。
进一步地,所述机器人通过算法处理点云数据,并计算出线段L1、L2的长度;如果长度满足L1=L2=10cm,则认为该点云数据为部署的反光板。
进一步地,所述机器人通过算法处理点云数据,分别计算出两块反光板的中心点坐标O1、O2,同时计算出两块反光板中心点O1、O2的间距D和中心点O1、O2的中心坐标O3,如果长度满足D=100cm,则认为当前为自动扶梯。
进一步地,所述机器人通过算法处理点云数据,通过计算机器人当前坐标O和中心点O3坐标的间距,可以获得机器人距离自动扶梯的间距D1,如果间距D1<100cm,则控制机器人停止运行。
还提供一种自动扶梯激光识别防跌算法,包括反光板、激光雷达和机器人,所述反光板分别贴在自动扶梯对称的左侧和右侧,所述激光雷达安装在机器人的正前方,所述激光雷达设置的高度与反光板的离地高度相同,所述激光雷达通过扫描周围环境,上报点云数据到机器人导航系统;其算法逻辑步骤如下:
S1,读取雷达点云数据,使用intensity filter算法对数据进行光强度滤波,提取光强度满足大于240的数据点;
S2,对滤波后点云做line segments算法识别,找出点云中测得距离相同连续的数据点,标记为线段L1、L2;
S3,提取到的线段L1、L2是否满足长度等于10cm,如果线段L1、L2均满足,则认为L1、L2为一组标记物C;
S4,取线段L1中心点O1和线段L2中心点O2,计算O1和O2的间距D,O1和O2的中心点O3,如果间距D等于100cm,则认为当前反光板组合L1、L2为自动扶梯两侧贴的标志物,激光已经检测到自动扶梯;
S5,在机器人系统中可以获得激光当前坐标为O,计算出激光距离自动扶梯的距离D1,对间距D1进行判断,如果间距D1<100cm,则发送控制指令,停止机器人运行。
其中,取线段L1中心点O1(x1,y1)和线段L2中心点O2(x2,y2),计算O1和O2的间距
其中,取O1和O2的中心点O3(x3,y3),当前坐标为O(x,y),计算出激光距离自动扶梯的间距
本发明的有益效果在于:本发明自动扶梯激光识别防跌装置及其算法基于机器人导航系统,采用激光和反光板的组合方式,实现准确无误差识别自动扶梯,并计算出机器人相对扶梯的坐标,通过激光雷达识别反光板达到识别自动扶梯的效果,实现自动扶梯防跌;本发明可以远距离识别到自动扶梯,准确度和精度均有很大提升。
附图说明
图1是本实施例的示意图。
具体实施方式
下面通过具体实施方式结合附图对本发明进一步详细说明。本申请可以以多种不同的形式来实现,并不限于本实施例所描述的实施方式。提供以下具体实施方式的目的是便于对本申请公开内容更清楚透彻的理解,其中上、下、左、右等指示方位的字词仅是针对所示结构在对应附图中位置而言。
请参阅图1所示,本发明关于一种自动扶梯激光识别防跌装置,包括反光板、激光雷达和机器人,所述反光板分别贴在自动扶梯对称的左侧和右侧,所述激光雷达安装在机器人的正前方,所述激光雷达设置的高度与反光板的离地高度相同,所述激光雷达通过扫描周围环境,上报点云数据到机器人导航系统,通过算法处理点云数据,从而远距离识别出自动扶梯并且提前控制机器人停止运行。
在本实施例中,所述反光板为高反射率材质的条形状反光板,并且长度为10cm,宽为5cm的反光板两片,所述反光板分别贴在自动扶梯的左右两侧且间隔为100cm。其中,所述反光板横向贴在自动扶梯两侧,激光雷达选择可以反馈光强度的雷达。
在本实施例中,机器人内部系统的算法逻辑步骤如下:
S1,读取雷达点云数据,普通环境物体反馈强度范围在0-180,反光板的反射强度会大于240,使用intensity filter算法对数据进行光强度滤波,提取光强度满足大于240的数据点;
S2,对滤波后点云做line segments算法识别,找出点云中测得距离相同连续的数据点,标记为线段L1、L2;
S3,提取到的线段L1、L2是否满足长度等于10cm,如果线段L1、L2均满足,则认为线段L1、L2为一组标记物C,认为该点云数据为部署的反光板;
S4,取线段L1中心点O1(x1,y1)和线段L2中心点O2(x2,y2),计算O1和O2的长度O1和O2的中心点O3(x3,y3),如果D等于100cm,则认为当前反光板组合线段L1、L2为自动扶梯两侧贴的标志物,激光已经检测到自动扶梯;
S5,在机器人系统中可以获得激光当前坐标为O(x,y),计算出激光距离自动扶梯的间距对间距D1进行判断,如果间距D1<100cm,则发送控制指令,停止机器人运行。
与现有技术相比,本实施例采用的是激光雷达识别技术,目前单线激光雷达的数据已经非常可靠,在机器人领域运用非常普遍,是本方案的核心传感器,可以远距离识别出自动扶梯,实现提前控制机器人停止运行,实现自动防跌。本实施例基于机器人导航系统,采用激光和反光板的组合方式,实现准确无误差识别自动扶梯,并计算出机器人相对扶梯的坐标,通过激光雷达识别反光板达到识别自动扶梯的效果,实现自动扶梯防跌,准确度和精度均有很大提升。
需要进一步说明的是,除非另有明确的规定和限定,术语“计算”“设置”等术语应做广义理解,对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
以上实施方式仅仅是对本发明的优选实施方式进行描述,并非对本发明的范围进行限定,在不脱离本发明设计精神的前提下,本领域普通工程技术人员对本发明的技术方案作出的各种变形和改进,均应落入本发明的权利要求书确定的保护范围内。
Claims (9)
1.一种自动扶梯激光识别防跌装置,其特征在于:包括反光板、激光雷达和机器人,所述反光板分别贴在自动扶梯对称的左侧和右侧,所述激光雷达安装在机器人的正前方,所述激光雷达设置的高度与反光板的离地高度相同,所述激光雷达通过扫描周围环境,上报点云数据到机器人导航系统,通过算法处理点云数据,其算法逻辑步骤如下:
S1,读取雷达点云数据,使用intensity filter算法对数据进行光强度滤波,提取光强度满足大于240的数据点;
S2,对滤波后点云做l ine segments算法识别,找出点云中测得距离相同连续的数据点,标记为线段L1、L2;
S3,提取到的线段L1、L2是否满足长度等于10cm,如果线段L1、L2均满足,则认为线段L1、L2为一组标记物C;
S4,取线段L1中心点O1和线段L2中心点O2,计算O1和O2的间距D,O1和O2的中心点O3,如果D等于100cm,则认为当前组合线段L1、L2为自动扶梯两侧贴的反光板标志物,激光已经检测到自动扶梯;
S5,在机器人系统中可以获得激光当前坐标为O,计算出激光距离自动扶梯的距离D1,对D1进行判断,如果D1<100cm,则发送控制指令,停止机器人运行。
2.根据权利要求1所述的一种自动扶梯激光识别防跌装置,其特征在于:所述反光板为高反射率材质的条形状反光板,并且长度为10cm,宽为5cm,所述反光板分别贴在自动扶梯的左右两侧且间隔为100cm。
3.根据权利要求2所述的一种自动扶梯激光识别防跌装置,其特征在于:所述反光板横向贴在自动扶梯两侧。
4.根据权利要求1所述的一种自动扶梯激光识别防跌装置,其特征在于:所述机器人通过算法处理点云数据,并计算出线段L1、L2的长度;如果长度满足L1=L2=10cm,则认为该点云数据为部署的反光板。
5.根据权利要求4所述的一种自动扶梯激光识别防跌装置,其特征在于:所述机器人通过算法处理点云数据,分别计算出两块反光板的中心点坐标O1、O2,同时计算出两块反光板中心点O1、O2的间距D和中心点O1、O2的中心点O3,如果间距满足D=100cm,则认为当前为自动扶梯。
6.根据权利要求5所述的一种自动扶梯激光识别防跌装置,其特征在于:所述机器人通过算法处理点云数据,通过计算机器人当前坐标O和中心点O3坐标的间距,可以获得机器人距离自动扶梯的间距D1,如果间距D1<100cm,则控制机器人停止运行。
7.一种自动扶梯激光识别防跌算法,其特征在于:包括反光板、激光雷达和机器人,所述反光板分别贴在自动扶梯对称的左侧和右侧,所述激光雷达安装在机器人的正前方,所述激光雷达设置的高度与反光板的离地高度相同,所述激光雷达通过扫描周围环境,上报点云数据到机器人导航系统;其算法逻辑步骤如下:
S1,读取雷达点云数据,使用intensity filter算法对数据进行光强度滤波,提取光强度满足大于240的数据点;
S2,对滤波后点云做l ine segments算法识别,找出点云中测得距离相同连续的数据点,标记为线段L1、L2;
S3,提取到的线段L1、L2是否满足长度等于10cm,如果线段L1、L2均满足,则认为L1、L2为一组标记物C;
S4,取线段L1中心点O1和线段L2中心点O2,计算O1和O2的间距D,O1和O2的中心点O3,如果D等于100cm,则认为当前组合线段L1、L2为自动扶梯两侧贴的反光板标志物,激光已经检测到自动扶梯;
S5,在机器人系统中可以获得激光当前坐标为O,计算出激光距离自动扶梯的距离D1,对D1进行判断,如果D1<100cm,则发送控制指令,停止机器人运行。
8.根据权利要求7所述的一种自动扶梯激光识别防跌算法,其特征在于:取线段L1中心点O1(x1,y1)和线段L2中心点O2(x2,y2),计算O1和O2的间距
9.根据权利要求7所述的一种自动扶梯激光识别防跌算法,其特征在于:取O1和O2的中心点O3(x3,y3),当前坐标为O(x,y),计算出激光距离自动扶梯的距离
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210497358.4A CN114918915B (zh) | 2022-05-09 | 2022-05-09 | 一种自动扶梯激光识别防跌装置及其算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210497358.4A CN114918915B (zh) | 2022-05-09 | 2022-05-09 | 一种自动扶梯激光识别防跌装置及其算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114918915A CN114918915A (zh) | 2022-08-19 |
CN114918915B true CN114918915B (zh) | 2023-12-12 |
Family
ID=82807735
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210497358.4A Active CN114918915B (zh) | 2022-05-09 | 2022-05-09 | 一种自动扶梯激光识别防跌装置及其算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114918915B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108236549A (zh) * | 2016-12-26 | 2018-07-03 | 丰田自动车株式会社 | 行驶车辆及其控制方法 |
CN109270963A (zh) * | 2018-09-29 | 2019-01-25 | 武汉理工大学 | 一种基于反光布和激光雷达的轮椅自动跟随系统及方法 |
WO2020103533A1 (zh) * | 2018-11-20 | 2020-05-28 | 中车株洲电力机车有限公司 | 一种轨道和道路障碍物检测方法 |
CN113341983A (zh) * | 2021-06-15 | 2021-09-03 | 上海有个机器人有限公司 | 一种用于机器人的自动扶梯自主避让预警方法 |
CN113651221A (zh) * | 2021-07-13 | 2021-11-16 | 日立楼宇技术(广州)有限公司 | 一种机器人搭乘扶梯的方法、装置及存储介质 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20210284504A1 (en) * | 2020-03-16 | 2021-09-16 | Otis Elevator Company | Specialized, personalized & enhanced elevator calling for robots & co-bots |
-
2022
- 2022-05-09 CN CN202210497358.4A patent/CN114918915B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108236549A (zh) * | 2016-12-26 | 2018-07-03 | 丰田自动车株式会社 | 行驶车辆及其控制方法 |
CN109270963A (zh) * | 2018-09-29 | 2019-01-25 | 武汉理工大学 | 一种基于反光布和激光雷达的轮椅自动跟随系统及方法 |
WO2020103533A1 (zh) * | 2018-11-20 | 2020-05-28 | 中车株洲电力机车有限公司 | 一种轨道和道路障碍物检测方法 |
CN113341983A (zh) * | 2021-06-15 | 2021-09-03 | 上海有个机器人有限公司 | 一种用于机器人的自动扶梯自主避让预警方法 |
CN113651221A (zh) * | 2021-07-13 | 2021-11-16 | 日立楼宇技术(广州)有限公司 | 一种机器人搭乘扶梯的方法、装置及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN114918915A (zh) | 2022-08-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105793731A (zh) | 自主移动对象 | |
CN105787192B (zh) | 一种信息处理方法及飞行器 | |
CN107462249B (zh) | 一种基于rfid的室内定位方法、装置及系统 | |
EP2854073A1 (en) | Restraining system including near field RFID detection | |
CN111435164A (zh) | 一种机器人检测障碍的方法及机器人 | |
CN114918915B (zh) | 一种自动扶梯激光识别防跌装置及其算法 | |
CN111413989A (zh) | 基于agv的激光定位系统和方法 | |
CN113650649A (zh) | 轨道列车定位方法及系统 | |
CN111722187B (zh) | 雷达安装参数计算方法以及装置 | |
CN111897278B (zh) | 基于雷达的道闸控制方法及系统 | |
JP5209656B2 (ja) | 車載白線認識装置 | |
KR101812039B1 (ko) | 자율 이동 로봇의 도킹 제어 장치 | |
CN110737276B (zh) | 预警方法、巡逻机器人及计算机可读存储介质 | |
CN104444646A (zh) | 电梯承载对象的重量检测方法和装置、电梯系统 | |
CN207811109U (zh) | 岸桥智能对箱系统 | |
CN112949489A (zh) | 一种道路边界识别方法、装置、电子设备和存储介质 | |
CN108328480A (zh) | 岸桥智能对箱系统及方法 | |
CN116243335A (zh) | 一种基于多视觉传感器的货物倾倒预警系统 | |
KR101185678B1 (ko) | Rfid 인식태그 좌표평균법을 이용한 위치 및 자세 추적 장치 및 방법 | |
CN109443201A (zh) | 一种基于s300激光扫描传感器的栈板识别方法 | |
CN115123897A (zh) | 对象检测方法、装置及设备 | |
CN112285734B (zh) | 基于道钉的港口无人集卡高精度对准方法及其对准系统 | |
JP2022034051A (ja) | 測定装置、測定方法およびプログラム | |
CN113741475A (zh) | 移动机器人充电桩防移动系统和方法 | |
CN211786116U (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 |