主权项 |
1. A controller for reducing vibration and positioning a load in a mechanical system driven by a motor connected to the load, comprising:
an optimal feedforward module designed according to a model of the system; a linear feedback module; and a nonlinear feedback module, wherein inputs to the linear feedback module and the nonlinear feedback module are an angular position and an angular velocity of the motor, and outputs of the optimal feedforward module, the linear feedback module, and the nonlinear feedback module are summed and fed back to control a torque of the motor, wherein the model is a 3-mass lumped parameters model, wherein the load is represented by a mass mL with a linear damping coefficient dM, the base is represented by a mass mBwith linear damping and spring coefficients dB and kB respectively, a linear motion of the load with respect to the base is xL, a linear motion of the base with respect to an inertial base is xB, and external disturbances due to an environment and acting on the load are represented by the a time function d(i), and the model is given by a differential equation
JM{umlaut over (x)}M+D({dot over (x)}M−{dot over (x)}L)+K(xM−xL)=u−JM{umlaut over (x)}BJL{dot over (x)}L+D({dot over (x)}L−{dot over (x)}M)+K(xL−xM)=−JL{umlaut over (x)}BJB{dot over (x)}B+DB{dot over (x)}B+KBxB=−u y=xMwhere {dot over (x)} and {umlaut over (x)} are the first and second derivative of x with respect to time t, and wherein the position of the motor is xM, the load is represented by an inertia JL, the motor is represented with an inertia JM, the base is represented with an inertia JB, and the motor is controlled by a torque u, and KB, and DB represent linear spring coefficient and the linear damping coefficient of the base, respectively. |