[发明专利]货架检测方法及装置、电子设备、存储介质有效
申请号: | 202110682472.X | 申请日: | 2021-06-21 |
公开(公告)号: | CN113253737B | 公开(公告)日: | 2021-10-15 |
发明(设计)人: | 胡立志;卢维;王政;李铭 | 申请(专利权)人: | 浙江华睿科技股份有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02;G06K9/62;G06T7/73 |
代理公司: | 北京乐知新创知识产权代理事务所(普通合伙) 11734 | 代理人: | 江宇 |
地址: | 310051 浙江省杭*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 货架 检测 方法 装置 电子设备 存储 介质 | ||
1.一种货架检测方法,其特征在于,所述方法包括:
移动机器人确定到达货架识别区域后,进行激光扫描,获取反射激光的点云数据;
基于货架的尺寸对所述点云数据进行过滤,并对过滤后的所述点云数据进行聚类;
基于货架的尺寸及其预置的位姿信息,对聚类后的所述点云数据进行过滤;
基于过滤的点云数据聚类形成的点云簇确定货架的第一朝向;将货架腿上的点云数据作为观测值,基于所述货架的第一朝向确定货架腿的第一中心坐标;
依次遍历所有的货架腿,以至少两个货架腿为一组,分别确定其中满足货架尺寸的货架腿组,作为候选货架腿组;具体地,在四个不同的货架腿中任选三个为一组,判断该组中存在两货架腿之间的距离与货架实际长度之差是否小于第三设定阈值,小于第三设定阈值时,判断该组中是否存在两货架腿之间的距离与货架实际宽度之差小于第四设定阈值,若存在,则判断长度所在的两货架腿与宽度所在的两货架腿是否垂直,若垂直,则判断长度及宽度构成的三角形斜边是否与货架的实际斜边长之差小于第五设定阈值,小于第五设定阈值时,对三个货架腿对应的货架中心坐标进行校验,校验通过确定三货架腿满足实际货架腿的位置关系;若四个不同的货架腿中的任三个货架腿满足实际货架腿的位置关系,则该四个货架腿为货架的四条腿;
在所述候选货架腿组中选择与预设货架坐标之差值小于第一设定阈值的货架腿组,利用所选择的货架腿组中的货架腿的第二中心坐标作为观测值,基于所述第一中心坐标估算货架的第三中心坐标和第二朝向;
依据扫描激光的相关位置参数以及所述移动机器人的当前位姿,将货架的所述第三中心坐标转换到世界坐标系下,得到检测的目标点位置;
所述移动机器人切换为里程计导航模式,并依据所述目标点位置驶入货架下方,举起货架并将货架运输至目的地。
2.根据权利要求1所述的方法,其特征在于,所述举起货架并将货架运输至目的地之前,所述方法还包括:
开启所述移动机器人的上视相机,扫描货架上的识别码,通过检测所述上视相机相对于所述识别码的相对位姿,调整所述移动机器人的位置,直到所述相对位姿小于第二设定阈值,停止所述移动机器人的位置调整并记录该相对位姿,调用工作台举起货架。
3.根据权利要求1所述的方法,其特征在于,所述基于货架的尺寸对所述点云数据进行过滤,包括:
确定激光点云与预设货架中心的距离大于第一设定距离时,删除该点云数据。
4.根据权利要求1所述的方法,其特征在于,所述对聚类后的所述点云数据进行过滤,包括:
在聚为一类的点云簇中,距离最远的两个点的距离大于第二设定距离时,删除该点云簇;或
在聚为一类的点云簇中,点云的数量小于第一预设数量或大于第二预设数量时,删除该点云簇;或
在聚为一类的点云簇中,获取每点云簇的第四中心坐标,判断该第四中心坐标与货架的预设中心位置之间的距离第三设定距离时,删除该点云簇。
5.根据权利要求1所述的方法,其特征在于,确定该四个货架腿为货架的四条腿之后,所述方法还包括:
继续遍历除所确定的四条货架腿之外的货架腿,以三个货架腿为一组,判断该组中存在两货架腿之间的距离与货架实际长度之差是否小于第三设定阈值,小于第三设定阈值时,判断该组中是否存在两货架腿之间的距离与货架实际宽度之差小于第四设定阈值,若存在,则判断长度所在的两货架腿与宽度所在的两货架腿是否垂直,若垂直,则判断长度及宽度构成的三角形斜边是否与货架的实际斜边长之差小于第五设定阈值,小于第五设定阈值时,对三个货架腿对应的货架中心坐标进行校验,校验通过确定三货架腿满足实际货架腿的位置关系,该组中的三个货架腿为货架的三条腿;
继续遍历除所确定的四条、三条货架腿之外的货架腿,以两个货架腿为一组,确定两货架腿之间的距离与货架实际长度之差小于第三设定阈值时,进行货架朝向及货架中心坐标的估算及校验,校验通过确定该组中两个货架腿满足实际货架腿的位置关系,该组中的两个货架腿为货架的两条腿。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江华睿科技股份有限公司,未经浙江华睿科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110682472.X/1.html,转载请声明来源钻瓜专利网。