[发明专利]运输车的方位调整方法和产品在审
申请号: | 202010581474.5 | 申请日: | 2020-06-23 |
公开(公告)号: | CN111897322A | 公开(公告)日: | 2020-11-06 |
发明(设计)人: | 张文君;范小军 | 申请(专利权)人: | 北京旷视机器人技术有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 北京华进京联知识产权代理有限公司 11606 | 代理人: | 乔改利 |
地址: | 100096 北京市海*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 运输车 方位 调整 方法 产品 | ||
1.一种运输车的方位调整方法,其特征在于,所述方法包括:
获取所述运输车在当前区域中当前方位对应的最大旋转角度;
根据所述运输车的当前方位与目标位置之间的当前偏差,确定所述运输车待调整的航向角度;其中,所述目标位置位于所述当前区域内;
根据所述最大旋转角度与所述航向角度之间的大小关系,对所述运输车的方位进行调整。
2.根据权利要求1所述的方法,其特征在于,所述根据所述最大旋转角度与所述航向角度之间的大小关系,对所述运输车的方位进行调整,包括:
当所述航向角度大于所述最大旋转角度时,根据所述最大旋转角度将所运输车的航向调整至调整方向;
根据所述当前偏差和所述运输车的视野范围,对调整至调整方向的所述运输车的横向位置和/或纵向位置进行调整,以使所述运输车运行至所述目标位置。
3.根据权利要求2所述的方法,其特征在于,所述当前偏差包括角度偏差、横向偏差和纵向偏差中的至少一个;所述根据所述最大旋转角度将所运输车的航向调整至调整方向,包括:
根据所述角度偏差和所述最大旋转角度,将所述运输车的航向调整至所述调整方向。
4.根据权利要求3所述的方法,其特征在于,所述根据所述角度偏差和所述最大旋转角度,将所述运输车的航向调整至所述调整方向,包括:
采用公式yawoff=θoff-sign(xoff*yoff)*θlimit确定所述运输车的航向角度yawoff;
其中,xoff为所述横向偏差,yoff为所述纵向偏差,θoff为所述角度偏差,θlimit为所述最大旋转角度。
5.根据权利要求3所述的方法,其特征在于,所述根据所述当前偏差和所述运输车的视野范围,对调整至调整方向的所述运输车的横向位置和/或纵向位置进行调整,以使所述运输车运行至所述目标位置,包括:
根据所述纵向偏差、所述最大旋转角度和所述视野范围,确定所述运输车在所述调整方向上的运行距离;
根据所述运行距离对所述运输车的横向位置和/或纵向位置进行调整,以使所述运输车运行至所述目标位置。
6.根据权利要求5所述的方法,其特征在于,所述根据所述纵向偏差、所述最大旋转角度和所述视野范围确定所述运输车在所述调整方向上的运行距离,包括:
采用公式确定所述运行距离;
其中,span为所述运行距离,yoff为所述纵向偏差,lmax为所述视野范围,θlimit为所述最大旋转角度,a为修正系数。
7.根据权利要求1所述的方法,其特征在于,所述当前偏差包括角度偏差、横向偏差和纵向偏差中的至少一个;所述根据所述最大旋转角度与所述航向角度之间的大小关系,对所述运输车的方位进行调整,包括:
当所述航向角度小于或等于所述最大旋转角度时,根据所述航向角度和所述角度偏差,将所述运输车的航向调整至目标航向;其中,所述目标航向为所述运输车的当前位置指向所述目标位置的方向;
根据所述横向偏差和/或所述纵向偏差,确定所述运输车在所述目标航向的方向上的运行距离,以使所述运输车运行至所述目标位置。
8.根据权利要求7所述的方法,其特征在于,所述根据所述航向角度和所述角度偏差,将所述运输车的航向调整至目标航向,包括:
按照所述角度偏差和所述航向角度之差,将所述运输车的航向调整至所述目标航向。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京旷视机器人技术有限公司,未经北京旷视机器人技术有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010581474.5/1.html,转载请声明来源钻瓜专利网。