Lecture 20

advertisement
Lecture 20
Dimitar Stefanov
Microprocessor control of Powered
Wheelchairs
•Flexible control; speed synchronization of both driving
wheels, flexible control algorithm; algorithm for power
limitation, diagnostic of the current wheelchair condition,
information about the current battery charge, etc.
•The control of the powered wheelchair can be tuned easily
to the individual user’s needs. Easy adjustment of the
maximal speed in different regimes (forward, backward,
turning)
•Acceleration and deceleration rate, input filter parameters
(tremor suppression), input device dead zone.
•Tuning –the controller is set into the “program
mode” regime; tuning via special keys or tuning by
using the wheelchair joystick; tuning via special
tuning device, which is connected to the
microprocessor controller; series of menus are used to
tune the parameter of interest.
•Contour velocity control – velocity feedback; the
desired speed remains constant despite of the terrain
characteristics (rough and smooth surface) and the
terrain inclination; speed feedback – by optical
encoders, tachogenerators, or by using the back
electromotive force (EMF) of the motor.
Wheelchair model
1. Model of DC motor with permanent magnets
Va – armature voltage;
ia – armature current;
Ra – armature resistance;
Kv – motor voltage constant;
wm – motor angular velocity;
La – armature inductance;
Jm – motor inertia;
Kt – motor torque constant;
Tm – motor torque.
can be neglected because the time constant of the
chair is typically on the order of 1/100 times larger.
Torque loss – result from the friction if wheels, bearing and rolling.
Free-body diagram of a powered wheelchair and rider on an inclined surface
Q – pitch (slope) angle;
F – incline angle
M- mass of the wheelchair/rider system
Acceleration of the wheelchair/rider system along the x
and y axes:
vr – linear velocity of the right wheel
vl - linear velocity of the left wheel
l – distance between the the center of mass and the rear axles
W – width of wheelchair between the rear wheels.
Forces, acting at the center of the mass (M) of the
wheelchair/rider system:
g – acceleration due to gravity.
Linear acceleration of the left and the right wheels
and chair angular acceleration about the “z” axis:
where
Microprocessor-based feedback wheelchair
controller
•Differential torque control of the powered rear
wheels; free motion of the front castor wheels.
•Feedback speed control maintains the desired
wheelchair speed in presence of disturbances, e.g.
side slopes, changes of the terrain, changes in the
texture of the rolling surface.
•Easy user’s control.
Problem:
•User should feel the resistance of the wheelchair
in order to be able to sense bearing failure of low
tire pressure.
Solutions:
• Sensors which give information about the
power consumption and interface, which transmit
the information to the user
•P – controller.
Typical interface – two axis joystick – set the
direction and speed of the wheelchair motion.
•In case of PI feedback control, user can easily
keep the desired direction (no correcting
commands are required).
•The difference between the joystick signal
and the velocity signal of the velocity sensor
becomes an error signal for the controller.
•In case of open loop, user continuously adjust
the speed proportion of the wheels in order to
maintain the desired direction.
Speed control of the rear wheels:
1. Tachogenerators
2. Optical sensors
3. Hall – sensors
4. In case of armature controlled permanent magnet D.C. motors,
the back electromotive force (EMF) is proportional to the motor
speed
Angular and linear velocity of the wheelchair, expressed by the
velocity of the left and the right of the rear wheels:
Val – linear velocity of the wheelchair
Vwl – angular velocity of the wheelchair
vr – linear velocity of the right wheel
vl - linear velocity of the left wheel.
The input to the left motor servo amplifier (VsL) :
Where:
Vcv, Vcw - output signals of the wheelchair
controller
Vcv –signal, proportional to the linear velocity
Vcw – signal, proportional to the angular
velocity.
The input to the right motor servo amplifier (VsR)
:
Feedback controller – allows independent limitation of
the linear and the angular speed of the wheelchair:
independent limitation of acceleration and deceleration
during forward and backward movement.
Choice of the parameters of the microprocessor
wheelchair controller:
•Gain of the system
•Sampling rate – determined the closed-loop gain
•The longer the sampling time, the lower gain of the the
PI controller; high gain and high accuracy in case of
faster sampling time.
•Average sampling rate - 0.01s.
Shared control
•Called sensor-based control
•Array of external and internal sensors is used by the
control system
The selection of appropriate interface is from
great importance for the wheelchair
performance.
Input signals from the user – set the desired
speed and turning radius:
1. Continuous variable input signals
2. Discrete-steps variable input signals
•Proportional input devices – joystick, head
control
•Latched inputs – switches, sip-and-puff
devices, voice recognition devices
Signal pre-conditioning:
•Simple low-pass filter (suppresses fast user’s
commands)
•Sliding window signal averager
•Neural network or fuzzy logic based signal
preconditioning – tremor suppression.
Two basic approaches for tremor suppression:
1. Driving behavior is recorded on an actual or
virtual driving course.
1. Driving data are used to train the neural
network or to adjust the parameters of
fuzzy controller.
2. Tremor data are measured while the joystick is
in the neutral position.
1. Neutral position tremor is measured and
used as a background noise to develop an
adaptive noise cancellation.
Approach 1. An example.
Approach 2. An example.
Pre-conditioning – removes input
device drift and sensor imbalance.
Schemes for failure detection:
•The output signals to the motors become zero
when signal failure is detected
•Redundant circuitry schematics
•Memorizing the “history” of the wheelchair
behavior; comparison the wheelchair response to
one and the same input commands at the current
and the past moments.
Failure detection of the input device. An example.
Download