[发明专利]反光信标夹角误差补偿方法、自动行走设备以及存储介质在审
申请号: | 201911163982.5 | 申请日: | 2019-11-25 |
公开(公告)号: | CN112947396A | 公开(公告)日: | 2021-06-11 |
发明(设计)人: | 崔江伟;韩奎 | 申请(专利权)人: | 苏州科瓴精密机械科技有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 苏州威世朋知识产权代理事务所(普通合伙) 32235 | 代理人: | 沈晓敏 |
地址: | 215000 江*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 反光 信标 夹角 误差 补偿 方法 自动 行走 设备 以及 存储 介质 | ||
1.一种反光信标夹角误差补偿方法,其特征在于,包括:
当自动行走设备在第一方向匀速直线运动时,获取激光转台从静止状态旋转至第m圈起始位置时的旋转时长Tsync,其中,整数m≥6;
根据旋转时长Tsync,通过第一信标角度误差补偿公式,计算出第一信标角度的补偿角度值,其中,第一信标角度误差补偿公式为自动行走设备在第一方向匀速直线运动时第一信标角度关于激光转台旋转时长的函数公式,第一信标角度为第一反光信标发出的激光反射信号与自动行走设备行走方向之间的夹角。
2.根据权利要求1所述的反光信标夹角误差补偿方法,其特征在于,步骤“根据旋转时长Tsync,通过第一信标角度误差补偿公式,计算出第一信标角度的补偿角度值”具体包括:
获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长Tcom;
计算第一信标角度的补偿时长Tfinal=Tsync+Tcom;
根据补偿时长Tfinal,通过第一信标角度误差补偿公式,计算出第一信标角度的最终补偿角度值。
3.根据权利要求1所述的反光信标夹角误差补偿方法,其特征在于,在步骤“根据旋转时长Tsync,通过第一信标角度误差补偿公式,计算出第一信标角度的补偿角度值”之前,所述方法还包括:
当自动行走设备在第一方向匀速直线运动时,获取激光转台实际测得的第一信标角度An以及相应的激光转台实际旋转时长Tn,其中,n为激光转台的旋转圈数序号。
4.根据权利要求3所述的反光信标夹角误差补偿方法,其特征在于,在步骤“当自动行走设备在第一方向匀速直线运动时,获取激光转台实际测得的第一信标角度An以及相应的激光转台实际旋转时长Tn,其中,n为激光转台的旋转圈数序号”之后,所述方法还包括:
根据至少两组数据(An,Tn),通过最小二乘法拟合公式,计算得到关于第一信标角度的误差补偿公式。
5.根据权利要求3所述的反光信标夹角误差补偿方法,其特征在于,在步骤“当自动行走设备在第一方向匀速直线运动时,获取激光转台实际测得的第一信标角度An以及相应的激光转台实际旋转时长Tn,其中,n为激光转台的旋转圈数序号”之后,所述方法还包括:
根据至少两组数据(An,Tn),通过加权最小二乘法拟合公式,计算得到关于第一信标角度的误差补偿公式。
6.根据权利要求5所述的反光信标夹角误差补偿方法,其特征在于,步骤“根据至少两组数据(An,Tn),通过加权最小二乘法拟合公式,计算得到关于第一信标角度的误差补偿公式”具体包括:
获取第一信标角度信号从自动行走设备的激光信号处理模块传输至自动行走设备的定位计算模块的通讯时长Tcom;
计算第一信标角度的补偿时长Tfinal=Tsync+Tcom;
获取实际旋转时长Tn与补偿时长Tfinal之间的时间差t1;
计算权重系数其中,β为大于零的常数;
根据至少两组数据(An,Tn)与权重系数c,通过加权最小二乘法公式,计算得到关于第一信标角度的误差补偿公式。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于苏州科瓴精密机械科技有限公司,未经苏州科瓴精密机械科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911163982.5/1.html,转载请声明来源钻瓜专利网。
- 上一篇:光学部件驱动装置、照相机装置以及电子设备
- 下一篇:一种环保型路灯