基于滑模SMC-PID的二自由度机械臂轨迹跟踪控制仿真(Simulink+m程序实现)
(1)程序实现了两自由度机械臂的滑模PID控制仿真:
① 首先由SMC_pid_2input生成正弦形式的关节期望轨迹及各阶导数;
② SMC_pid_2i 据此计算关节角度、角速度跟踪误差,构建滑模面r;
③ 控制器SMC_pid_2ctrl 结合机械臂动力学参数(杆长、质量)建立M/C/G矩阵,计算标称控制力矩,叠加PID控制项与滑模鲁棒项补偿模型误差和扰动,输出总控制力矩;
④ SMC_pid_2plant为机械臂本体模型,接收控制力矩,通过逆动力学求解关节角加速度,更新关节角度和角速度并反馈闭环控制,实现对期望轨迹的跟踪。