jane li - wpiusers.wpi.edu/.../l11-feedbackcontrol_note.pdf · •feedback systems: an introduction...

50
Jane Li Assistant Professor Mechanical Engineering Department, Robotic Engineering Program Worcester Polytechnic Institute

Upload: others

Post on 26-Jul-2020

0 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

Jane Li

Assistant Professor

Mechanical Engineering Department, Robotic Engineering Program

Worcester Polytechnic Institute

Page 2: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• (2 pts) How to ensure games for rehabilitation can be played by a wide range of stroke patients?

• (4 pts) Name one assistive strategy which are not found in the multi-joint exoskeletons

• (4 pts) Why is it helpful for LL exoskeleton to provide knee joint stability reinforcement? And how to provide it?

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 2

Page 3: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• How to make games playable for a broad range of stroke patients?

• Assume no use of hands

• Simple games should support multiple methods of user input

• Calibrate to the patient’s motion range

• Direct and natural mappings are necessary

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 3

Page 4: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Devices for hip, knee and ankle

• Fundamentally different joint functions

• Assistive strategies unique to single-joint device

• Muscle stiffness control, proportional EMG control

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 4

Page 5: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Gravity compensation

• Feedforward movement assistance during swing

• Knee joint stability reinforcement during stance

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 5

Page 6: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Prepare for understanding the stability control in teleoperation and haptics

• Dynamic system and feedback control

• Stability of continuous and discrete systems

• This is a vey brief introduction

• ES 3011. CONTROL ENGINEERING I – undergrad

• RBE 502. ROBOT CONTROL – grad

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 6

Page 7: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 7

Page 8: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595
Page 9: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595
Page 10: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 10

Page 11: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 11

Page 12: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Causes for unstable systems?

• Determine whether a system is stable or not?

• Design a stability controller?

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 12

Page 13: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595
Page 14: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Dynamic system

• A system whose behavior changes over time, often in response to external stimulation or forcing

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 14

Open-loop Closed-loop

Page 15: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 15

Page 16: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Feedback allows a system to be

• Resilient to external disturbances

• Insensitive to variations of internal elements

• Feedback may

• Create dynamic instabilities (oscillations or “runaway”)

• Introduce sensor noise into the system

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 16

Page 17: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• In engineering context

• The use of algorithms and feedback to produce desired system behavior

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 17

Page 18: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Cruise control of vehicle

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 18

Page 19: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 19

Page 20: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 20

Page 21: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 21

Past FuturePresent

Page 22: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• How to model this system?

• Time Domain

• ODE

• State space

• Frequency Domain

• Laplace transform

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 22

Page 23: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 23

ODE – How to solve?

Page 24: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Let be a solution,

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 24

Page 25: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 25

Page 26: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Two distinct real roots:

• General solution

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 26

Page 27: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Two complex conjugate roots

• Euler formula

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 27

Page 28: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• General solution

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 28

Page 29: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Repeated real root

• General solution

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 29

Page 30: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 30

Solutions have negative real parts

Page 31: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Let be a solution with initial condition

• A solution is stable if other solutions that start near stay close to

• A solution is asymptotically stable if all the nearby solutions converge to this stable solution for large time

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 31

Page 32: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 32

Solution format?

Page 33: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 33

Over

Under

Critical

All asymptotically stable

Page 34: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 34

Page 35: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 35

Page 36: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 36

Page 37: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 37

Page 38: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 38

Page 39: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Lyapunov function

• An energy-like function

• Nonnegative function

• Always decreases along trajectories of the system dynamics

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 39

Page 40: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 40

Page 41: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 41

dynamics matrix Control matrix

sensor matrix Direct term

Page 42: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 42

Page 43: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 43

Stability Criterion?

Page 44: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Any linear system? Choose a new coordinate system

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 44

Stability Criterion = A’s eigenvalues have negative real parts

Page 45: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Stability is a property of system dynamics

• Instability of a continuous system

• Due to the introduction of feedback

• How to determine the stability of a dynamic system?

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 45

Page 46: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• Shared virtual object

• PD controller for position coherency

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 46

Page 47: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 47

Page 48: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 48

Page 49: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 49

Page 50: Jane Li - WPIusers.wpi.edu/.../L11-FeedbackControl_note.pdf · •Feedback Systems: An Introduction for Scientists and Engineers, 2nd Edition, by KJ Astrom and R. M. Murray RBE 595

• For the above systems

• Derive dynamic equations

• Derive state space representation

• m = 1, b=0.4, K=5000 N/m, choose a set of b(s) for stability and instability

• No network delay (Td = 0)

10/2/2017RBE 595 – Synergy of Human and Robotic Systems – Instructor: Jane Li, Mechanical Engineering Department & Robotic Engineering Program - WPI 50