In the last video, we learned that the Lie bracket of two vector fields expresses their
noncommutativity.
This noncommutativity may allow approximate motion in directions not directly allowed
by the control vector fields.
The Lie bracket is, itself, a vector field.
Therefore, we can take Lie brackets of Lie brackets.
For example, we can take the Lie bracket of g_1 with the Lie bracket of g_1 and g_2.
Higher-degree Lie brackets like this one correspond to higher-order terms in the Taylor expansions
from the last video.
We call the original vector fields Lie products of degree 1, the Lie bracket of two of the
original vector fields a Lie product of degree 2, the Lie bracket of Lie products of degree
1 and 2 a Lie product of degree 3, and so on.
The key idea behind testing for local controllability from a configuration q is to see if the Lie
products of all degrees, evaluated at the configuration q, allow motion in every direction.
We say that a set of vector fields satisfies the Lie algebra rank condition, or LARC, at
a configuration q if their Lie products, of all degrees, span the n-dimensional space
of feasible motions at the configuration q.
With this definition, we can state the main theorem:
Consider a control system q-dot equals g_1 times u_1 plus g_2 times u_2, etc., such that
the vector fields satisfy the LARC at q.
Then the system is small-time locally controllable from q if the control set U positively spans
the m-dimensional control space, and it's small-time locally accessible from q if the
control set spans, but does not positively span, the m-dimensional control space.
Basically, a positively spanning control set allows motion forward and backward along vector
fields, while a spanning control set may only allow unidirectional motion along the vector
fields.
Let's apply this test to our canonical nonholonomic mobile robot.
The vector field g_1 corresponds to forward motion and the vector field g_2 corresponds
to rotating in place.
The Lie bracket of g_1 and g_2, which I'll call g_3, is zero, sine phi, minus cosine
phi, a sideways parallel-parking motion.
If we create a matrix whose columns are the three vector fields, we find that the determinant
is 1.
Since the determinant is nonzero, these 3 vector fields are linearly independent, and
therefore they span the 3-dimensional space of velocities of the chassis.
Therefore the LARC is satisfied at all configurations.
If the robot is a car with a reverse gear, the control set U is a bowtie-shaped region,
as we learned in an earlier video.
This control set positively spans the 2-dimensional control space.
Therefore, by the theorem, the car with a reverse gear is small-time locally controllable
from all configurations.
On the other hand, if the robot is a car without a reverse gear, the control set is only half
of the bowtie-shaped region.
This control set spans the control space, but does not positively span the control space.
Therefore the car without a reverse gear is small-time locally accessible from all configurations,
but it's not small-time locally controllable.
Although we're usually only interested in the motion of the chassis, we could include
other configuration variables in the description of the robot.
For an upright rolling wheel, the full configuration is phi, x, y, and theta, where theta is the
rolling angle of the wheel.
If the radius of the wheel is r, then the forward motion vector field is g_1 equals
zero, r cosine phi, r sine phi, 1, and the spin-in-place vector field is g_2 equals 1,
zero, zero, zero.
The degree-2 Lie bracket is g_3 equals zero, r sine phi, minus r cosine phi, zero, which
corresponds to sliding sideways.
We need at least one more Lie bracket to be able to span the four-dimensional space of
velocities, so we can construct the degree-3 Lie bracket of g_2 and g_3, which is zero,
r cosine phi, r sine phi, zero, which corresponds to sliding forward without changing the rolling
angle theta.
Taking the determinant of the 4-by-4 matrix with these vector fields as the columns, we
find that the determinant is minus r squared, so the four vector fields are linearly independent,
provided the wheel radius is nonzero.
Therefore the LARC is satisfied at all configurations.
If the control set positively spans the control space, the robot is small-time locally controllable
from all configurations, meaning that it can follow any path in its 4-dimensional configuration
space arbitrarily closely, despite the 2 velocity constraints that the wheel cannot slide forward
or sideways.