[发明专利]斜坡检测方法及驱动设备、存储介质在审
申请号: | 202110529067.4 | 申请日: | 2021-05-14 |
公开(公告)号: | CN113093218A | 公开(公告)日: | 2021-07-09 |
发明(设计)人: | 不公告发明人 | 申请(专利权)人: | 汤恩智能科技(苏州)有限公司 |
主分类号: | G01S17/88 | 分类号: | G01S17/88;G01C9/00 |
代理公司: | 上海华诚知识产权代理有限公司 31300 | 代理人: | 肖华 |
地址: | 215163 江苏省苏州市高新区嘉*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 斜坡 检测 方法 驱动 设备 存储 介质 | ||
1.一种斜坡检测方法,应用于包括单线激光雷达的驱动设备,其特征在于,包括:
获取所述单线激光雷达探测障碍物得到的第一坐标值,其中所述第一坐标值参考所述单线激光雷达的坐标系确定;
对所述第一坐标值进行坐标转换得到第二坐标值,其中所述第二坐标值参考所述驱动设备的坐标系确定;
基于所述第二坐标值确定所述障碍物是否为斜坡。
2.根据权利要求1所述的方法,其特征在于,所述基于所述第二坐标值确定所述障碍物是否为斜坡,包括:
对所述第二坐标值中的z轴坐标值大于预设高度阈值所对应纵坐标值的点确定为障碍物点;
基于所述障碍物点进行线性拟合;
在所述线性拟合结果符合预设拟合条件的情况下,确定所述障碍物为斜坡。
3.根据权利要求2所述的方法,其特征在于,所述方法还包括:
在所述障碍物为斜坡的情况下,基于所述线性拟合结果确定所述斜坡的坡度或坡角。
4.根据权利要求1至3中任一项所述的方法,其特征在于,所述对所述第一坐标值进行坐标转换得到第二坐标值,包括:
基于所述第一坐标值转换坐标系得到第三坐标值,其中所述第一坐标值参考所述单线激光雷达的极坐标系确定,所述第三坐标值参考所述单线激光雷达的笛卡尔坐标系确定;
基于所述第三坐标值和预设的坐标变换矩阵进行坐标转换,得到所述第二坐标值。
5.根据权利要求4所述的方法,其特征在于:所述单线激光雷达的坐标系包括以所述单线激光雷达的激光发射点作为坐标原点的坐标系;
所述驱动设备的坐标系包括以所述驱动设备的后轮连接轴中心点作为坐标原点的坐标系。
6.根据权利要求5所述的方法,其特征在于:所述单线激光雷达的坐标系包括以所述单线激光雷达的激光发射点作为坐标原点的极坐标系、以及以所述单线激光雷达的激光发射点作为原点的笛卡尔坐标系;
所述第一坐标值为以所述激光发射点作为坐标原点的极坐标系下的极坐标值;
所述第三坐标值为以所述激光发射点作为坐标原点的笛卡尔坐标系下的笛卡尔坐标值。
7.根据权利要求5所述的方法,其特征在于:所述驱动设备的坐标系包括以所述驱动设备的后轮连接轴中心点作为坐标原点的笛卡尔坐标系;
所述第二坐标值为以所述后轮连接轴中心点作为坐标原点的笛卡尔坐标系下的笛卡尔坐标值。
8.根据权利要求4所述的方法,其特征在于,所述坐标变换矩阵基于所述单线激光雷达的激光发射点与所述设备的后轮连接轴中心点之间的相对位置、以及所述单线激光雷达的激光扫描平面相对于所述设备的底面或侧面的偏转角度确定。
9.根据权利要求8所述的方法,其特征在于:基于所述第三坐标值和预设的坐标变换矩阵,得到所述第二坐标值,包括:
基于所述第三坐标值乘以所述坐标变换矩阵,得到所述第二坐标值。
10.根据权利要求4所述的方法,其特征在于,所述线性拟合包括直线拟合,所述拟合条件包括直线拟合误差阈值以及拟合直线斜率阈值,所述线性拟合结果符合预设拟合条件包括:
在所述直线拟合的拟合误差值小于所述直线拟合误差阈值,并且所述拟合直线的斜率大于所述拟合直线斜率阈值的情况下,确定所述线性拟合结果符合预设拟合条件。
11.一种驱动设备,其特征在于,包括:处理器,存储器、单线激光雷达、通信接口和通信总线;
所述单线激光雷达、所述存储器和所述通信接口通过所述通信总线连接;
所述存储器用于存储至少一个指令,当所述处理器执行所述存储器存储的所述至少一个指令时,使所述驱动设备执行权利要求1至10中任一项所述的斜坡检测方法。
12.一种计算机可读存储介质,其特征在于,所述存储介质上存储有指令,所述指令在计算机上执行时使所述计算机执行权利要求1至10中任一项所述的斜坡检测方法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于汤恩智能科技(苏州)有限公司,未经汤恩智能科技(苏州)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110529067.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:轴类零件圆弧处加工检验工装
- 下一篇:一种煤矿井下自动化瓦斯防爆系统及方法