[发明专利]一种基于车体位姿的作业部件末端位姿测量方法有效

专利信息
申请号: 202110188180.0 申请日: 2021-02-18
公开(公告)号: CN112987069B 公开(公告)日: 2021-11-26
发明(设计)人: 胡炼;赖桑愉;何杰;罗锡文;陈高隆;黄浩;刘海龙;高锐涛 申请(专利权)人: 华南农业大学
主分类号: G01S19/53 分类号: G01S19/53
代理公司: 广州市华学知识产权代理有限公司 44245 代理人: 付茵茵
地址: 510642 广*** 国省代码: 广东;44
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 一种 基于 车体 作业 部件 末端 测量方法
【权利要求书】:

1.一种基于车体位姿的作业部件末端位姿测量方法,其特征在于:包括如下步骤:

a、将姿态传感器安装于车体或与车体刚性连接的载体平台上,测量车体姿态;

b、将GNSS系统中的卫星天线安装于车体顶部,测量车体的位姿信息;或将激光传感安装于车体或载体平台上,测量基于基准作业面的相对位置信息;

c、建立车体坐标系Oxyz,以车体前进方向为y轴,x轴与y轴垂直指向车体方向的右侧,z轴垂直于x、y轴向上;

d、在各个执行机构安装传感器,检测执行机构的姿态变化以及位置变化,并建立作业部件坐标系Oxnynzn,n=1,2...;

e、获取卫星天线或激光传感的位置信息,获取车体姿态信息,获取执行机构的姿态信息及位置变化量,建立基于所获取信息及执行机构几何关系求解作业部件末端中心的位置解算模型,并计算获得作业部件末端中心坐标;

f、测量作业部件的姿态信息并推算作业部件末端的姿态信息;

g、设计基准作业面,结合所求的作业部件末端位姿信息计算作业部件末端与基准作业面的高程差Δh,以及作业部件末端与基准作业面的角度差Δα;

步骤e中,根据卫星天线的位置信息、车体姿态信息和各执行机构的姿态信息及位置变化量,建立GNSS坐标解算模型,解算作业部件末端三维坐标,GNSS坐标解算模型如下:

其中,n=1,2,...;r表示作业部件末端中心的三维坐标;p表示卫星天线的位置信息;ψ,θ分别为车体偏航角、横滚角和俯仰角;β12,......,βn为各执行机构上姿态传感器测量值;l1,l2,......,ln为各执行机构上位移传感器测量值;

解算作业部件末端三维坐标步骤如下:

(1)测量车体及执行机构的角度与长度信息和卫星天线至车体质心位置的坐标增量,输入GNSS坐标解算模型;

(2)换算车体姿态角;

(3)计算车身姿态旋转矩阵;

(4)根据几何关系或机器人运动学及所测量的各执行机构姿态信息与位置变化量,解算基于车体坐标系的作业部件末端中心的位置信息;

(5)计算卫星天线至作业部件末端中心的坐标增量;

(6)结合步骤(5)及卫星天线的位置信息,计算作业部件末端中心的三维坐标;

或步骤e中,根据激光传感的位置信息、车体姿态信息和各执行机构的姿态信息及位置变化量,建立激光高程解算模型,求解作业部件末端中心的高程信息,激光高程解算模型如下:

其中,n=1,2,...;H表示作业部件末端中心相对于基准作业面的相对位置信息;hp表示激光接收器相对于基准作业面的相对高程;ψ,θ分别为车体偏航角、横滚角和俯仰角;β12,......,βn为各执行机构上姿态传感器测量值;l1,l2,......,ln为各执行机构上位移传感器测量值;

作业部件末端中心高程解算步骤如下:

(1)测量车体及执行机构的角度与长度信息和激光接收器至车体或载体平台姿态传感器安装位置的Z轴坐标增量,输入激光高程解算模型;

(2)计算车体姿态旋转矩阵;

(3)根据几何关系或机器人运动学及所测量的各执行机构姿态信息与位置变化量,解算基于车体坐标系的作业部件末端中心的坐标Z轴分量;

(4)计算激光接收器至作业部件末端中心的Z轴坐标增量;

(5)结合步骤(4)及激光传感的位置信息,计算作业部件末端中心相对于基准作业面的相对位置信息。

2.按照权利要求1所述的一种基于车体位姿的作业部件末端位姿测量方法,其特征在于:步骤b中,GNSS系统用于计算偏航角ψ及空间位置坐标。

3.按照权利要求1所述的一种基于车体位姿的作业部件末端位姿测量方法,其特征在于:步骤d中,根据执行机构的运动需求,传感器选择姿态传感器或位移传感器。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于华南农业大学,未经华南农业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/202110188180.0/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code