四自由度扒渣机器人的逆解方法

摘要: 本发明涉及机器人制造,特别是四自由度扒渣机器人的逆解方法。背景技术:1、在冶炼、隧道或矿山行业中,扒渣与清理废料是一项劳动强度大且充满危险的工作。传统依靠人工或...
四自由度扒渣机器人的逆解方法

本发明涉及机器人制造,特别是四自由度扒渣机器人的逆解方法。

背景技术:

1、在冶炼、隧道或矿山行业中,扒渣与清理废料是一项劳动强度大且充满危险的工作。传统依靠人工或半自动机械的操作方式存在效率低、定位精度差以及安全隐患等问题,具体而言,人工扒渣作业环境恶劣,易受粉尘、高温、坍塌等风险影响,作业人员劳动强度极大,且作业效率受人员体力、技能限制,难以实现连续高效作业;半自动机械操作则需要人工实时干预,对操作人员的技术要求较高,且定位精度有限,无法满足精细化扒渣需求。

2、为了实现扒渣作业的完全自动化与智能化,开发具有多自由度(如3个旋转自由度与1个平移自由度)的自动化扒渣机器人成为了关键。然而,该类机器人通常依靠复杂的复合铰链与多气缸(或液压缸)协同驱动主臂动作,其机械结构具有非线性特征,导致笛卡尔空间的目标位姿不能直接等效为驱动器的控制量。

3、现有技术中,运动学算法多针对标准工业串联机械臂,该类机械臂的关节多为旋转关节,运动学关系相对简单,逆解计算难度较低;但对于带有复合铰链机构、气缸驱动的四自由度扒渣机器人,其气缸长度与关节角度之间存在复杂的非线性映射关系,现有算法难以直接解决此类机器人的逆向运动学计算问题,无法将末端目标位姿精准转换为各气缸的伸缩量与偏转角度,严重制约了该类设备的自动插补运动与轨迹规划能力,影响了扒渣机器人的自动化水平与作业精度。

技术实现思路

1、本发明的主要目的是提出四自由度扒渣机器人的逆解方法,能够将末端目标位姿精准转换为气缸控制量,从而提升扒渣机器人的自动化水平与作业精度。

2、本发明通过以下技术方案实现:

3、四自由度扒渣机器人的逆解方法,四自由度扒渣机器人包括底座、可旋转地竖直设置在底座上的第一主臂、可俯仰调节地设置在第一主臂上的第二主臂、平移执行臂、设置在平移执行臂上的末端执行器、设置在第二主臂与平移执行臂之间的连接件、以及驱动第二主臂和平移执行臂动作的驱动机构,驱动机构包括第一气缸、第二气缸,逆解方法包括如下步骤:

4、步骤s1、基于四自由度扒渣机器人的三维模型建立各连杆坐标系及运动学模型,其中,各连杆坐标系包括底座全局坐标系、底座旋转坐标系、第一主臂坐标系、第二主臂坐标系、平移坐标系以及末端坐标系;

5、步骤s2、基于各连杆坐标系及运动学模型,结合获取的末端执行器的目标位置以及姿态角,采用平面投影解耦策略,求解底座旋转角、第一主臂关节角、第二主臂关节角和平移执行臂的平移量;

6、步骤s3、对第一主臂关节角和第二主臂关节角进行初始安装角偏移补偿,得到第一补偿后角度和第二补偿后角度,再利用几何投影关系,结合扒渣机器人各连杆和连接件的结构参数,计算出第一、第二气缸的伸缩长度及偏转角度,以作为驱动机构的直接控制指令。

7、进一步的,所述步骤s1中,所述底座全局坐标系{b}的原点设置在底座几何中心,底座旋转坐标系{1}绕z轴旋转,第一主臂坐标系{2}、第二主臂坐标系{3}分别建立在第一主臂与第二主臂的铰接处、第二主臂与连接件的铰接处,分别绕y轴进行俯仰摆动,平移坐标系{4}建立在平移执行臂作业中心,末端坐标系{ee}建立在末端执行器中心,相邻两坐标系之间的转换矩阵分别表示为:、、、和其中,为底座旋转角,为第一主臂关节角,为第二主臂关节角,为平移执行臂的平移量。

8、进一步的,所述步骤s1中,所述运动学模型为扒渣机器人的正向空间运动链。

9、进一步的,所述步骤s2中,根据各连杆坐标系及运动学模型,建立从底座到末端执行器的总体齐次变换矩阵,并分离出该总体齐次变换矩阵在x、y、z方向的坐标分量方程分别为:、、,其中,为末端执行器的目标位置,为第一气缸和第一主臂的铰接点与第二气缸和第一主臂的铰接点之间的竖直距离,为第二气缸和第一主臂的铰接点与第一主臂与第二主臂铰接点之间的距离,为第二主臂连杆长度。

10、进一步的,所述步骤s2中,根据在实际扒渣作业中,末端目标姿态角为小角度,得到,故求得底座旋转角为,将求得的底座旋转角代入x、y、z方向的坐标分量方程,得到方程组,以求得第一主臂关节角、第二主臂关节角和平移执行臂的平移量,其中,平移执行臂的平移量需满足物理约束,d为设定的最大行程。

11、进一步的,所述步骤s3中,对步骤s2求得的第一主臂关节角和第二主臂关节角进行初始安装角偏移补偿,得到补偿后的第一主臂关节角和第二主臂关节角。

12、进一步的,所述步骤s3中,所述第一气缸一端铰接于第一主臂、另一端铰接于连接件后段,所述第二气缸一端铰接于第一主臂、另一端铰接于连接件前段,第一气缸与第一主臂的铰接点位于第二气缸与第一主臂的铰接点内下侧。

13、进一步的,所述步骤s3中,所述第一气缸与连接件的铰接点d在底座全局坐标系下的特征分量表示为(,),则第一气缸的伸缩长度为、偏转角度为,所述第二气缸与连接件的铰接点e在底座全局坐标系下的特征分量表示为(,),则第二气缸的伸缩长度为、偏转角度为,其中,,,,,为第二主臂与连接件的铰接点与第二气缸与连接件的铰接点之间的距离,为第一气缸与连接件的铰接点与第二气缸与连接件的铰接点之间的距离。

14、进一步的,还包括步骤s4:若和超出气缸出厂最大行程或者和超过设定的软硬件限位值,则微调目标位置以及姿态角,重新进入步骤s1。

15、由上述对本发明的描述可知,与现有技术相比,本发明具有如下有益效果:

16、本发明首先基于四自由度扒渣机器人的三维模型建立各连杆坐标系及运动学模型,然后基于各连杆坐标系及运动学模型,结合获取的末端执行器的目标位置以及姿态角,采用平面投影解耦策略,求解底座旋转角、第一主臂关节角、第二主臂关节角和平移执行臂的平移量,最后对第一主臂关节角和第二主臂关节角进行初始安装角偏移补偿,得到第一补偿后角度和第二补偿后角度,再利用几何投影关系,结合扒渣机器人各连杆和连接件的结构参数,计算出第一、第二气缸的伸缩长度及偏转角度,以作为驱动机构的直接控制指令,从而实现将抽象的笛卡尔空间运动规划结果无损地转化为可直接执行的气缸控制量,实现了扒渣机器人四自由度机构的双气缸解析驱动控制,适配于复合铰链机构,提高了恶劣工况下的指令响应速度与精细化扒渣的工程可靠性。

1.四自由度扒渣机器人的逆解方法,其特征在于:四自由度扒渣机器人包括底座、可旋转地竖直设置在底座上的第一主臂、可俯仰调节地设置在第一主臂上的第二主臂、平移执行臂、设置在平移执行臂上的末端执行器、设置在第二主臂与平移执行臂之间的连接件、以及驱动第二主臂和平移执行臂动作的驱动机构,驱动机构包括第一气缸、第二气缸,逆解方法包括如下步骤:

2.根据权利要求1所述的四自由度扒渣机器人的逆解方法,其特征在于:所述步骤s1中,所述底座全局坐标系{b}的原点设置在底座几何中心,底座旋转坐标系{1}绕z轴旋转,第一主臂坐标系{2}、第二主臂坐标系{3}分别建立在第一主臂与第二主臂的铰接处、第二主臂与连接件的铰接处,分别绕y轴进行俯仰摆动,平移坐标系{4}建立在平移执行臂作业中心,末端坐标系{ee}建立在末端执行器中心,相邻两坐标系之间的转换矩阵分别表示为:、、、和其中,为底座旋转角,为第一主臂关节角,为第二主臂关节角,为平移执行臂的平移量。

3.根据权利要求2所述的四自由度扒渣机器人的逆解方法,其特征在于:所述步骤s1中,所述运动学模型为扒渣机器人的正向空间运动链。

4.根据权利要求3所述的四自由度扒渣机器人的逆解方法,其特征在于:所述步骤s2中,根据各连杆坐标系及运动学模型,建立从底座到末端执行器的总体齐次变换矩阵,并分离出该总体齐次变换矩阵在x、y、z方向的坐标分量方程分别为:、、,其中,为末端执行器的目标位置,为第一气缸和第一主臂的铰接点与第二气缸和第一主臂的铰接点之间的竖直距离,为第二气缸和第一主臂的铰接点与第一主臂与第二主臂铰接点之间的距离,为第二主臂连杆长度。

5.根据权利要求4所述的四自由度扒渣机器人的逆解方法,其特征在于:所述步骤s2中,根据在实际扒渣作业中,末端目标姿态角为小角度,得到,故求得底座旋转角为,将求得的底座旋转角代入x、y、z方向的坐标分量方程,得到方程组,以求得第一主臂关节角、第二主臂关节角和平移执行臂的平移量,其中,平移执行臂的平移量需满足物理约束,d为设定的最大行程。

6.根据权利要求5所述的四自由度扒渣机器人的逆解方法,其特征在于:所述步骤s3中,对步骤s2求得的第一主臂关节角和第二主臂关节角进行初始安装角偏移补偿,得到补偿后的第一主臂关节角和第二主臂关节角。

7.根据权利要求6所述的四自由度扒渣机器人的逆解方法,其特征在于:所述步骤s3中,所述第一气缸一端铰接于第一主臂、另一端铰接于连接件后段,所述第二气缸一端铰接于第一主臂、另一端铰接于连接件前段,第一气缸与第一主臂的铰接点位于第二气缸与第一主臂的铰接点内下侧。

8.根据权利要求7所述的四自由度扒渣机器人的逆解方法,其特征在于:所述步骤s3中,所述第一气缸与连接件的铰接点d在底座全局坐标系下的特征分量表示为(,),则第一气缸的伸缩长度为、偏转角度为,所述第二气缸与连接件的铰接点e在底座全局坐标系下的特征分量表示为(,),则第二气缸的伸缩长度为、偏转角度为,其中,,,,,为第二主臂与连接件的铰接点与第二气缸与连接件的铰接点之间的距离,为第一气缸与连接件的铰接点与第二气缸与连接件的铰接点之间的距离。

9.根据权利要求1至8任一所述的四自由度扒渣机器人的逆解方法,其特征在于:还包括步骤s4:若和超出气缸出厂最大行程或者和超过设定的软硬件限位值,则微调目标位置以及姿态角,重新进入步骤s1。