 to the dimension of the control distribution, the system will be called a *fully actuated nonholonomic system*.

A **solution of a fully actuated nonholonomic problem** is an admissible curve $\gamma:I\rightarrow\mathcal{D}$ such that $$\nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))\in \Gamma (\tau_D),$$ or, equivalently, $$\nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))=u^{A}(t)e_{A}(\tau_{\mathcal{D}}(\gamma(t)),$$ where $u^{A}$ are the control inputs.

Locally, the equations may be written as $$\begin{aligned}
\dot{q}^{i}&=&\rho_{A}^{i}y^{A}\\
\dot{y}^{C}&=&-\Gamma_{AB}^{C}y^{A}y^{B}-(\mathcal{G}^{\mathcal{D}})^{CB}\rho_{B}^{i}\frac{\partial V}{\partial q^{i}}+u^{C}.\end{aligned}$$

Given a cost function $$\begin{aligned}
C&:&\mathcal{D}\times U\rightarrow\mathbb{R}\\
&&(q^{i},y^{A}, u^A)\mapsto C(q^{i},y^{A},u^{A})\end{aligned}$$ the *optimal control problem* consists of finding an admissible curve $\gamma:I\rightarrow\mathcal{D}$ solution of the fully actuated nonholonomic problem given initial and final boundary conditions on $\mathcal{D}$ and minimizing the functional $$\mathcal{J}(\gamma(t),u(t)):=\int_{0}^{T}C(\gamma(t),u(t))dt,$$ where $\gamma$ is an admissible curve.

We define the submanifold $\mathcal{D}^{(2)}$ of $T\mathcal{D}$ by $$\label{D2}
\mathcal{D}^{(2)}:=\{v\in T\mathcal{D}\mid v=\dot{\gamma}(0)\hbox{
where } \gamma:I\rightarrow\mathcal{D} \hbox{ is admissible}\
to the dimension of the control distribution, the system will be called a * amply trip nonholonomic system *. 

 A * * solution of a fully actuated nonholonomic trouble * * is an admissible curve $ \gamma: I\rightarrow\mathcal{D}$ such that $ $ \nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))\in \Gamma (\tau_D),$$ or, equivalently, $ $ \nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))=u^{A}(t)e_{A}(\tau_{\mathcal{D}}(\gamma(t)),$$ where $ u^{A}$ are the control inputs. 

 Locally, the equation may be written as $ $ \begin{aligned } 
 \dot{q}^{i}&=&\rho_{A}^{i}y^{A}\\ 
 \dot{y}^{C}&=&-\Gamma_{AB}^{C}y^{A}y^{B}-(\mathcal{G}^{\mathcal{D}})^{CB}\rho_{B}^{i}\frac{\partial V}{\partial q^{i}}+u^{C}.\end{aligned}$$ 

 Given a monetary value function $ $ \begin{aligned } 
 C&:&\mathcal{D}\times U\rightarrow\mathbb{R}\\ 
 & & (q^{i},y^{A }, u^A)\mapsto C(q^{i},y^{A},u^{A})\end{aligned}$$ the * optimal command problem * consists of recover an admissible curvature $ \gamma: I\rightarrow\mathcal{D}$ solution of the fully actuated nonholonomic problem given initial and final boundary condition on $ \mathcal{D}$ and minimizing the functional $ $ \mathcal{J}(\gamma(t),u(t)):=\int_{0}^{T}C(\gamma(t),u(t))dt,$$ where $ \gamma$ is an admissible curve. 

 We specify the submanifold $ \mathcal{D}^{(2)}$ of $ T\mathcal{D}$ by $ $ \label{D2 } 
 \mathcal{D}^{(2)}:=\{v\in T\mathcal{D}\mid v=\dot{\gamma}(0)\hbox { 
 where } \gamma: I\rightarrow\mathcal{D } \hbox { is admissible}\
 to the dimension of the coktrol distribution, the vystem will be called a *fully actuated noniolobomic system*.

A **solution of a fully acnuated nobholibomic problem** is ak admjdsibnx curve $\gamma:I\rlghtarrow\madhcal{D}$ such thdt $$\ncbla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\iathcal{B}^{\mwthcal{D}}}V(\tau_{\matrcal{C}}(\dammz(n)))\ik \Gamma (\tau_D),$$ or, equivalently, $$\nabma_{\gamma(u)}^{\mathcal{G}^{\mathcal{D}}}\gsmma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\hau_{\mwthcal{D}}(\gamma(t)))=u^{A}(t)e_{A}(\hau_{\mathcal{D}}(\tammw(r)),$$ where $u^{A}$ afe the conurml inputs.

Lkcally, the equations may be wrigten cs $$\begin{alitnwd}
\dlj{q}^{i}&=&\rho_{A}^{i}y^{A}\\
\dov{y}^{C}&=&-\Gamia_{AB}^{C}y^{A}y^{B}-(\matmbal{G}^{\matvcal{D}})^{CB}\tho_{B}^{i}\frac{\partisl T}{\parrial q^{i}}+u^{C}.\end{aligned}$$

Giten a cost function $$\fegin{aligteb}
C&:&\mathcal{D}\times U\righraerow\mdthbt{R}\\
&&(q^{i},h^{Q}, u^X)\makstp D(q^{i},y^{A},u^{W})\env{aligned}$$ ths *optimal cintrol problem* consosew of finding zn admysfible curve $\gamma:I\rightarrow\mathcal{D}$ sonutjon of the fully actuatwd nonholonomic problgm given igitial and final boundary conditions on $\mathcal{D}$ dnd mmnkmieikn thd fknctional $$\mathcal{J}(\gamma(t),u(t)):=\int_{0}^{T}C(\gamma(t),u(t))dt,$$ whews $\bakma$ is an admifsible curvr.

Wf cgfine the submxnifolb $\mzthcal{D}^{(2)}$ of $T\mathcap{D}$ by $$\lwbel{D2}
\nathcal{D}^{(2)}:=\{v\yn T\kathcal{D}\mid v=\dot{\gamma}(0)\hbox{
whwre } \gamma:I\rpghtqrrow\mathcal{D} \hbox{ is admissiyle}\
to the dimension of the control distribution, will called a actuated nonholonomic system*. actuated problem** is an curve $\gamma:I\rightarrow\mathcal{D}$ such $$\nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))\in \Gamma (\tau_D),$$ or, equivalently, $$\nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))=u^{A}(t)e_{A}(\tau_{\mathcal{D}}(\gamma(t)),$$ $u^{A}$ are the control inputs. Locally, the equations may be written as $$\begin{aligned} \dot{y}^{C}&=&-\Gamma_{AB}^{C}y^{A}y^{B}-(\mathcal{G}^{\mathcal{D}})^{CB}\rho_{B}^{i}\frac{\partial V}{\partial q^{i}}+u^{C}.\end{aligned}$$ Given a cost function $$\begin{aligned} C&:&\mathcal{D}\times U\rightarrow\mathbb{R}\\ &&(q^{i},y^{A}, u^A)\mapsto C(q^{i},y^{A},u^{A})\end{aligned}$$ *optimal problem* of an admissible curve $\gamma:I\rightarrow\mathcal{D}$ solution of the fully actuated nonholonomic problem given initial and final boundary on $\mathcal{D}$ and minimizing the functional $$\mathcal{J}(\gamma(t),u(t)):=\int_{0}^{T}C(\gamma(t),u(t))dt,$$ where is an admissible curve. define the submanifold $\mathcal{D}^{(2)}$ of by \mathcal{D}^{(2)}:=\{v\in T\mathcal{D}\mid where \gamma:I\rightarrow\mathcal{D} is admissible}\
 to the dimension of the controL distributIon, thE sySteM wIll bE calLed a *fully actuaTEd noNholonomic system*.

A **solutIon of A fULly aCTuAted nOnholonOMiC PRobLeM** iS an AdMIsSible CurVe $\gamma:i\rightarroW\maThCal{D}$ such that $$\NAbLa_{\gamma(t)}^{\maThcAl{G}^{\mathcal{D}}}\gAmmA(t)+grad_{\MaThcAL{G}^{\matHcaL{D}}}V(\taU_{\mathcAL{D}}(\gammA(t)))\in \Gamma (\TaU_d),$$ or, equIValentlY, $$\NAbLa_{\gaMma(t)}^{\mathcal{G}^{\mathcAL{D}}}\GAmma(t)+grad_{\mathcAl{G}^{\matHcAL{D}}}v(\TAu_{\mAthCal{D}}(\gamma(t)))=U^{A}(T)e_{A}(\taU_{\Mathcal{d}}(\GaMMA(T)),$$ whERe $u^{A}$ are the conTrol inputs.

LOCalLy, the eQuAtiONs may bE writTeN As $$\bEgin{aligned}
\Dot{q}^{I}&=&\rho_{A}^{i}y^{A}\\
\dOt{y}^{C}&=&-\GaMMa_{AB}^{C}y^{A}Y^{b}-(\mathcaL{G}^{\mathCal{d}})^{CB}\Rho_{B}^{I}\FrAc{\ParTiAL V}{\pARtIal Q^{I}}+u^{C}.\End{alignEd}$$

giVen a cOst fUNCTIon $$\bEgiN{aliGned}
C&:&\Mathcal{D}\times u\riGhtaRRow\MathbB{R}\\
&&(q^{i},y^{a}, u^A)\mApSto C(q^{I},y^{A},u^{A})\eNd{aliGnEd}$$ the *optimal conTrol Problem* coNsiStS of FiNding AN admisSibLe cUrve $\gamMa:I\righTArrOw\MATHcAl{D}$ solution of the fuLlY ACtUated nonHolonoMIc PrOBlem giveN iNitIal aND Final BounDArY conditiOns on $\mAThCaL{D}$ and miNiMizing ThE fuNctIonal $$\MAthcAl{J}(\gamMa(t),u(t)):=\int_{0}^{t}C(\gamMA(t),u(t))dt,$$ where $\gamMA$ is an admissibLE cURVe.

wE defIne The submanifOld $\mAThcaL{D}^{(2)}$ of $t\MaThcAL{D}$ by $$\lAbel{D2}
\MaTHcAL{D}^{(2)}:=\{v\in T\mathcal{D}\mid v=\dOt{\Gamma}(0)\hBox{
whEre } \gamma:I\righTarrow\mathCAL{d} \hbox{ is aDmisSIbLE}\
 to the dimension of the c ontrol dis tribu tio n,th e sy stem  will be calle d  a * fully actuated nonholo nomic  s y stem * .
A ** solutio n  o f a f ul ly  ac tu a te d non hol onomicproblem**isan  admissiblec ur ve $\gamma :I\ rightarrow\m ath cal{D} $suc h  that  $$ \nabl a_{\ga m ma(t)} ^{\mathca l{ G }^{\ma t hcal{D} } } \g amma (t)+grad_{\mathca l {G } ^{\mathcal{D}} }V(\ta u_ { \m a t hca l{D }}(\gamma( t) ))\in \Gamma( \t a u _ D), $ $ or, equival ently, $$\n a bla _{\gam ma (t) } ^{\mat hcal{ G} ^ {\m athcal{D}}} \gam ma(t)+gra d_{\ma t hcal{G} ^ {\mathc al{D}} }V( \ta u_{\ m at hc al{ D} } (\g a mm a(t ) ))= u^{A}(t) e_ {A }(\ta u_{\ m a t h cal{ D}} (\ga mma(t )),$$ where $ u^{ A}$a rethe c ontro l in pu ts.
Locall y, th eequations may b e wr itten as$$\ be gin {a ligne d }
\dot {q} ^{i }&=&\rh o_{A}^{ i }y^ {A } \ \ 
\ dot{y}^{C}&=&-\Gam ma _ { AB }^{C}y^{ A}y^{B } -( \m a thcal{G} ^{ \ma thca l { D}})^ {CB} \ rh o_{B}^{i }\frac { \p ar tial V} {\ partia lq^{ i}} +u^{C } .\en d{alig ned}$$
Given a cost functio n  $$\begin{ali g ne d } 
C & :&\m ath cal{D}\time s U\ r ight arro w \m ath b b{R}\ \
&&( q^ { i} , y^{A}, u^A)\mapstoC( q^{i}, y^{A} ,u^{A})\end{a ligned}$$t h e  *optima l co n tr o l problem* con sists  of findin g  an admi ssibl e curve$\gamma:I \ r ightarro w\m ath cal {D} $ so lution of the f ully  a ctuated  no nholono mic  pr obl emgi ven initi al and f in al  b ou nda ry co n ditionson  $\ ma thc al{D} $  and m inimi zing  t he fun ctional $$ \ m athc al {J }(\g amm a( t),u( t)): = \in t_{0}^{ T}C(\gamm a(t ) ,u(t )) dt ,$$ whe re $\gamma$ i san admissi bl e c urve.W e define  the submanifold $\math c al{D}^{ (2) }$ of  $T\ mathcal{D }$by $$\ lab e l{D2}\mathc al{D} ^{ (2) } : =\{v\ i n  T \ma th cal{D}\mid v =\d ot{\g am ma}( 0)\hbox {
where } \gamma:I \ rig htarrow\mathc al{ D} \ h b ox { i s  a d mis si b le} \ 
 to_the dimension_of the control distribution,_the system_will_be called_a_*fully actuated nonholonomic_system*.

A **solution of_a fully actuated nonholonomic_problem** is an_admissible_curve $\gamma:I\rightarrow\mathcal{D}$ such that $$\nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))\in \Gamma (\tau_D),$$ or, equivalently, $$\nabla_{\gamma(t)}^{\mathcal{G}^{\mathcal{D}}}\gamma(t)+grad_{\mathcal{G}^{\mathcal{D}}}V(\tau_{\mathcal{D}}(\gamma(t)))=u^{A}(t)e_{A}(\tau_{\mathcal{D}}(\gamma(t)),$$ where $u^{A}$ are the_control_inputs.

Locally, the_equations_may_be written as $$\begin{aligned}
\dot{q}^{i}&=&\rho_{A}^{i}y^{A}\\
\dot{y}^{C}&=&-\Gamma_{AB}^{C}y^{A}y^{B}-(\mathcal{G}^{\mathcal{D}})^{CB}\rho_{B}^{i}\frac{\partial V}{\partial_q^{i}}+u^{C}.\end{aligned}$$

Given a cost function $$\begin{aligned}
C&:&\mathcal{D}\times_U\rightarrow\mathbb{R}\\
&&(q^{i},y^{A}, u^A)\mapsto_C(q^{i},y^{A},u^{A})\end{aligned}$$ the *optimal control problem* consists of finding_an_admissible curve $\gamma:I\rightarrow\mathcal{D}$_solution of the fully actuated nonholonomic problem given initial_and final boundary conditions on $\mathcal{D}$_and minimizing the_functional_$$\mathcal{J}(\gamma(t),u(t)):=\int_{0}^{T}C(\gamma(t),u(t))dt,$$_where $\gamma$ is an_admissible curve.

We define the submanifold $\mathcal{D}^{(2)}$_of $T\mathcal{D}$ by $$\label{D2}
\mathcal{D}^{(2)}:=\{v\in T\mathcal{D}\mid v=\dot{\gamma}(0)\hbox{
where_} \gamma:I\rightarrow\mathcal{D} \hbox{ is admissible}\