[发明专利]自动导航方法、服务器及存储介质在审
| 申请号: | 201910153571.1 | 申请日: | 2019-02-28 |
| 公开(公告)号: | CN111624990A | 公开(公告)日: | 2020-09-04 |
| 发明(设计)人: | 占兆武;周严伟;谢恺;罗为 | 申请(专利权)人: | 富华科精密工业(深圳)有限公司 |
| 主分类号: | G05D1/02 | 分类号: | G05D1/02 |
| 代理公司: | 深圳市赛恩倍吉知识产权代理有限公司 44334 | 代理人: | 杨毅玲;汪飞亚 |
| 地址: | 518109 广东省深圳市龙华区龙华*** | 国省代码: | 广东;44 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 自动 导航 方法 服务器 存储 介质 | ||
1.一种自动导航方法,应用于服务器中,所述服务器与至少一自动引导车通信连接,其特征在于,该方法包括:
接收安装在所述自动引导车的车轮上的车轮编码器在所述自动引导车行驶过程中反馈回来的脉冲数量;
根据所述脉冲数量和所述自动引导车在k时刻的位姿信息计算所述自动引导车在k+1时刻的位姿信息,其中,所述位姿信息包括航向角信息和位置信息;
根据所述自动引导车在k+1时刻的位姿信息和预存在服务器中的虚拟路径上的参考点信息生成控制指令以控制所述自动引导车在导航空间内对应的虚拟路径上行走。
2.如权利要求1所述的自动导航方法,其特征在于,所述根据所述脉冲数量和所述自动引导车在k时刻的位姿信息计算所述自动引导车在k+1时刻的位姿信息包括:
计算所述脉冲数量获取所述自动引导车行驶一段距离后的右轮行驶的距离dR和左轮行驶的距离dL;
根据所述右轮行驶的距离dR和左轮行驶的距离dL之间的距离差得到自动引导车的航向角偏移,其中,R是瞬时曲率中心半径,l是左右轮之间的横向距离;
根据所述航向角偏移计算所述自动引导车在k时刻的航向角偏移Δθk,并得到所述自动引导车在k+1时刻的航向角为θk+1=θk+Δθk;
根据所述自动引导车在k时刻的位置与在k+1时刻的位置之间的欧式距离Dk,k+1和所述自动引导车在k时刻的位置信息(xk,yk),得到所述自动引导车在k+1时刻的位置信息(xk+1,yk+1),其中,其中,所述Δθk为所述自动引导车在k时刻的航向角偏移,所述θk为所述自动引导车在k时刻的航向角。
3.如权利要求2所述的自动导航方法,其特征在于,所述右轮行驶的距离dR=de·NR,所述左轮行驶的距离dL=de·NL,其中,NR为安装在右轮的车轮编码器反馈回来的脉冲数量,NL为安装在左轮的车轮编码器反馈回来的脉冲数量,de为车轮编码器的每个脉冲所代表的路径距离。
4.如权利要求3所述的自动导航方法,其特征在于,所述车轮编码器的每个脉冲所代表的路径距离de通过以下公式计算得到:
其中,N0所述车轮编码器的总共脉冲数,r为所述自动引导车的左轮和右轮的半径。
5.如权利要求2所述的自动导航方法,其特征在于,所述自动引导车在k时刻的位置与在k+1时刻的位置之间的欧式距离Dk,k+1通过以下公式计算得到:
其中,Rk为所述自动引导车在k时刻的瞬时曲率中心半径,Δθk为所述自动引导车在k时刻的航向角偏移。
6.如权利要求5所述的自动导航方法,其特征在于,所述自动引导车在k时刻的航向角偏移Δθk通过以下公式计算得到:
其中,dR,k=de·NR,k表示所述自动引导车的右轮在k时刻行驶的距离,dL,k=de·NL,k表示所述自动引导车的左轮在k时刻行驶的距离。
7.如权利要求6所述的自动导航方法,其特征在于,所述自动引导车在k时刻的瞬时曲率中心半径Rk通过以下公式计算得到:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于富华科精密工业(深圳)有限公司,未经富华科精密工业(深圳)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910153571.1/1.html,转载请声明来源钻瓜专利网。
- 上一篇:智能终端显示装置及智能终端
- 下一篇:一种图像数据处理方法及设备





