Introduction
These are the three common linear controllers for the single joint loop in Motion Control Schemes. The plant is:
The error is .
| Symbol | Meaning |
|---|---|
| controller transfer function | |
| plant transfer function of one joint | |
| gear ratio, with | |
| motor torque constant, with | |
| back emf constant, with | |
| armature resistance | |
| effective moment of inertia at the motor shaft, | |
| effective viscous friction at the motor shaft, | |
| joint angle error | |
| desired load (joint) angle, which is the reference input | |
| actual load (joint) angle, which is the output |
Proportional (P) control
The motor voltage is proportional to the error:
| Symbol | Meaning |
|---|---|
| armature voltage, which is the output of the controller | |
| proportional gain | |
| open loop transfer function, |
Open loop:
Closed loop:
This is a second order system. It is always stable if all the parameters are positive.
Proportional derivative (PD) control
Add a derivative term:
| Symbol | Meaning |
|---|---|
| rate of change of the error | |
| derivative (velocity) gain |
Open loop:
Closed loop:
The derivative gain adds to the damping term (the coefficient of ).
Proportional integral derivative (PID) control
Add an integral term:
| Symbol | Meaning |
|---|---|
| integral gain |
Open loop:
Closed loop:
This is a third order system. The integral term removes the steady state error.
Summary
| Controller | Order of closed loop | |
|---|---|---|
| P | 2 | |
| PD | 2 | |
| PID | 3 |