一种手术机器人的关节控制方法、系统及存储介质
本发明提供一种手术机器人的关节控制方法、系统及存储介质,所述方法包括:离线初始化阶段,控制关节沿预设轨迹运行,同步采集电机电角度与关节输出力矩,经等角度重采样及快速傅里叶变换,得到初始化力矩波动模型的各次谐波正弦、余弦系数,在线补偿阶段,实时监测电机相电压、电流,构建电压平衡方程并采用递归最小二乘法在线估计绕组电阻;以初始化力矩波动模型构建前馈补偿模型,将谐波系数作为状态向量搭建卡尔曼滤波器,以残余力矩误差为观测值,结合绕组电阻变化量调节过程噪声,实现状态向量递归更新,实时输出前馈补偿力矩;同时采用数字带阻滤波器抑制关节连杆固有共振,提升关节控制精度与稳定性。