姿态自适应的剪抛式茶芽智能采摘末端执行器及采摘方法

摘要: 本发明涉及茶叶采摘,具体地说是一种姿态自适应的剪抛式茶芽智能采摘末端执行器及采摘方法。背景技术:1、茶叶的逐芽采收是制作名优茶的首要环节,对嫩芽的外形、色泽、完...
姿态自适应的剪抛式茶芽智能采摘末端执行器及采摘方法

本发明涉及茶叶采摘,具体地说是一种姿态自适应的剪抛式茶芽智能采摘末端执行器及采摘方法。

背景技术:

1、茶叶的逐芽采收是制作名优茶的首要环节,对嫩芽的外形、色泽、完整性以及避免损伤方面均有极高要求。然而,田间茶叶嫩芽生长密集、目标尺寸小且形态不规则,导致茶芽在空间中的姿态多样。在此条件下,采用一步到位的点对点式采摘方式,极易受到茶芽姿态变化、树干及老叶遮挡因素的干扰,从而造成采摘失败。现有茶叶采摘末端执行器多采用固定姿态作业,其作业组件所形成的采摘平面相对基准位姿固定不变,难以适应茶芽生长姿态多样、空间取向不规则的实际情况。尤其对于非标准y型的姿态复杂的嫩芽,因采摘平面无法与芽叶实际空间取向有效对准,极易导致漏采、误切或芽叶损伤,严重制约了机械化采摘的成功率与采收品质。

技术实现思路

1、本发明的目的在于提供一种姿态自适应的剪抛式茶芽智能采摘末端执行器及采摘方法,用于解决因采摘平面无法与芽叶实际空间取向有效对准,极易导致漏采、误切或芽叶损伤的问题;在确保采摘成功率的前提下,通过设计差异化的采摘控制流程,兼顾采收效率与作业质量。

2、本发明解决其技术问题所采取的技术方案是:一种姿态自适应的剪抛式茶芽智能采摘末端执行器,包括末端外壳、水平旋转关节、摆抛关节、剪切关节、电源和控制单元,所述末端外壳与采摘机械臂固定连接,所述水平旋转关节包括旋转电机和末端执行器壳体,所述旋转电机固定在末端外壳内,所述末端执行器壳体固定在旋转电机输出端;所述摆抛关节包括俯仰电机、啮合齿轮组和断柄支架,所述俯仰电机位于末端执行器壳体内,所述断柄支架与末端执行器壳体转动连接,所述啮合齿轮组位于俯仰电机输出端和断柄支架之间用于传递俯仰电机扭矩至断柄支架,所述剪切关节包括剪切电机和对称设置的两个断柄装置,所述剪切电机固定在断柄支架上,所述断柄装置的安装端与断柄支架转动连接,所述剪切电机驱使两断柄装置做反向旋转,所述剪切关节和断柄支架构成末端执行机构;所述电源和控制单元均设置在末端外壳内,所述电源为控制单元和各电机提供电能,所述控制单元用于接收上位机下发的末端控制指令,并按照设定的时序逻辑向各电机输出驱动控制信号。

3、进一步地,所述啮合齿轮组包括大齿轮和小齿轮,其中所述大齿轮与俯仰电机输出端固定连接,所述小齿轮与断柄支架固定连接,所述断柄支架通过小齿轮的齿轮轴与末端执行器壳体转动连接。

4、进一步地,所述断柄装置的安装端为齿形结构,所述断柄装置的剪切端具有刀刃,两所述断柄装置的安装端啮合配合,所述剪切电机的输出端与其中一个断柄装置的安装端固定连接。

5、本发明还提供一种姿态可调节的剪-抛式茶叶采摘方法,包括以下步骤:

6、s1茶叶关键点检测。

7、对茶芽关键部位进行精细化标注:茶芽顶部b为单芽顶端呈尖锥状的嫩芽生长点;茶芽侧叶顶部l为伴随单芽生长的侧叶尖端部位;芽叶交叉点i为嫩芽主体与侧生叶片的相交部位;茶芽采摘点p为符合采摘标准的茶芽基部断茎部位。

8、s2茶芽空间姿态估计。

9、基于关键点检测结果,结合视觉模块获取的深度与点云数据,通过坐标系对齐与空间向量化运算,将茶芽抽象为包括采摘姿态偏转角的数学模型。

10、s3差异化采摘。

11、依据采摘姿态偏转角,判断茶芽空间取向相对于基准方向的偏差程度,将茶芽划分为标准y型与非标准y型,标准y型为姿态规则、朝向相对稳定的茶芽,非标准y型为朝向不规则、分叉结构复杂的茶芽;根据芽茶类型,采取对应的采摘方式实施采摘工作。

12、进一步地,步骤s1中,构建面向采摘作业的关键点标注数据集,并利用labelstudio标注工具对茶芽关键部位进行精细化标注。

13、进一步地,步骤s1中,基于yolov11-pose基线网络,改进提出gcyp-pose检测模型,具体改进包括:在c3k2模块后引入局部-全局特征融合模块glmixblock模块,通过融合不同尺度与维度的特征信息,增强模型在检测与姿态估计的多任务场景下的特征共享与表征能力;采用广义高效特征金字塔网络,重构yolov11-pose基线网络neck部分;将原检测头替换为轻量级共享卷积检测头lscd,通过自动交互机制充分挖掘多尺度特征图的互补信息,实现高效的跨尺度特征融合,增强对不同生长尺度茶芽的适应性。

14、进一步地,步骤s2包括如下子步骤:s2.1利用关键点检测网络定位茶芽关键部位在图像平面的坐标,并通过关键点映射,获取其在相机坐标系下关键点的三维空间坐标;s2.2以茶芽采摘点为原点建立局部坐标系,以为空间坐标的原点,三个互相正交的坐标轴x、y和z从原点向外延伸,形成茶芽自身空间坐标系x-y-z,在点云中构建三个核心特征向量:,,;是由原点指向侧叶的特征向量,反应侧叶的向外伸展程度;是由原点指向顶芽的特征向量,反应顶芽的绝对生长方向;向量由原点指向采摘点,的反方向表示茶芽理想采摘点的所在区域;s2.3将核心特征向量映射至机器人基座坐标系(x,y, z)中,形成参数化数学模型。

15、进一步地,步骤s3包括如下子步骤:

16、s3.1末端执行机构处于复位张开姿态,水平旋转关节归零,摆抛关节归零,剪切关节的两断柄装置张开至预设角度,等待采摘指令。

17、s3.2控制单元根据视觉检测结果,获取茶芽的采摘姿态偏转角和采摘平面旋转角空间姿态参数,依据姿态参数,控制单元决定是否驱动水平旋转关节与摆抛关节进行角度预调整,使末端执行机构的采摘平面旋转至与茶芽实际空间取向相适应的方向;若不需要调整,直接执行步骤s3.3。

18、s3.3采摘末端执行器根据视觉检测结果获取目标茶芽的采摘点位置信息,机械臂带动末端执行机构进行精对准,确保剪切点与目标采摘点精确重合;对准后,剪切关节迅速闭合,完成剪切动作。

19、s3.4剪切动作完成后,剪切关节保持闭合以夹持芽叶,水平旋转关节与摆抛关节协同动作将末端执行机构调整至预抛掷姿态。

20、s3.5机械臂连同采摘末端执行器运动至抛掷位置,摆抛关节增大摆动角度,剪切关节的两断柄装置张开,将芽叶抛入收集装置;抛掷完成后,各关节复位,进入下一采摘周期。

21、本发明的有益效果是:本发明将复杂的姿态调节动作仅施加于需要姿态补偿的非标准y型茶芽,而对占多数的标准y型茶芽则以简化的快速直采方式完成作业。旋转电机与俯仰电机在非标准y型流程中承担姿态预调整功能,在标准y型流程中仅参与预抛掷与抛掷动作;剪切电机与断柄装置在两种采摘方式中均负责剪切、夹持与抛放动作的执行。由此,在整体上减少了姿态调节机构的工作频次,压缩了平均单芽作业周期,在维持高采摘成功率与低损伤率的同时,显著提升末端执行器的综合作业效率。

1.姿态自适应的剪抛式茶芽智能采摘末端执行器,其特征在于,包括末端外壳、水平旋转关节、摆抛关节、剪切关节、电源和控制单元,所述末端外壳与采摘机械臂固定连接,所述水平旋转关节包括旋转电机和末端执行器壳体,所述旋转电机固定在末端外壳内,所述末端执行器壳体固定在旋转电机输出端;所述摆抛关节包括俯仰电机、啮合齿轮组和断柄支架,所述俯仰电机位于末端执行器壳体内,所述断柄支架与末端执行器壳体转动连接,所述啮合齿轮组位于俯仰电机输出端和断柄支架之间用于传递俯仰电机扭矩至断柄支架,所述剪切关节包括剪切电机和对称设置的两个断柄装置,所述剪切电机固定在断柄支架上,所述断柄装置的安装端与断柄支架转动连接,所述剪切电机驱使两断柄装置做反向旋转,所述剪切关节和断柄支架构成末端执行机构;所述电源和控制单元均设置在末端外壳内,所述电源为控制单元和各电机提供电能,所述控制单元用于接收上位机下发的末端控制指令,并按照设定的时序逻辑向各电机输出驱动控制信号。

2.根据权利要求1所述的姿态自适应的剪抛式茶芽智能采摘末端执行器,其特征在于,所述啮合齿轮组包括大齿轮和小齿轮,所述大齿轮与俯仰电机输出端固定连接,所述小齿轮与断柄支架固定连接,所述断柄支架通过小齿轮的齿轮轴与末端执行器壳体转动连接。

3.根据权利要求2所述的姿态自适应的剪抛式茶芽智能采摘末端执行器,其特征在于,所述断柄装置的安装端为齿形结构,所述断柄装置的剪切端具有刀刃,两所述断柄装置的安装端啮合配合,所述剪切电机的输出端与其中一个断柄装置的安装端固定连接。

4.利用权利要求1所述的姿态自适应的剪抛式茶芽智能采摘末端执行器的姿态自适应的剪抛式茶芽智能采摘方法,其特征在于,包括以下步骤:

5.根据权利要求4所述的姿态自适应的剪抛式茶芽智能采摘方法,其特征在于,步骤s1中,构建面向采摘作业的关键点标注数据集,并利用开源数据标注平台label studio标注工具对茶芽关键部位进行精细化标注。

6.根据权利要求5所述的姿态自适应的剪抛式茶芽智能采摘方法,其特征在于,步骤s1中,基于yolov11-pose基线网络,改进提出gcyp-pose检测模型,具体改进包括:在c3k2模块后引入局部-全局特征融合模块glmixblock,通过融合不同尺度与维度的特征信息,增强模型在检测与姿态估计的多任务场景下的特征共享与表征能力;采用广义高效特征金字塔网络,重构yolov11-pose基线网络颈部结构neck部分;将原检测头替换为轻量级共享卷积检测头,通过自动交互机制充分挖掘多尺度特征图的互补信息,实现跨尺度特征融合。

7.根据权利要求6所述的姿态自适应的剪抛式茶芽智能采摘方法,其特征在于,步骤s2包括如下子步骤:s2.1利用关键点检测网络定位茶芽关键部位在图像平面的坐标,并通过关键点映射,获取其在相机坐标系下关键点的三维空间坐标;s2.2以茶芽采摘点为原点建立局部坐标系,以为空间坐标的原点,三个互相正交的坐标轴x、y和z从原点向外延伸,形成茶芽自身空间坐标系x-y-z,在点云中构建三个核心特征向量:,,;是由原点指向侧叶的特征向量,反应侧叶的向外伸展程度;是由原点指向顶芽的特征向量,反应顶芽的绝对生长方向;向量由原点指向采摘点,的反方向表示茶芽理想采摘点的所在区域;s2.3将核心特征向量映射至机器人基座坐标系(x, y, z)中,形成参数化数学模型。

8.根据权利要求7所述的姿态自适应的剪抛式茶芽智能采摘方法,其特征在于,步骤s3包括如下子步骤: