1.一种并联机器人双自适应高鲁棒性控制方法,其特征在于,包括如下步骤:
1)针对并联机器人,进行运动学分析,并建立含并联机器人建模误差、机构关节摩擦与外部干扰的集总干扰项的动力学模型;
2)根据实际生产工艺要求,确定并联机器人末端位姿的期望运动轨迹;
3)基于步骤1)所建立的并联机器人动力学模型,设计一种具有自适应切换增益的并联机器人动力学滑模控制器,通过针对其切换增益设计制约函数自适应律,以突破需获取干扰上界信息限制,使并联机器人系统能够快速克服干扰作用,并削弱滑模控制抖振;
4)基于步骤3),设计一种具有自适应带宽增益的扩张状态观测器,以突破需干扰项变化率为零条件限制,减小观测值的初始观测误差峰值,实现对并联机器人系统干扰的实时估计和补偿,从而降低滑模控制器克服系统干扰的负担,进一步提高系统鲁棒性,并进一步削弱滑模控制抖振;
5)基于“上位机+下位机”的分布式结构构建并联机器人双自适应高鲁棒性控制系统,上位机为计算机,下位机为多轴运动控制器;
6)将计算所得的并联机器人各主动关节控制量发送至各个电机驱动器,使并联机器人按期望轨迹运动;
所述步骤3)具体过程为:
采用Lagrange法建立含并联机器人建模误差、机构关节摩擦与外部干扰的集总干扰项的动力学模型为:式中,分别为并联机器人各主动关节的位姿、速度和加速度;为含并联机器人建模误差、机构关节摩擦与外部干扰的集总干扰项,分别为名义惯性矩阵,名义哥氏力和离心力项,名义重力项;ΔM(x)∈Rn×n,ΔG(x)∈Rn为模型误差;且有F(t)∈Rn为摩擦力项,τd是外部干扰项,τ为主动关节驱动力/力矩;
令
式中,分别为并联机器人末端位姿的位姿误差、速度误差;分别为并联机器人末端位姿的期望位姿与速度;
由式(2)设计滑模面:
式中,η=diag(η1,η2,…,ηn),η1,η2,…,ηn均为可调参数,满足Hurwitz稳定判据;
将式(3)滑模面两端对时间进行求导得:
式中,分别为并联机器人末端位姿实际加速度与期望加速度;
选取趋近律为:
式中,λ=diag(λ1,λ2,…,λn);
针对式(5),设计一种调整并联机器人动力学滑模控制切换增益λ的制约函数自适应律如下:式中,λa(t)和λb(S(t))分别为在和时刻切换增益λ的取值,均为可调参数,t为满足不等式的最小解,其中ε是与动力学滑模变量收敛的邻域有关的可调参数,通过Lyapunov稳定性分析可得滑模变量有限的收敛时间;
结合式(1)、(3)、(5)、(6),整理得到具有自适应切换增益的并联机器人动力学滑模控制律为:所述步骤4)的具体过程为:
定义
式中,为并联机器人末端位姿速度;τ为主动关节驱动力/力矩;D为并联机器人集总干扰项;τa、α1与α2为定义的辅助变量;G为重力项;C为哥氏力和离心力项;
根据式(1),设计一种并联机器人能够突破需干扰项变化率为零条件限制的扩张状态观测器如下:式中,ea为并联机器人末端位姿速度实际值与观测值的误差;M为惯性矩阵;ζ1=diag(2ω0,2ω0,…,2ω0),ζ2=diag(ω02,ω02,…,ω02);ω0为与观测器增益有关的可调常数;分别为α1,α2的观测值,且有根据跟踪误差e设计扩张状态观测器带宽增益自适应律如下:式中,为在系统可接受误差范围内的可调参数;分别为观测器增益的下限和上限,其中参数ω0从到的过渡过程可表示为式中,tt为可调的过渡时间,t1为满足误差条件时,系统对应的时刻点;
通过设计上述带宽增益自适应律,并对tt的合理选取能够保证自适应带宽增益扩张状态观测器对集总干扰项的观测精度且减小观测值的初始观测误差峰值;
将式(9)中对并联机器人动力学模型中集总干扰项估计值代入式(7),可得并联机器人双自适应高鲁棒性控制律为:τ=τ1+τ2 (13)
式中,τ1为并联机器人自适应切换增益动力学滑模控制器部分控制量,τ2为自适应带宽增益扩张状态观测器对集总干扰项的补偿量,有
2.根据权利要求1所述的并联机器人双自适应高鲁棒性控制方法,其特征在于:所述步骤5)的具体过程为:以泰道公司多轴运动控制器(UMAC)为核心控制单元,基于“上位机+下位机”的分布式结构构建并联机器人双自适应高鲁棒性控制系统,上位机为计算机,下位机为多轴运动控制器;
下位机UMAC轴通道扩展卡ACC-24E2A与伺服驱动器进行通讯以实现编码器信息采集及驱动控制信号的输出功能,完成并联机器人的运动控制,并联机器人双自适应高鲁棒性控制系统下位机应用程序开发步骤为:首先,在UMAC中设置能够实现并联机器人双自适应高鲁棒性控制的参数预设,设置Ixx02以定义伺服电机指令输出地址,设置Ixx03以定义伺服电机位置环反馈地址,设置Ixx59以选择使用内置伺服算法或使用外部自定义算法,设置Ixx69以定义伺服电机可输出脉冲,设置I7mn0以定义第m个伺服芯片的第n通道编码器/定时器译码方式;
其次,编写能够满足并联机器人双自适应高鲁棒性控制目标需求的期望运动轨迹程序;
然后,编写并联机器人双自适应高鲁棒性控制自定义算法程序;
上位机PC实现包括系统初始化、数据处理、代码编译及并联机器人运行状态实时监测的功能,并联机器人双自适应高鲁棒性控制系统上位机应用程序开发步骤为:首先,基于PComm32W动态链接库实现上、下位机的通讯功能;
其次,下载能够满足并联机器人双自适应高鲁棒性控制目标需求的期望运动轨迹程序;
然后,将预编写的并联机器人双自适应高鲁棒性控制自定义算法PMC文件下载至UMAC缓冲区,实现并联机器人双自适应高鲁棒性运动控制。