UNIT 5
UNIT 5
PRIOR
LIKELIHOOD
Fine-motion planning
Fine-motion planning (or FMP) is a robust method that involves
moving a robot arm in very close proximity to a static environment
object.
The solutions to FMP problems will typically be conditional plans or
policies that make use of sensor feedback during execution and are
guaranteed to work in all situations consistent with the assumed
uncertainty bounds.
A fine-motion plan consists of a series of guarded motions.
Each guarded motion consists of
(1) a motion command and
(2) a termination condition, which is a predicate on the
robot’s sensor values, and returns true to indicate the end of
the guarded move.
The motion commands are typically compliant
motions that allow the effector to slide if the motion
command would cause collision with an obstacle.
Consider a two dimensional configuration space with
a narrow vertical hole. It could be the configuration
space for insertion of a rectangular peg into a hole or
a car key into the ignition.
The motion commands are constant velocities. The
termination conditions are contact with a surface. To
model uncertainty in control, we assume that instead
of moving in the commanded direction, the robot’s
actual motion lies in the cone Cv about it.
A two-dimensional environment, velocity uncertainty cone, and envelope of
possible robot motions.
The first motion command and the resulting envelope of possible robot motions.
The solution to this problem lies in adding a third term to the control
law, based on the integrated error over time:
Here Ki is yet another gain parameter. The term calculates
the integral of the error over time. The effect of this term is
that long-lasting deviations between the reference signal and
the actual state are corrected.
If, for example, xt is smaller than y(t) for a long period of
time, this integral will grow until the resulting control at
forces this error to shrink. Integral terms, then, ensure that a
controller does not exhibit systematic error, at the expense
of increased danger of oscillatory behaviour.