1.基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,包括以下步骤:根据采摘机器人的机械结构建立采摘执行器中香蕉果柄夹持件的位置和姿态与各自由度的正运动学模型;
基于牛顿迭代算法根据香蕉果柄夹持件的目标位置和姿态求得满足设定精度的逆运动学解;
所述根据采摘机器人的机械结构建立采摘执行器中香蕉果柄夹持件的位置和姿态与各自由度的正运动学模型;具体包括:根据采摘机器人的4个自由度对果柄夹持件的位置和姿态进行定位;
确定香蕉果柄夹持件的位置、姿态与各自由度变量的函数关系式;
所述根据采摘机器人的4个自由度对果柄夹持件的位置和姿态进行定位;具体包括:采摘机器人设置底座转动自由度θ、水平滑块沿导轨的水平运动自由度x、垂直滑块沿导轨的垂直运动自由度z和末端转动自由度 四个自由度;
通过控制采摘机器人4个自由度的运动调节采摘执行器中香蕉果柄夹持件的位置和姿态,使其定位到香蕉串果柄切割处以便完成采摘作业;其中,对香蕉果柄夹持件的位置和姿态进行精确控制,建立4个自由度变量描述香蕉果柄夹持件位置和姿态的采摘机器人正运动学模型;
短主臂与水平方向夹角为α,副臂与水平方向夹角为β,末端转动杆与香蕉果柄夹持件的夹角为γ;在水平运动方向和垂直运动方向的交点处建立局部坐标系o‑xyz,并随底座一起转动;而在底座转动中心建立基坐标系O‑XYZ;其中,局部坐标系o‑xyz在基坐标系O‑XYZ中的位置向量p为:p=[px,py,pz]=[‑364,0,657];
考虑到采摘机器人的连杆机构和局部坐标系o‑xyz随底座一起转动,故水平运动自由度和垂直运动自由度只在xoz平面内调整连杆机构的位置,因此,先在xoz平面内建立末端转动中心M的位置与水平位移x、垂直位移z的函数关系;根据采摘机器人各连杆之间的几何关系,可得节点A、C、M的位置表达式为:式(3)中,
联立式(1)~(3)可得末端转动中心M的位置表达式为:
其中,l1为连杆AB的长度;l2为平行连杆BD和CE的长度;l3为连杆BC的长度;l4为平行连杆EF和JK的长度;l5为连杆FL的长度;l6为连杆NH的长度;l7为连杆MN的长度;l8为平行连杆EJ和FK的长度;l9为连杆IJ的长度;l11为连杆EI的长度;l10为节点F与节点M之间的水平距离;h为节点K到连杆LM的垂直距离。
2.根据权利要求1所述的基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,所述采摘机器人包括履带、移动平台、水平滑块、垂直滑块、长主臂、短主臂、副臂、三角构件和采摘执行器,所述履带上设置移动平台,所述移动平台的上端和侧边分别设置用于安装水平滑块和垂直滑块的滑轨,所述水平滑块上设置短主臂,垂直滑块上设置长主臂,所述长主臂和短主臂的端部设置三角构件,所述三角构件与副臂连接,所述副臂的端部设置采摘执行器。
3.根据权利要求2所述的基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,所述采摘执行器包括末端转动杆、香蕉果柄夹持件和香蕉果柄切割件,所述末端转动杆与副臂的端部转动连接,所述末端转动杆与香蕉果柄夹持件连接,所述香蕉果柄夹持件上设置香蕉果柄切割件。
4.根据权利要求1所述的基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,确定香蕉果柄夹持件的位置、姿态与各自由度变量的函数关系式;具体包括:确定主臂夹角α、副臂夹角β与水平位移x、垂直位移z的关系;利用半角公式可实现正弦函数和余弦函数的转换,即:联立式(1)、(2)和半角公式(5)、(6),同时考虑主臂夹角α的取值范围,可得主臂夹角α与水平位移x、垂直位移z的相关函数表达式为:同理,可得副臂夹角β与水平位移x、垂直位移z的相关函数表达式为:将sinα式(8)、cosβ式(13)代入式(4),即可得xoz平面内末端转动中心M的位置(xM,zM)关于水平位移x、垂直位移z的非线性函数表达式;
结合局部坐标系o‑xyz在基坐标系O‑XYZ中的位姿p,同时考虑底座转角θ的作用,根据几何关系可得末端转动中心M在基坐标系O‑XYZ中的位置表达式为:对于香蕉果柄夹持件的位置和姿态,还需考虑末端转角 的作用,根据机器人的连杆结构和几何关系,可得香蕉果柄夹持件相对于末端转动中心M在基坐标系O‑XYZ中的位置为:再将M的位置表达式(15)代入式(16)可得:
将sinα式(8)、cosβ式(13)代入式(17),即得各自由度变量θ、x、z、描述香蕉果柄夹持件位置的函数关系式;
由于底座转角θ、末端转角 均为偏摆自由度,故香蕉果柄夹持件的姿态Ψ为:至此,得到式(17)、(18)所示采摘机器人的正运动学模型,即香蕉果柄夹持件的位置(XH,YH,ZH)、姿态角Ψ与各自由度变量θ、x、z、的函数关系式。
5.根据权利要求1所述的基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,所述基于牛顿迭代算法根据香蕉果柄夹持件的目标位置和姿态求得满足设定精度的逆运动学求解,具体包括:根据香蕉果柄夹持件的目标位置和姿态对底座转角θ和末端转角 进行求解;
基于牛顿迭代法求解水平位移x和垂直位移z。
6.根据权利要求5所述的基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,所述根据香蕉果柄夹持件的目标位置和姿态对底座转角θ和末端转角 进行求解;
具体包括:由于基坐标系O‑XYZ建在底座转动中心,故机器人连杆在XOY平面内的投影经过基坐标系原点O,因此,先根据几何关系由香蕉果柄夹持件的目标位置(XH,YH,ZH)和姿态Ψ求得末端转动中心M的位置分量XM、YM,再通过反正切函数求解底座转角θ;联立式(16)、(18)可得M的位置分量XM、YM为:因为底座转角θ的取值范围为(‑π,π),而反正切函数的取值范围为(‑π/2,π/2),因此,根据M的位置分量XM、YM所处象限进行修正,可得底座转角θ的逆解表达式为:求得底座转角θ后,再根据末端转角 的取值范围(‑2π/3,2π/3),由式(18)可得末端转角 的逆解表达式:
7.根据权利要求5所述的基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,所述基于牛顿迭代法求解水平位移x和垂直位移z,具体包括:若采摘机器人的水平位移x、垂直位移z满足的方程组为F(X),其雅可比矩阵为J(X),其T中X=(x,z) ,则牛顿迭代法的计算表达式为:
‑1
Xk+1=Xk‑J (Xk)F(Xk) (22)
‑1
式(22)中,Xk、Xk+1分别表示第k、k+1次迭代的输出值,(k=0,1,…,n);J (Xk)为雅可比矩阵J(Xk)的逆矩阵;
‑1
确定关于水平位移x和垂直位移z的方程组F(X),及其雅可比矩阵的逆矩阵J (X);
选取采摘机器人正运动学模型的位置表达式(17)中XH、ZH分量,以及姿态Ψ表达式(18)构造关于水平位移x和垂直位移z的方程组F(x,z),即将sinα式(8)、cosβ式(13)代入式(23),再分别对x、z求偏导数,可得其雅可比矩阵J(x,z):式(24)中,各元素的表达式为:
其中:
‑1
而式(24)所示雅可比矩阵J(x,z)的逆矩阵J (x,z)计算表达式为:将式(23)、(25)代入式(22),即得计算采摘机器人水平位移x、垂直位移z的牛顿迭代表达式。
8.根据权利要求7所述的基于牛顿迭代法的香蕉采摘机器人逆运动学计算方法,其特征在于,所述基于牛顿迭代法求解水平位移和垂直位移,具体为,选择水平位移和垂直位移的实时值作为牛顿迭代初值,进行一次迭代获取下一时刻的水平位移和垂直位移。