基于在线辨识的机器人惯量前馈控制仿真研究

Simulation Study of Robot Inertia Feedforward Control Based on Online Identification

针对模块化串联协作机器人,当腕部3个关节模块集中在机器人末端时,在机器人运行过程中,本体和负载会对前3个关节产生较大的惯性效应,降低机器人的控制效果.为了消除惯性效应对机器人伺服控制系统的影响,提高协作机器人的跟踪精度,加快动态响应的速度,减少超调量并降低稳态误差,在建立协作机器人动力学模型、计算前馈力矩的基础上,提出了一种基于在线辨识算法的惯量前馈控制技术.由于在机器人运行过程中,各关节电机所带负载的转动惯量不断发生变化,为了实时得到转动惯量实际值,在控制系统中引入变遗忘因子最小二乘辨识算法,对各电机所带负载的转动惯量进行在线辨识.考虑到协作机器人关节中的传动机构多由弹性部件组成,将弹性因素加入到控制系统的设计当中,建立了两刚体弹簧系统被控模型.将转动惯量辨识值输入到前馈通道,实时修正动力学模型中的惯性矩阵,输出前馈电流并叠加在伺服系统电流环的输入端,从而实现前馈控制.最后,在Simulink 环境中,基于实验室研制的一种模块化串联协作机器人对该控制技术进行了仿真验证,结果表明:该惯量前馈控制技术能够显著提升机器人控制系统的响应速度与跟踪特性并降低其超调量,验证了该惯量前馈控制技术的可行性与优越性.

For modular tandem cooperative robots,when three joint modules of the wrist are concentrated at the end of the robot,the body and load will have a large inertial effect on the first three joints and the control effect of the robot will be reduced during operation of the robot. In this paper,on the basis of establishing a robot dynamic model and calculating feedforward torque,an inertia feedforward control technology based on online identification algorithm was proposed to eliminate the influence of inertial effect on servo control system of a robot,improve tracking precision,accelerate dynamic response,decrease overshoot,and reduce steady-state error. As the moment of inertia of each joint motor’s load constantly changes during the operation of the robot,to obtain the actual moment of inertia in real time,a least square identification algorithm with a variable forgetting factor was introduced into the control system to identify the moment of inertia of each motor’s load online. Considering that most of the driving mechanisms in the robot joints are elastic parts,elastic factors were added into the design of the control system,and a control model of two rigid bodies connected by a spring was established. The identified value of the moment of inertia was inputted to the feedforward channel to correct inertia matrix of dynamic model in real time,and the feedforward current was outputted and superimposed on the input of the servo system current loop,and then the feedforward control was realized. Finally,based on a modular serial cooperative robot developed in the laboratory,control technology was simulated and verified in Simulink. The results show that the inertial feedforward control technology significantly improves the response speed and tracking characteristics and reduces the overshoot of the robot control system, which illustrates the feasibility and superiority of this inertial feedforward control technology.