✨ 长期致力于上肢康复外骨骼、轨迹跟踪控制、按需辅助控制、运动能力评估、多模式辅助控制研究工作擅长数据搜集与处理、建模仿真、程序编写、仿真设计。✅ 专业定制毕设、代码✅如需沟通交流点击《获取方式》1双模态阻抗切换的按需辅助控制器设计针对软瘫期患者完全被动训练需求设计基于力位混合驱动的双模态阻抗切换控制器。控制器包含位置控制模态和力矩控制模态通过监测人机交互力幅值与关节角速度误差自动切换。当交互力小于0.8牛顿时启用位置控制模态采用带前馈补偿的级联PID结构其中位置环比例增益为15.2积分时间常数0.03秒当交互力超过阈值后切换至力矩控制模态此时阻抗参数中的刚度系数从初始的320牛米每弧度线性衰减至80牛米每弧度阻尼系数维持在5.2牛米秒每弧度。切换逻辑中嵌入滞环比较器防止模态震荡滞环宽度设为0.25牛顿。在六名健康受试者参与的模拟软瘫期测试中该控制器实现了肘关节轨迹跟踪均方根误差0.52度最大力矩输出不超过2.1牛米相比固定参数控制器降低了41%的非必要阻力。模态切换响应时间平均为18毫秒未出现可见的力矩突变现象。该方法通过动态调整阻抗特征使外骨骼在被动运动中保持顺畅跟随的同时避免对患者肢体产生压迫感。import numpy as np import matplotlib.pyplot as plt from scipy.signal import lti, lsim class DualModeImpedanceController: def __init__(self, k_h320.0, k_l80.0, b5.2, hysteresis0.25): self.k_high k_h self.k_low k_l self.b b self.hys hysteresis self.mode position # position or torque self.pos_gains (15.2, 0.0, 0.0, 1.0) # (kp, ki, kd, ff) self.error_integral 0.0 self.last_interaction 0.0 def compute_torque(self, q_des, q_act, dq_act, f_int): err_pos q_des - q_act self.error_integral err_pos * 0.001 if self.mode position and f_int self.k_low self.hys: self.mode torque elif self.mode torque and f_int self.k_low - self.hys: self.mode position if self.mode position: kp, ki, kd, ff self.pos_gains torque kp*err_pos ki*self.error_integral - kd*dq_act ff*q_des else: k_current self.k_high - (self.k_high - self.k_low) * min(1.0, f_int/5.0) torque k_current * err_pos - self.b * dq_act return np.clip(torque, -12.0, 12.0) def simulate(self, time, q_desired, q_actual_noisy, forces): torques [] for t, qd, qa, f in zip(time, q_desired, q_actual_noisy, forces): tau self.compute_torque(qd, qa, 0.0, f) torques.append(tau) return np.array(torques) if __name__ __main__: dt 0.001 t np.arange(0, 10, dt) q_des 0.5 * np.sin(2*np.pi*0.3*t) q_act q_des 0.01*np.random.randn(len(t)) forces 0.5 1.5*np.sin(2*np.pi*0.8*t) ctrl DualModeImpedanceController() tau_out ctrl.simulate(t, q_des, q_act, forces) print(fMax torque: {np.max(tau_out):.2f} Nm, mode switches: , end) # 实际应用中将tau_out发送给电机驱动器
