买专利卖专利找龙图腾,真高效! 查专利查商标用IPTOP,全免费!专利年费监控用IP管家,真方便!
申请/专利权人:睿羿科技(山东)有限公司
摘要:本发明属于自动驾驶领域,具体是一种室内未知环境下无人清扫车覆盖作业的方法,包括如下步骤:建立车体坐标系,读取点云数据,提取出线段数据;计算所有线段对应的直线方程;基于线段对应的直线方程计算车体坐标系原点到所有线段的垂足点坐标;根据垂足点坐标以及车辆折返次数N进行线段判断,计算选择出来的线段的长度,筛选出符合要求的线段,计算车体坐标系原点到符合要求线段垂足点的距离,得到离车体最近的线段进行车辆PID角度控制,通过激光雷达获取车辆前方墙体或障碍进行掉头。本发明通过一个单线激光雷达获取到雷达到墙体数据从而无需建立对应的高精度地图,通过激光寻线等距控制规划法实现墙体跟踪控制。
主权项:1.一种室内未知环境下无人清扫车覆盖作业的方法,其特征在于,所述无人清扫车采用阿克曼运动模型,车辆转向角以左转为正值,右转为负值,在车辆后轮轴中心对应的车辆顶部安装单线激光雷达,包括如下步骤:步骤1、以车辆初始前后方向为x轴,左右方向为y轴,前为x轴正值,左为y轴正值,x轴、y轴交点为原点建立车体坐标系,读取单线激光雷达扫描到的右侧墙体点云数据,对点云数据进行处理,提取出线段数据;步骤2、计算所有线段对应的直线方程;步骤3、基于线段对应的直线方程计算车体坐标系原点到所有线段的垂足点坐标;步骤4、根据垂足点坐标以及车辆折返次数N进行线段判断,当折返次数N为奇数时,选择垂足点在车体右边的线段,当折返次数N为偶数的时候,选择垂足点在车体左边的线段;步骤5、计算步骤4中选择出来的线段的长度,筛选出符合要求的线段,然后计算车体坐标系原点到符合要求线段垂足点的距离进一步筛选,最后计算得到离车体最近的线段;步骤6、基于步骤5得到的离车体最近的线段,计算雷达到墙体的实时距离进行车辆PID角度控制,使车辆与墙体保持相对平行行驶;步骤7、通过激光雷达获取车辆前方墙体或障碍进行掉头,实现弓字型覆盖作业。
全文数据:
权利要求:
百度查询: 睿羿科技(山东)有限公司 一种室内未知环境下无人清扫车覆盖作业的方法
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。