sot-core
4.11.8
Hierarchical task solver plug-in for dynamic-graph.
|
As explained in class dynamicgraph::sot::FeatureAbstract,
\[ {\bf E}(t) = {\bf e}({\bf q}(t), t)= {\bf s}({\bf q}(t)) - {\bf s}^*(t) \]
thus:
\[ \dot{\bf E}= \frac{\partial{\bf e}}{\partial{\bf q}} \dot{\bf q} + \frac{\partial{\bf e}}{\partial t} \\ \]
The features are responsible for computing:
The class dynamicgraph::sot::Task takes some features outputs as inputs. It imposes an exponential decrease, i.e. \( \dot{\bf E} = -\lambda {\bf E} \). It gives:
\[ -\lambda {\bf e} = \frac{\partial{\bf e}}{\partial{\bf q}} \dot{\bf q} + \frac{\partial{\bf e}}{\partial t} \]
and computes solutions as:
\[ \dot{\bf q} = \frac{\partial{\bf e}}{\partial{\bf q}}^{\dagger} \left( - \lambda {\bf e} - \frac{\partial{\bf e}}{\partial t} \right) + K v \]
where:
\(v\) is a free parameters left to tasks of lower priority.