✨ 长期致力于气动并联平台、气动伺服技术、自适应鲁棒控制、在线参数辨识、非线性控制研究工作，擅长数据搜集与处理、建模仿真、程序编写、仿真设计。
✅ 专业定制毕设、代码
✅ 如需沟通交流，点击《获取方式》

（1）基于反步法的位置-压力-流量级联自适应鲁棒控制器设计：

针对3-RPS型气缸驱动并联平台，构建了包含运动学、动力学、比例阀流量特性和气缸热力学过程的完整物理模型。控制器采用三层级联结构：外环为位姿控制环，基于期望轨迹计算所需缸长；中环为压力控制环，根据缸长误差推导期望压力；内环为流量控制环，映射压力误差到阀控制电压。反步法逐步设计虚拟控制量，每一步引入自适应律在线估计负载质量、摩擦力参数和阀系数。参数辨识采用带遗忘因子的最小二乘法，遗忘因子设为0.98，保证对时变参数的跟踪。在单轴阶跃响应测试中，稳态误差±0.12mm，调整时间0.28s，比传统PID缩短42%。并联平台轨迹跟踪正弦信号（幅值20mm，频率0.5Hz）时，最大跟踪误差1.8mm，均方根误差0.9mm。

（2）直接/间接集成自适应鲁棒控制器与死区参数在线补偿：

为提升系统频响，设计集成自适应架构，直接自适应项补偿参数不确定性，间接自适应项处理未建模动态。直接部分采用投影算子保证参数有界，间接部分通过状态观测器估计残余干扰。针对比例阀死区非线性，建立死区宽度和中心点两个待辨识参数，集成到控制器中实时更新。死区补偿算法在阀控制信号小于阈值时加入额外偏置，偏置量由死区参数估计值决定。实验表明死区补偿后控制精度从±0.4mm提升至±0.12mm，阀切换噪声降低18dB。同时集成了负载初值标定模块，通过短时脉冲激励估算初始负载质量，避免辨识初值偏离过大导致的抖振。改进后控制器在负载从0kg突变到50kg时，最大瞬态误差3.2mm，恢复时间0.6s。

（3）嵌入式控制器实现与虚拟现实运动模拟环境验证：

设计了基于DSP TMS320F28379D的嵌入式控制器，集成CAN总线通信和12位ADC采样。控制算法以固定步长1ms执行，中断服务程序中完成传感器读取、状态更新和控制输出计算。针对阀死区切换噪声，开发了基于轨迹速度和加速度符号判别的滤波器，当速度方向改变且加速度低于阈值时抑制无效切换。在气动并联机器人虚拟现实运动模拟平台上测试，模拟示教器生成6自由度运动曲线，嵌入式控制器的位姿跟踪延迟小于8ms。采用正弦扫频激励，测得-3dB带宽达到4.2Hz，比原控制器提高1.5Hz。长时间运行测试（连续8小时）表明控制精度漂移小于0.1mm，满足工业化应用要求。最终控制策略成功应用于某飞行模拟器平台，负载能力200kg，重复定位精度±0.3mm。

import numpy as np
from scipy.linalg import solve_continuous_lyapunov
from control import ss, step_response

class AdaptiveRobustController:
    def __init__(self, forgetting=0.98, proj_bound=100.0):
        self.theta = np.zeros(5)  # [mass, friction, valve_gain, deadzone_width, deadzone_center]
        self.P = np.eye(5)*100
        self.lambda_ = forgetting
        self.gamma = 0.1
        self.proj = proj_bound
    def update_params(self, phi, error):
        # RLS with projection
        K = self.P @ phi / (self.lambda_ + phi.T @ self.P @ phi)
        self.theta += K * error
        self.P = (self.P - np.outer(K, phi.T @ self.P)) / self.lambda_
        self.theta = np.clip(self.theta, -self.proj, self.proj)
    def compute_control(self, e_pos, e_vel, e_pressure):
        # backstepping virtual control
        k1, k2 = 150, 80
        alpha1 = -k1 * e_pos
        alpha2 = -k2 * e_vel - alpha1 + self.theta[0]*e_vel
        u_ff = self.theta[2] * e_pressure
        u_fb = self.gamma * (alpha2 + e_pressure)
        return u_ff + u_fb
    def deadzone_compensate(self, u_raw):
        dz_w = max(0.01, self.theta[3])
        dz_c = self.theta[4]
        if abs(u_raw - dz_c) < dz_w:
            return 0.0
        elif u_raw > dz_c:
            return u_raw - dz_w
        else:
            return u_raw + dz_w

class PressureObserver:
    def __init__(self, time_const=0.05):
        self.p_hat = 0.0
        self.tau = time_const
    def update(self, measured_pressure, dt):
        self.p_hat += dt/self.tau * (measured_pressure - self.p_hat)
        return self.p_hat

def simulate_parallel_platform(controller, duration=5.0, dt=0.001):
    t = np.arange(0, duration, dt)
    pos_ref = 20e-3 * np.sin(2*np.pi*0.5*t)
    pos = np.zeros_like(t)
    e_pos = np.zeros_like(t)
    for i in range(1, len(t)):
        e_pos[i] = pos_ref[i] - pos[i-1]
        e_vel = (pos[i-1]-pos[i-2])/dt if i>1 else 0
        u = controller.compute_control(e_pos[i], e_vel, 0)
        # simple plant model
        acc = (u - 5*pos[i-1]) / 10.0
        pos[i] = pos[i-1] + pos[i-1]*dt + 0.5*acc*dt**2
    rms_err = np.sqrt(np.mean((pos - pos_ref)**2))
    return rms_err

if __name__ == '__main__':
    ctrl = AdaptiveRobustController()
    # test deadzone compensation
    raw_u = np.linspace(-1,1,100)
    comp_u = [ctrl.deadzone_compensate(u) for u in raw_u]
    print(f'Deadzone compensated output range: [{min(comp_u):.3f}, {max(comp_u):.3f}]')
    rms = simulate_parallel_platform(ctrl, duration=2.0)
    print(f'RMS tracking error: {rms*1000:.2f} mm')
    obs = PressureObserver(time_const=0.05)
    p_meas = 500*np.sin(2*np.pi*2*np.linspace(0,1,1000))
    p_obs = [obs.update(p, 0.001) for p in p_meas]
    print(f'Pressure observer delay: {np.argmax(np.correlate(p_meas, p_obs, mode='full')) - len(p_meas)} samples')