1 / 21

Manipulator Control

Introduction to ROBOTICS. Manipulator Control. Jizhong Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu. Outline. Homework Highlights Robot Manipulator Control Control Theory Review Joint-level PD Control Computed Torque Method

Download Presentation

Manipulator Control

An Image/Link below is provided (as is) to download presentation Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author. Content is provided to you AS IS for your information and personal use only. Download presentation by click this link. While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server. During download, if you can't get a presentation, the file might be deleted by the publisher.

E N D

Presentation Transcript


  1. Introduction to ROBOTICS Manipulator Control Jizhong Xiao Department of Electrical Engineering City College of New York jxiao@ccny.cuny.edu

  2. Outline • Homework Highlights • Robot Manipulator Control • Control Theory Review • Joint-level PD Control • Computed Torque Method • Non-linear Feedback Control • Midterm Exam Scope

  3. Manipulator Control

  4. Robot Manipulator Control • Robot System: • Joint Level Controller Find a control input (tor), • Task Level Controller Find a control input (tor),

  5. Robot Manipulator Control • Control Methods • Conventional Joint PID Control • Widely used in industry • Advanced Control Approaches • Computed torque approach • Nonlinear feedback • Adaptive control • Variable structure control • ….

  6. d e dt Error signal e yd - ya actual ya V desired yd compute V using PID feedback - Motor actual ya Control Theory Review (I) PID controller: Proportional / Integral / Derivative control e= yd- ya V = Kp• e + Ki ∫ e dt + Kd ) Closed Loop Feedback Control Reference book: Modern Control Engineering, Katsuhiko Ogata, ISBN0-13-060907-2

  7. Evaluating the response overshoot steady-state error ss error -- difference from the system’s desired value settling time overshoot -- % of final value exceeded at first oscillation rise time -- time to span from 10% to 90% of the final value settling time -- time to reach within 2% of the final value How can we eliminate the steady-state error? rise time

  8. Control Performance, P-type Kp = 20 Kp = 50 Kp = 200 Kp = 500

  9. Control Performance, PI - type Kp = 100 Ki = 50 Ki = 200

  10. You’ve been integrated... Kp = 100 unstable & oscillation

  11. Control Performance, PID-type Kp = 100 Kd = 5 Kd = 2 Ki = 200 Kd = 10 Kd = 20

  12. PID final control

  13. Control Theory Review (II) • Linear Control System • State space equation of a system • Example: a system: • Eigenvalue of Aare the root of characteristic equation • Asymptotically stable all eigenvalues of A have negative real part (Equ. 1)

  14. Control Theory Review (II) • Find a state feedback control such that the closed loop system is asymptotically stable • Closed loop system becomes • Chose K, such that all eigenvalues of A’=(A-BK) have negative real parts (Equ. 2)

  15. Control Theory Review (III) • Feedback linearization • Nonlinear system • Example: Original system: Nonlinear feedback: Linear system:

  16. Robot Motion Control (I) • Joint level PID control • each joint is a servo-mechanism • adopted widely in industrial robot • neglect dynamic behavior of whole arm • degraded control performance especially in high speed • performance depends on configuration

  17. Robot Motion Control (II) • Computed torque method • Robot system: • Controller: How to chose Kp, Kv ? Error dynamics Advantage: compensated for the dynamic effects Condition: robot dynamic model is known

  18. Robot Motion Control (II) How to chose Kp, Kv to make the system stable? Error dynamics Define states: In matrix form: Characteristic equation: The eigenvalue of A matrix is: One of a selections: Condition: have negative real part

  19. Robot Motion Control (III) • Non-linear Feedback Control Robot System: Jocobian:

  20. Robot Motion Control (III) • Non-linear Feedback Control Design the nonlinear feedback controller as: Then the linearized dynamic model: Design the linear controller: Error dynamic equation:

  21. Thank you!

More Related