• 제목/요약/키워드: Augmented PD control

검색결과 4건 처리시간 0.017초

Modeling, Identification and Control of a Redundant Planar 2-DOF Parallel Manipulator

  • Zhang, Yao-Xin;Cong, Shuang;Shang, Wei-Wei;Li, Ze-Xiang;Jiang, Shi-Long
    • International Journal of Control, Automation, and Systems
    • /
    • 제5권5호
    • /
    • pp.559-569
    • /
    • 2007
  • In this paper, the dynamic controller design problem of a redundant planar 2-dof parallel manipulator is studied. Using the Euler-Lagrange equation, we formulate the dynamic model of the parallel manipulator in the joint space and propose an augmented PD controller with forward dynamic compensation for the parallel manipulator. By formulating the controller in the joint space, we eliminate the complex computation of the Jacobian matrix of joint angles with end-effector coordinate. So with less computation, our controller is easier to implement, and a shorter sampling period can be achieved, which makes the controller more suitable for high-speed motion control. Furthermore, with the combination of static friction model and viscous friction model, the active joint friction of the parallel manipulator is studied and compensated in the controller. Based on the dynamic parameters of the parallel manipulator evaluated by direct measurement and identification, motion control experiments are implemented. With the experiments, the validity of the dynamic model is proved and the performance of the controller is evaluated. Experiment results show that, with forward dynamic compensation, the augmented PD controller can improve the tracking performance of the parallel manipulator over the simple PD controller.

강인추적 제어를 이용한 자율 무인 잠수정의 심도제어 (Depth Control of Autonomous Underwater Vehicle Using Robust Tracking Control)

  • 채창현
    • 한국기계가공학회지
    • /
    • 제20권4호
    • /
    • pp.66-72
    • /
    • 2021
  • Since the behavior of an autonomous underwater vehicle (AUV) is influenced by disturbances and moments that are not accurately known, the depth control law of AUVs must have the ability to track the input signal and to reject disturbances simultaneously. Here, we proposed robust tracking control for controlling the depth of an AUV. An augmented closed-loop system is represented by an error dynamic equation, and we can easily show the asymptotic stability of the overall system by using a Lyapunov function. The robust tracking controller is consisted of the internal model of the command signal and a state feedback controller, and it has the ability to track the input signal and reject disturbances. The closed-loop control system is robust to parameter uncertainties. Simulation results showed the control performance of the robust tracking controller to be better than that of a P + PD controller.

Unscented Kalman Filtering for Spacecraft Attitude and Rate Determination Using Magnetometer

  • Kim, Sung-Woo;Park, Sang-Young;Abdelrahman, Mohammad;Choi, Kyu-Hong
    • 한국우주과학회:학술대회논문집(한국우주과학회보)
    • /
    • 한국우주과학회 2008년도 한국우주과학회보 제17권2호
    • /
    • pp.36.1-36.1
    • /
    • 2008
  • An Unscented Kalman Filter(UKF) for estimation of attitude and rate of a spacecraft using only magnetometer vector measurement is presented. The dynamics used in the filter is nonlinear rotational equation which is augmented by the quaternion kinematics to construct a process model. The filter is designed for low Earth orbit satellite, so the disturbance torques include gravity-gradient torque, magnetic disturbance torque, and aerodynamic drag. The magnetometer measurements are simulated based on time-varying position of the spacecraft. The filter has been tested not only in the standby mode but also in the detumbling mode. To stabilize the attitude, linear PD controller is applied and the actuator is assumed to be thruster. A Monte-Carlo simulation has been done to guarantee the stability of the filter performance to the various initial conditions. The UKF performance is compared to that of EKF and it reveals that UKF outperforms EKF.

  • PDF

Unscented KALMAN Filtering for Spacecraft Attitude and Rate Determination Using Magnetometer

  • Kim, Sung-Woo;Abdelrahman, Mohammad;Park, Sang-Young;Choi, Kyu-Hong
    • Journal of Astronomy and Space Sciences
    • /
    • 제26권1호
    • /
    • pp.31-46
    • /
    • 2009
  • An Unscented Kalman Filter (UKF) for estimation of the attitude and rate of a spacecraft using only magnetometer vector measurement is developed. The attitude dynamics used in the estimation is the nonlinear Euler's rotational equation which is augmented with the quaternion kinematics to construct a process model. The filter is designed for small satellite in low Earth orbit, so the disturbance torques include gravity-gradient torque, magnetic disturbance torque, and aerodynamic drag torque. The magnetometer measurements are simulated based on time-varying position of the spacecraft. The filter has been tested not only in the standby mode but also in the detumbling mode. Two types of actuators have been modeled and applied in the simulation. The PD controller is used for the two types of actuators (reaction wheels and thrusters) to detumble the spacecraft. The estimation error converged to within 5 deg for attitude and 0.1 deg/s for rate respectively when the two types of actuators were used. A joint state parameter estimation has been tested and the effect of the process noise covariance on the parameter estimation has been indicated. Also, Monte-Carlo simulations have been performed to test the capability of the filter to converge with the initial conditions sampled from a uniform distribution. Finally, the UKF performance has been compared to that of the EKF and it demonstrates that UKF slightly outperforms EKF. The developed algorithm can be applied to any type of small satellites that are actuated by magnetic torquers, reaction wheels or thrusters with a capability of magnetometer vector measurements for attitude and rate estimation.