为了提高柔性关节机器人的轨迹跟踪精度和抖动抑制能力,设计了一种基于无源性理论的柔性关节控制器.通过Simulink仿真验证和简化了该控制器,使其更加适合于多自由度机器人的控制.用于实验的7自由度机器人采用DSP+FPGA结构,数字信号处理器(DSP)和现场可编程逻辑门阵列(FPGA)分别实现非线性部分和线性部分计算,避免了由于自由度的增加引起的关节控制器性能变化.实验结果表明,与传统的PD控制相比,基于无源性理论的柔性关节控制器具有力矩波动小以及抖动抑制快、稳态精度高等优点.
In order to improve the trajectory tracking precision and the vibration suppression capability of flexible joint robots,a passivity theory based flexible joint controller is proposed.The controller is verified and simplified in Simulink environment in order to make it more suitable for the robot with multiple degrees of freedom(DoF).Experiments are conducted on a 7-DoF robot with DSP+FPGAs structure,and the nonlinear and linear parts are calculatd in digital signal processor(DSP) and field programmable gate array(FPGA) separately,which avoids the performance change of the joint controller due to the increasing DoF.The experiment results show that comparing with the PD(proportional-derivative) controller,the proposed controller has the advantages of lower torque fluctuation,faster vibration suppression and higher static accuracy.