10.07.2015 Views

Control of a Bicycle Using Virtual Holonomic Constraints

Control of a Bicycle Using Virtual Holonomic Constraints

Control of a Bicycle Using Virtual Holonomic Constraints

SHOW MORE
SHOW LESS
  • No tags were found...

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

<strong>Control</strong> <strong>of</strong> a <strong>Bicycle</strong> <strong>Using</strong> <strong>Virtual</strong> <strong>Holonomic</strong> <strong>Constraints</strong>Luca Consolini, Manfredi MaggioreAbstract— The problem <strong>of</strong> making a bicycle trace a strictlyconvex Jordan curve with bounded roll angle and boundedspeed is investigated. The problem is solved by enforcing avirtual holonomic constraint which specifies the roll angle <strong>of</strong> thebicycle as a function <strong>of</strong> its position along the curve. It is shownthat virtual holonomic constraints can be generated as periodicsolutions <strong>of</strong> a scalar periodic differential equation. Finally, itis shown that if the mean curvature <strong>of</strong> the path is sufficientlysmall the virtual holonomic constraint can be asymptoticallystabilised and the speed <strong>of</strong> the bicycle is asymptotically periodic.I. INTRODUCTIONThis paper investigates the problem <strong>of</strong> maneuvering abicycle along a closed Jordan curve C in the horizontal planein such a way that the bicycle does not fall over and itsvelocity is bounded. The simplified bicycle model we use inthis paper, developed by Neil Getz [1], [2], views the bicycleas a point mass with a side slip velocity constraint, andmodels its roll dynamics as those <strong>of</strong> an inverted pendulum,see Figure 1. The model neglects, among other things, thewheels dynamics and the associated gyroscopic effect. Thedynamics <strong>of</strong> Getz’s bicycle when the contact point <strong>of</strong> the rearwheel is made to follow the curve C are Euler-Lagrange.In [3], Hauser-Saccon-Frezza investigate the maneuveringproblem for Getz’s bicycle using a dynamic inversion approachto determine bounded roll trajectories. They constrainthe bicycle on the curve and, given a desired velocity signalv(t), they find a trajectory with the property that the velocity<strong>of</strong> the bicycle is v(t) and its roll angle ϕ is in the interval(−π/2, π/2), i.e, the bicycle doesn’t fall over. In [4], Hauser-Saccon develop an algorithm to compute the minimum-timespeed pr<strong>of</strong>ile for a point-mass motorcycle compatible withthe constraint that the lateral and longitudinal accelerationsdo not make the tires slip, and apply their algorithm to Getz’sbicycle model.The problem <strong>of</strong> maneuvering Getz’s bicycle along a closedcurve is equivalent to moving the pivot point <strong>of</strong> an invertedpendulum around the curve without making the pendulumfall over. On the other hand, the seemingly different problem<strong>of</strong> maneuvering Hauser’s PVTOL aircraft [5] along a closedcurve in the vertical plane can be viewed as the problem <strong>of</strong>moving the pivot <strong>of</strong> an inverted pendulum around the curvewithout making the pendulum fall over. The two problemsL. Consolini is with the Department <strong>of</strong> Information Engineering,University <strong>of</strong> Parma, Viale Usberti 181/A, Parma, 43124 Italy,E-mail: lucac@ce.unipr.itM. Maggiore is with the Department <strong>of</strong> Electrical and Computer Engineering,University <strong>of</strong> Toronto, 10 King’s College Road, Toronto, Ontario,M5S 3G4, Canada. E-mail: maggiore@control.utoronto.ca.M. Maggiore was supported by the Natural Sciences and EngineeringResearch Council (NSERC) <strong>of</strong> Canada.are, therefore, closely related, the main difference being thefact that in the former case the pendulum lies on a planewhich is orthogonal to the plane <strong>of</strong> the curve, while inthe latter case it lies on the same plane. In [6], the pathfollowing problem for the PVTOL was solved by enforcinga virtual holonomic constraint which specifies the roll angle<strong>of</strong> the PVTOL as a function <strong>of</strong> its position on the curve.In this paper we follow a similar approach for the bicyclemodel and impose a virtual holonomic constraint relating thebicycle’s roll angle to its position along the curve, but ratherthan finding one feasible virtual constraint, we show howto generate a class <strong>of</strong> feasible virtual constraints as periodicsolutions <strong>of</strong> a scalar periodic differential equation which wecall the virtual constraint generator. We show that if thecurvature <strong>of</strong> the path is sufficiently small compared to theheight <strong>of</strong> the bicycle’s centre <strong>of</strong> mass, then on the constraintmanifold the velocity <strong>of</strong> the bicycle converges exponentiallyto a periodic pr<strong>of</strong>ile. In other words, the bicycle traversesthe entire curve with bounded speed and its speed pr<strong>of</strong>ileis asymptotically periodic. Finally, we design a controllerwhich exponentially stabilises the virtual constraint manifoldand recovers the asymptotic properties <strong>of</strong> the bicycle on theconstraint manifold just described.The idea <strong>of</strong> virtual holonomic constraint is a usefulparadigm for the control <strong>of</strong> oscillations and goes well beyondthe example investigated in this paper. To the best <strong>of</strong> ourknowledge, this notion originated with the work <strong>of</strong> Grizzleand collaborators on biped locomotion (e.g., [7] and [8]). Therecent work in [9], [10], [11] investigated virtual holonomicconstraints for Euler-Lagrange systems. There, an integral<strong>of</strong> motion for the dynamics on the virtual constraint wasgiven explicitly, and a methodology to stabilise desired limitcycles on the virtual constraint manifold was given basedon a time-varying linearization <strong>of</strong> the system on the limitcycle. In [12], this ideas were applied to the stabilisation<strong>of</strong> oscillations in the Furuta pendulum. In [13], we gaveconditions for a virtual holonomic constraint to be feasible,and we exposed the role <strong>of</strong> the virtual constraint generatorin producing feasible virtual constraints that can always belocally exponentially stabilised. We also presented sufficientconditions in order that the reduced system describing themotion on the virtual constraint manifold be Euler-Lagrange.The bicycle model in this paper does not meet the sufficientconditions <strong>of</strong> [13]; in fact, we will show that the reduced systemis not Euler-Lagrange. Getz’s bicycle model is thereforean example showing that the reduced motion <strong>of</strong> an Euler-Lagrange system subjected to a virtual holonomic constraintmay not be Euler-Lagrange. See Remark 3.4 for more details.


ϕmδIn order to derive the constrained dynamics, suppose that(x(0), y(0)) ∈ C, i.e., (x(0), y(0)) = σ(s 0 ), for some s 0 ∈R modT. A point σ(s(t)) moving on C has linear velocityv(t) = ‖σ ′ (s(t))‖ṡ(t) (2)and accelerationψ(x, y)bhp˙v(t) = ‖σ ′ (s(t))‖¨s(t) +ṡ 2 (t)‖σ ′ (s(t))‖ σ′ (s(t)) ⊤ σ ′′ (s(t)). (3)Therefore, for an arbitrary velocity signal v(t), (x(t), y(t))traverses C with velocity v(t) if and only if (x(0), y(0)) ∈ C,(ẋ(0), ẏ(0)) is tangent to C, and the steering angle δ(t)( is chosen to be δ(t) = arctan[p κ(s(t))], where s(t) =∫ t(s(τ))‖]dτ)0 [v(τ)/‖σ′ modT, so thatFig. 1.Getz’s bicycle model.We adopt the notational conventions in [3] to describe thesimplified bicycle model depicted in Figure 1:• (x, y) - coordinates <strong>of</strong> the point <strong>of</strong> contact <strong>of</strong> the rearwheel• ϕ - roll angle• ψ - yaw angle• δ - projected steering angle on the (x, y) plane• b - distance between the projection <strong>of</strong> the centre <strong>of</strong> massand the point <strong>of</strong> contact <strong>of</strong> the rear wheel• p - wheel base• h - pendulum length• v - forward linear velocity <strong>of</strong> the bicycle• f - reaction force <strong>of</strong> the ground on the rear wheel.We will denote ¯κ = tanδ/p = ˙ψ/v. For a given velocitysignal v(t) and steering angle signal δ(t), ¯κ(t) representsthe curvature <strong>of</strong> the path (x(t), y(t)) traced by the point<strong>of</strong> contact <strong>of</strong> the rear wheel. The model <strong>of</strong> the bicycle inFigure 1 was presented in [2] and is given by[¨ϕ˙v]M = F + B[˙¯κf], (1)where, letting s ϕ = sin ϕ and c ϕ = cosϕ,[ ]h2bhcM =ϕ¯κbhc ϕ¯κ 1 + (b 2 + h 2 s 2 ϕ)¯κ 2 ,− 2h¯κs ϕ[]ghsF = ϕ − (1 − h¯κs ϕ )hc ϕ¯κv 2(1 − h¯κs ϕ )2hc ϕ¯κv ˙ϕ + bh¯κs ϕ ˙ϕ 2 ,[]− bhcB =ϕ v 0− (b 2¯κ .− hs ϕ (1 − h¯κs ϕ ))v 1/mConsider a C 3 closed Jordan curve C in the (x, y) planewith regular parametrization σ(s) : R modT → R 2 (T is theperiod <strong>of</strong> the function σ), not necessarily unit speed. Let κ(s)denote the signed curvature <strong>of</strong> C. Throughout this paper, weassume the following.Assumption 1: The curve C is strictly convex, i.e., κ(s) >0 for all s ∈ R modT.In this paper we investigate the dynamics <strong>of</strong> the bicycle whenthe point (x, y) is constrained to move along the curve C.¯κ(t) = κ(s(t)). (4)The motion <strong>of</strong> the bicycle on the curve C is thus found bysubstituting (2), (3), (4) in (1):[] [ ]¨ϕ˜M‖σ ′ ‖¨s + (σ′ ) ⊤ σ ′′ = ˜F 0+ f , (5)‖σ ′ ‖ ṡ2 1/mwhere ˜M = M|¯k=k(s) and( [ ) ∣1 ˜F = F + B k0]′ (s)ṡ.∣∣∣¯k=k(s),v=‖σ ′ (s)‖ṡThe motion <strong>of</strong> the bicycle on C in (5) is an Euler-Lagrangesystem with configuration variables (ϕ, s) and LagrangianL = T − V , withT = 1 [2 [ ˙ϕ ‖σ′ (s)‖ṡ] ˜M˙ϕ‖σ ′ (s)‖ṡ], V = gh cosϕ.Since the control force f enters nonsingularly in the ¨sequation, we can define a feedback transformation for fin (5) such that ¨s = u, where u is the new control input.With this transformation, the motion <strong>of</strong> the bicycle on Creads as[h¨ϕ = gs ϕ − (1 − hκ(s)s ϕ )κ(s)‖σ ′ (s)‖ + bκ ′ (s)+ bκ(s) ]‖σ ′ (s)‖ 2 σ′ (s) ⊤ σ ′′ (s) c ϕ ‖σ ′ (s)‖ṡ 2 − bκ(s)c ϕ ‖σ ′ (s)‖u¨s = u.(6)Letting q = (ϕ, s), the state space is X = {(q, ˙q) ∈ S 1 ×(R modT) × R 2 }. In our simulations we will use h = 1 mand b = 1.5 m.Remark 1.1: If σ(s) is a unit speed parametrization <strong>of</strong> C,then the first differential equation in (6) reduces to[]h¨ϕ = gs ϕ − (1 −hκ(s)s ϕ )κ(s)+bκ ′ (s) c ϕ ṡ 2 −bκ(s)c ϕ u.The objective <strong>of</strong> this paper is to solve the followingManeuvering Problem. Find a feedback u(q, ˙q) forsystem (6) such that there exists a set <strong>of</strong> initial conditions Ωwith the property that, for all (q(0), ˙q(0)) ∈ Ω, the bicycledoes not overturn, i.e., |ϕ(t)| < π/2 for all t ≥ 0, andtraverses the entire curve C in one direction, i.e., there exists2


¯t > 0 such that |ṡ(t)| > 0 for all t ≥ ¯t. Moreover, the speedṡ(t) <strong>of</strong> the bicycle on C should remain bounded.Our solution <strong>of</strong> this problem relies on the notion <strong>of</strong> virtualholonomic constraint.Definition 1.2: A function ϕ = Φ(s), Φ : R modT →S 1 is a virtual holonomic constraint for system (6) if theconstraint manifoldΓ = {(q, ˙q) ∈ X : ϕ = Φ(s), ˙ϕ = Φ ′ (s)ṡ}is controlled invariant, i.e., there exits a smooth feedbacku(q, ˙q) rendering it invariant.The constraint manifold Γ is the collection <strong>of</strong> all thosephase curves <strong>of</strong> (6) such that ϕ(t) = Φ(s(t)) for all tfor which the solution is defined. It is a two-dimensionalsubmanifold <strong>of</strong> X parametrized by (s, ṡ), and thereforediffeomorphic to the cylinder (R modT) × R. Our approachto solving the maneuvering problem is to look for virtualholonomic constraints ϕ = Φ(s) such that |Φ(s)| < π/2for all s ∈ R modT. The advantage <strong>of</strong> this approach, asopposed to searching for individual bounded roll trajectories,is that each virtual constraint Φ provides a family <strong>of</strong>bounded roll trajectories corresponding to arbitrary choices<strong>of</strong> (s(0), ṡ(0)) ∈ (R modT) × R.II. THE VIRTUAL CONSTRAINT GENERATORIn this section we show that virtual holonomic constraintsfor (6) can be generated as solutions <strong>of</strong> a first-order differentialequation, which we call the virtual constraint generator.This idea was first presented in our previous work [13]. Webegin with a sufficient condition for a function Φ to be afeasible virtual holonomic constraint for (6).Lemma 2.1: A C 1 function ϕ = Φ(s), R modT → S 1 isa virtual holonomic constraint for system (6) ifΦ ′ (s) + h −1 bκ(s)‖σ ′ (s)‖ cosΦ(s) ≠ 0 (7)for all s ∈ R modT.Pro<strong>of</strong>: Viewing the function ϕ − Φ(s) as an output<strong>of</strong> system (6), condition (7) is simply the requirement thatsaid output has a well-defined uniform relative degree 2 on{ϕ − Φ(s) = 0}. The associated zero dynamics manifold isprecisely Γ, and it is controlled invariant.The foregoing lemma inspires the following observation.Instead <strong>of</strong> guessing a virtual constraint and checking whetherit is feasible, as in the lemma, one could use (7) to generatefeasible virtual holonomic constraints. More precisely, letr = h −1 b and consider the scalar differential equationdΦds = −rκ(s)‖σ′ (s)‖ cosΦ + δ(s). (8)Since s is a cyclic variable in R modT, the above is a T -periodic differential equation. If, for some δ(s) ≠ 0, (8)has a T -periodic solution Φ(s), then in light <strong>of</strong> Lemma 2.1,ϕ = Φ(s) is a virtual holonomic constraint. Therefore, onecan think <strong>of</strong> differential equation (8) as a virtual holonomicconstraint generator, for which one is to pick δ(s) suchthat a periodic solution exists. Such problem <strong>of</strong> existence<strong>of</strong> periodic solutions is addressed in the next proposition,whose pro<strong>of</strong> is omitted due to space limitations.Proposition 2.2: Set δ(s) = ǫµ(s), where µ : R modT →R is a T -periodic and locally Lipschitz function such thatµ(s) > 0 for all s ∈ R modT, and let( )K + =K − =maxs∈R mod Tmins∈R mod Tµ(s)κ(s)‖σ ′ (s)‖(µ(s)κ(s)‖σ ′ (s)‖,).Then, for any Φ 0 ∈ (0, π/2) mod2π and s 0 ∈ R modT,(i) there exists a uniqueǫ ∈ [ǫ − , ǫ + ] = [(r cosΦ 0 )/K + , (r cosΦ 0 )/K − ],such that the solution <strong>of</strong> (8) with δ(s) = ǫµ(s) andinitial condition Φ(s 0 ) = Φ 0 is T -periodic.(ii) If µ(s) is chosen so that K + /K − < (cosΦ 0 ) −1 , thenthe image <strong>of</strong> the T -periodic solution Φ(s) in part (i) iscontained in the interval(Φ − , Φ + ) =(cos −1( K +K − cosΦ 0), cos −1( K − ) )K + cosΦ 0 ,which is a subset <strong>of</strong> (0, π/2).Remark 2.3: By choosing µ(s) = κ(s)‖σ ′ (s)‖, we haveK + = K − = 1, ǫ + = ǫ − = r cosΦ 0 . In this case, theproposition above implies that, for all Φ 0 ∈ (0, π/2), settingδ(s) = rκ(s)‖σ ′ (s)‖ cosΦ 0 , the virtual constraint generatorhas a T -periodic solution Φ(s) whose image is in the interval(0, π/2) mod2π. As a matter <strong>of</strong> fact, one can readily verifythat the solution in question is constant, Φ(s) = Φ 0 , whichcorresponds to the situation when the bicycle has a constantroll angle as it travels around C. The proposition providesgreat flexibility in finding virtual holonomic constraints withthe property that the roll angle is confined within the interval(0, π/2) mod2π. All such constraints are compatible with themaneuvering problem.Example 2.4: Suppose C is an ellipse with major semiaxisA, minor semiaxis B, and 2π-periodic parametrizationσ(s) = (Acos s, B sin s), with A = 15, B = 5. Thecurvature is κ(s) = AB/(A 2 sin 2 s + B 2 cos 2 s) 3/2 . For theinitial condition <strong>of</strong> the virtual constraint generator, we pickΦ(0) = π/3. Following Proposition 2.2, we need to choosea 2π-periodic function µ(s) > 0, set δ(s) = ǫµ(s), and findthe unique value <strong>of</strong> ǫ > 0 guaranteeing that the solutionwith initial condition Φ(0) = π/3 is 2π-periodic. There ismuch freedom in the choice <strong>of</strong> µ(s). For instance, pickingµ(s) = 1, we numerically find ǫ ≈ 0.927. The correspondingvirtual holonomic constraint is depicted in Figure 2. Thecondition, in Proposition 2.2(ii), that K + /K − < (cosφ 0 ) −1is very conservative. Indeed, with our choice <strong>of</strong> µ we haveK + = 3, K − = 1/3 and thus the condition is violated. Yet,the image <strong>of</strong> the virtual constraint is contained in the interval(0, π/2).III. MOTION ON THE CONSTRAINT MANIFOLDHaving chosen δ(s) as in Proposition 2.2(ii) and an associatedvirtual holonomic constraint ϕ = Φ(s) satisfying (8),3


pi/2pi/4Φ(s)00 pi/2 pi 3pi/2 2piFig. 2. <strong>Virtual</strong> holonomic constraint for the ellipse in Example 2.4.the next step is to analyse the dynamics on the constraintmanifold Γ = {(q, ˙q) ∈ X : ϕ = Φ(s), ˙ϕ = Φ ′ (s)ṡ}. Theseare the zero dynamics <strong>of</strong> (6) with output function ϕ − Φ(s).The feedback making Γ invariant is found by imposing thatddt [Φ′ (s)ṡ] ∣ Γ= ¨ϕ ∣ Γ. Expanding both sides <strong>of</strong> the equationabove, using identity (8), and the fact that δ(s) ≠ 0, weobtain the feedback making Γ invariant[− ṡ2Φ ′′ + 1 δ h ((1 − hκ sin Φ)κ‖σ′ ‖ + bκ ′]+ bκσ ′ ⊤ σ ′′ /‖σ ′ ‖ 2 )‖σ ′ ‖ cosΦ .u = h−1 g sinΦδSubstituting this feedback in the s dynamics we get thedynamics on Γ,where¨s = Ψ 1 (s) + Ψ 2 (s)ṡ 2 , (9)Ψ 1 (s) = h−1 g sin Φ(s)δ(s)Ψ 2 (s) = − 1 [Φ ′′ (s) + 1 δ(s) h ((1 − hκ(s)sin Φ(s))κ(s)‖σ′ (s)‖]+ bκ ′ (s) + bκ(s)σ ′ (s) ⊤ σ ′′ (s)/‖σ ′ (s)‖ 2 )cosΦ(s)‖σ ′ (s)‖ .(10)System (9) describes the motion on Γ in the followingsense. If the bicycle is initialized on the curve C, withinitial roll angle ϕ(0) = Φ(s 0 ) for some s 0 ∈ R modT,and with initial angular velocity ˙ϕ(0) = Φ ′ (s 0 )ṡ 0 for someṡ 0 ∈ R, then the bicycle remains on C, its roll angle satisfiesϕ(t) = Φ(s(t)) for all t ≥ 0, and the position s and velocityṡ <strong>of</strong> the bicycle on C evolve according to (9). In order forthe virtual holonomic constraint to be compatible with themaneuvering problem, we need to verify whether or not thebicycle traverses the entire curve C with bounded speed, i.e.,that there exist ¯t > 0, ǫ > 0 such that ṡ(t) > ǫ > 0 for allt ≥ ¯t, and limsup t→∞ ṡ(t) < ∞. The next result exploresgeneral properties <strong>of</strong> systems <strong>of</strong> the form (9).Proposition 3.1: Consider a differential equation <strong>of</strong> theform (9), where Ψ 1 and Ψ 2 are T -periodic and locallyLipschitz∫functions such that Ψ 1 (s) > 0 for all s andT0 Ψ 2(s)ds < 0. Then, there exists a real-valued T -periodicfunction ν(s), with ν(s) > 0, such that the set R = {(s, ṡ) :ṡ = ν(s)} is exponentially stable for (9), with domain<strong>of</strong> attraction containing the set D = {(s, ṡ) : ṡ ≥ 0}.sMoreover, for all initial conditions in {(s, ṡ) : ṡ ≥ 0}, thefunction t ↦→ ν(s(t)) is periodic and so ṡ(t) is asymptoticallyperiodic.Remark 3.2: It can be shown that the domain <strong>of</strong> attraction<strong>of</strong> the set R in the foregoing proposition is {(s, ṡ) : ṡ >−ν(s)}.Pro<strong>of</strong>: The set {(s, ṡ) : ṡ ≥ 0} is positively invariantfor (9) because ¨s|ṡ=0 = Ψ 1 (s) > 0 by assumption. Since theinequality is strict, we have ṡ(t) > 0 for all t > 0. In the rest<strong>of</strong> the pro<strong>of</strong> we will restrict initial conditions on D. Lettingz = ṡ 2 , we have ż = 2ṡ(Ψ 1 (s) + Ψ 2 (s)z). Since ṡ > 0 forall t > 0, we can use s as a time variable:dzds = 2Ψ 1(s) + 2Ψ 2 (s)z. (11)The above is a scalar linear T -periodic system. As before,if z(s 0 ) ≥ 0, then z(s) > 0 for all s > s 0 . Letting φ(s) =exp(2 ∫ s0 Ψ 2(τ)dτ), the solution <strong>of</strong> the linear system withinitial condition z(s 0 ) isz(s) = φ(s − s 0 )z(s 0 ) + 2∫ ss 0φ(s)φ −1 (τ)Ψ 1 (τ)dτ.System (11) has a T -periodic solution if and only if thereexists z 0 such that z 0 = z(s 0 ) = z(s 0 + T), i.e, z 0 =φ(T)z 0 +2 ∫ s 0+Ts 0φ(s 0 +T)φ −1 (τ)Ψ 1 (τ)dτ. <strong>Using</strong> the factthat φ(s + u) = φ(s)φ(u), the condition becomes∫ Tz 0 = φ(T)z 0 + 2 φ(T)φ −1 (τ)Ψ 1 (τ)dτ. (12)0By assumption, 0 < φ(T) < 1, so the equation abovehas a unique solution z 0 > 0 and (11) has a unique T -periodic solution ¯z(s) > 0. Letting ˜z(k) = z(s 0 + kT) − z 0and using identity (12), we have ˜z(k + 1) = φ(T)˜z(k).Since φ(T) < 1, the origin <strong>of</strong> this discrete-time systemis globally exponentially stable, proving that the T -periodicsolution ¯z(s) is globally exponentially stable for (11). Letν(s) = √¯z(s) and return to system (9). For all initialconditions (s(0), ṡ(0)) ∈ D, we have ṡ(t) > 0 for all t > 0,and ṡ(t) = √ z(s(t)), where z(s) is the solution <strong>of</strong> (11)with initial condition z(s(0)) = ṡ(0) 2 . Since ¯z(s) is globallyexponentially stable for (11), R is exponentially stable for (9)with domain <strong>of</strong> attraction containing D.It remains to be shown that t ↦→ ν(s(t)) is periodic.Consider the scalar differential equation ṡ = √¯z(s), whosevector field is T -periodic. Denote by ̺(t, s 0 ) its solutionwith initial condition s(0) = s 0 at time t. For all s 0 ,̺(t, s 0 + T) = ̺(t, s 0 ) + T . Indeed, ̺(0, s 0 ) + T = s 0 + Tandddt [̺(t, s 0) + T] = √¯z(̺(t, s 0 )) = √¯z(̺(t, s 0 ) + T).Next, since ṡ = √¯z(s) > 0, there exist unique times ¯t > 0and t 0 such that ̺(¯t, 0) = T and ̺(t 0 , 0) = s 0 , and̺(t + ¯t, s 0 ) = ̺(t + ¯t + t 0 , 0) = ̺(t + t 0 , T)= ̺(t + t 0 , 0) + T = ̺(t, s 0 ) + T.4


It then follows that for all t and s 0 , d̺(t + ¯t, s 0 )/dt =d̺(t, s 0 )/dt or, what is the same, for any s 0 , t ↦→ ν(s(t)) isperiodic.We now show that if the curvature <strong>of</strong> C satisfies an integralbound, the bicycle satisfies the hypotheses <strong>of</strong> Proposition 3.1,and so the motion on the constraint manifold satisfies therequirements <strong>of</strong> the maneuvering problem.Proposition 3.3: If the curvature <strong>of</strong> C satisfies the inequality∫1 Tκ(s)ds 0, such that the closedorbit <strong>of</strong> (9) R = {(s, ṡ) : ṡ = ν(s)} is exponentiallystable, and D = {(s, ṡ) : ṡ ≥ 0} lies in its domain <strong>of</strong>attraction. Moreover, for all initial conditions in D, ṡ(t) isasymptotically periodic.Remark 3.4: The existence <strong>of</strong> the isolated closed orbit R<strong>of</strong> (9) which is exponentially stable implies that the reducedmotion on the constraint manifold Γ is not Euler-Lagrange.Getz’s bicycle is therefore an example <strong>of</strong> an Euler-Lagrangesystem for which there is a virtual holonomic constraint suchthat the reduced motion is not Euler-Lagrange.Pro<strong>of</strong>: By Proposition 2.2(i), the virtual constraintsatisfies Φ(s) ∈ (0, π/2), and so sin Φ(s) > 0. Sinceδ(s) > 0 it follows that Ψ 1 (s) > 0. <strong>Using</strong> equality (8),we haveΦ ′′ = δ ′ − rκ ′ ‖σ ′ ‖ cosΦ − (rκ‖σ ′ ‖) 2 sinΦcosΦ+ rκ‖σ ′ ‖δ sin Φ − rκσ ′ ⊤ σ ′′ /‖σ ′ ‖.Substituting in the expression for Ψ 2 in (10) we getΨ 2 = − δ′δ − κ‖σ′ ‖[bδ sin Φ − ‖σ ′ ‖ cosΦδh·(κ sin Φ b2 + h 2 ) ]− 1h≤ − δ′δ + κ‖σ′ ‖ 2cosΦ(κ sinΦ b2 + h 2 )− 1 .δhhSince ∫ T0 δ′ (s)/δ(s) = lnδ(T) − lnδ(0) = 0, using thebounds in Proposition 2.2(ii), we have∫ T ∫ Tκ‖σ ′ ‖ 2Ψ 2 (s)ds ≤ cosΦ(κ sinΦ b2 + h 2 )− 1 ds00 δhh( κ‖σ ′ ‖ 2 ) ∫ T≤ max cosΦ(κ(s) − b2 + h 2 )− 1 dss δh0 h( κ‖σ ′ ‖ 2 ) (b≤ max cosΦ − 2 + h 2 ∫ )Tκ(s)ds − T < 0.s δhhRemark 3.5: If the parametrization σ(s) <strong>of</strong> C has unitspeed (i.e., ‖σ ′ (s)‖ = 1), then T is the length <strong>of</strong> C, andthe integral (1/T) ∫ Tκ(s)ds is equal to (turning number <strong>of</strong>0C)×2π/T . The turning number is the number <strong>of</strong> revolutions0ṡ6420−2−4R−60 1 2 3 4 5 6Fig. 3. Phase portrait <strong>of</strong> the dynamics on Γ and set R for the ellipse inExample 2.4. The shaded region is the domain <strong>of</strong> attraction <strong>of</strong> R.that the tangent vector to C makes as a point is moved oncearound C. For a Jordan curve, the turning number is ± 1.Example 3.6: We return to ellipse <strong>of</strong> Example 2.4 and thevirtual constraint displayed in Figure 2. For this example,(1/2π) ∫ 2πκ(s)ds ≈ 0.142, and h/(b 2 + h 2 ) = 0.308 and0thus∫(13) is satisfied. Indeed, one can numerically check thatT0 Ψ 2(s)ds ≈ −27.5 < 0, and Proposition 3.1 applies. Thephase portrait <strong>of</strong> the dynamics on the constraint manifoldis displayed in Figure 3. The figure illustrates the set R,corresponding to the steady-state velocity pr<strong>of</strong>ile <strong>of</strong> thebicycle on Γ. The domain <strong>of</strong> attraction <strong>of</strong> R, shaded in thefigure, is the set {(s, ṡ) : ṡ > −ν(s)}, as pointed out inRemark 3.2.Example 3.7: Suppose C is a circle <strong>of</strong> radius R. The curvatureis constant, κ = 1/R. For any Φ 0 ∈ (0, π/2), pickingδ = (r/R)cos Φ 0 , as in Remark 2.3, we obtain the constantvirtual constraint Φ(s) = Φ 0 . Equation (11) becomesdz/ds = (gR)/(hr)tan Φ 0 − 1/(hr)(1 − (h/R)sinΦ 0 )z.The above is a linear time-invariant system with constantinput which is stable if R > h sin Φ 0 . The periodic solution¯z(s) in this case is simply the equilibrium <strong>of</strong> the systemabove, ¯z = gR 2 tan Φ 0 /(R −h sinΦ 0 ), and thus the asymptoticvelocity <strong>of</strong> the bicycle on Γ is constant, and reads asν = R √ g tanΦ 0 /(R − h sin Φ 0 ). It can be verified that νis an increasing function <strong>of</strong> Φ 0 . The conclusion is that thebicycle can go around the circle with any constant roll anglein the interval (0, π/2). The larger is the roll angle Φ 0 , thehigher is the asymptotic speed <strong>of</strong> the bicycle.IV. SOLUTION OF THE MANEUVERING PROBLEMTheorem 4.1: Suppose that the mean curvature <strong>of</strong> C satisfiesinequality (13). If Φ(s) is a virtual holonomic constraintsatisfying (7) and such that Φ(s) ∈ (0, π/2) for all s ∈R modT, then the feedbacku = 1∆(q)s( 1(h gs ϕ − Φ ′′ + 1 h)+ bκσ′⊤ σ ′′‖σ ′ ‖ 2 )c ϕ ‖σ ′ ‖((1 − hκs ϕ )κ‖σ ′ ‖ + bκ ′)ṡ 2 + K 1 e + K 2 ė ,(14)where ∆(q) = Φ ′ (s) + h −1 bκ(s)c ϕ ‖σ ′ (s)‖, e = ϕ − Φ(s),ė = ˙ϕ −Φ ′ (s)ṡ, and K 1 , K 2 are positive design parameters,5


solves the maneuvering problem and has the followingproperties:(i) The constraint manifold Γ is invariant and locally exponentiallystable for the closed-loop system (6), (14).(ii) There exists a C 1 and T -periodic function ν(s) :R modT → R, with ν(s) > 0 such that the setR = {(q, ˙q) ∈ Γ : ṡ = ν(s)} is asymptotically stablefor the closed-loop system and its domain <strong>of</strong> attractionis a neighbourhood <strong>of</strong> the set {(q, ˙q) ∈ Γ : ṡ > 0}.(iii) For initial conditions in the domain <strong>of</strong> attraction <strong>of</strong> R,the bicycle traverses the entire curve C and its speed isasymptotically periodic.Pro<strong>of</strong>: By construction, Φ(s) satisfies (7) and, as arguedin the pro<strong>of</strong> <strong>of</strong> Lemma 2.1, system (6) with output e hasuniform relative degree 2 on Γ. The feedback (14) is afeedback linearizing controller making the origin <strong>of</strong> the (e, ė)subsystem, and hence Γ, exponentially stable, proving part(i).As for part (ii), we know from Proposition 3.3 that thereexists a T -periodic function ν(s) such that the set R isexponentially stable for the restriction <strong>of</strong> the dynamics on Γ.In order to prove that R is asymptotically stable for initialconditions outside <strong>of</strong> Γ, note that R is a one-dimensionalsubmanifold <strong>of</strong> Γ diffeomorphic to S 1 , and hence compact.Owing to the reduction principle for asymptotic stability<strong>of</strong> compact sets (see [14], [15]), the asymptotic stability<strong>of</strong> R relative to Γ together with the asymptotic stability<strong>of</strong> Γ implies that R is asymptotically stable for (6). ByProposition 3.3, its domain <strong>of</strong> attraction contains the set{(q, ˙q) ∈ Γ : ṡ > 0}.Finally, concerning part (iii), since on R we have ṡ =ν(s) > 0, for all initial conditions in the domain <strong>of</strong> attraction<strong>of</strong> R there exists a time ¯t > 0 such that ṡ(t) > 0 for all t ≥ ¯t,and hence the bicycle traverses the entire curve C. Since Ris diffeomorphic to S 1 , since it is asymptotically stable, andon it solutions are periodic, R is a stable limit cycle <strong>of</strong> theclosed-loop system. Therefore, solutions in the domain <strong>of</strong>attraction <strong>of</strong> R are asymptotically periodic.Example 4.2: We return to example <strong>of</strong> the ellipse, withthe virtual constraint depicted in Figure 2. The simulationresults for the closed-loop system with controller (14) andK 1 = 100, K 2 = 10 are shown in Figures 4, 5 forthe initial condition (ϕ(0), ˙ϕ(0), s(0), ṡ(0)) = (0, 0, 0, 1).Figure 4 illustrates the exponential convergence <strong>of</strong> ϕ(t) tothe constraint Φ(s(t)). Figure 5 displays the projection <strong>of</strong>the phase curve on the (s, ṡ) plane and its convergence tothe submanifold R.REFERENCES[1] N. Getz, “<strong>Control</strong> <strong>of</strong> balance for a nonlinear nonholonomic nonminimumphase model <strong>of</strong> a bicycle,” in American <strong>Control</strong> Conference,1994, pp. 148–151.[2] N. Getz and J. Marsden, “<strong>Control</strong> for an autonomous bicycle,” inIEEE International Conference on Robotics and Automation, vol. 2,May 1995, pp. 1397–1402 vol.2.[3] J. Hauser, A. Saccon, and R. Frezza, “Achievable motorcycle trajectories,”in IEEE Conference on Decision and <strong>Control</strong>, December 2004.[4] J. Hauser and A. Saccon, “Motorcycle modeling for high-performancemaneuvering,” IEEE <strong>Control</strong> Systems Magazine, pp. 89–105, October2006.pi/23pi/8pi/4pi/8Φ(s(t))ϕ(t)00 1 2 3 4 5 6Fig. 4. Simulation <strong>of</strong> the closed-loop system for the ellipse example. Thesolution converges to the constraint manifold Γ.ṡ6420−2−4−60 1 2 3 4 5 6tRFig. 5. Simulation <strong>of</strong> the closed-loop system for the ellipse example. Thesolution converges to the submanifold R ⊂ Γ.[5] J. Hauser, S. Sastry, and G. Meyer, “Nonlinear control design forslightly non-minimum phase systems: Applications to V/STOL aircraft,”Automatica, vol. 28, no. 4, pp. 665–679, 1992.[6] C. Nielsen, L. Consolini, M. Maggiore, and M. Tosques, “Path followingfor the pvtol: A set stabilization approach,” in IEEE Conferenceon Decision and <strong>Control</strong>, Cancun, Mexico, December 2008.[7] F. Plestan, J. Grizzle, E. Westervelt, and G. Abba, “Stable walking <strong>of</strong> a7-DOF biped robot,” IEEE Transactions on Robotics and Automation,vol. 19, no. 4, pp. 653–668, 2003.[8] E. Westervelt, J. Grizzle, and D. Koditschek, “Hybrid zero dynamics <strong>of</strong>planar biped robots,” IEEE Transactions on Automatic <strong>Control</strong>, vol. 48,no. 1, pp. 42–56, 2003.[9] C. Canudas-de-Wit, “On the concept <strong>of</strong> virtual constraints as a toolfor walking robot control and balancing,” Annual Reviews in <strong>Control</strong>,vol. 28, pp. 157–166, 2004.[10] A. Shiriaev, J. Perram, and C. Canudas-de-Wit, “Constructive toolfor orbital stabilization <strong>of</strong> underactuated nonlinear systems: <strong>Virtual</strong>constraints approach,” IEEE Transactions on Automatic <strong>Control</strong>.,vol. 50, no. 8, pp. 1164–1176, August 2005.[11] L. Freidovich, A. Robertsson, A. Shiriaev, and R. Johansson, “Periodicmotions <strong>of</strong> the Pendubot via virtual holonomic constraints: Theory andexperiments,” Automatica, vol. 44, pp. 785–791, 2008.[12] A. Shiriaev, L. Freidovich, A. Robertsson, R. Johansson, and A. Sandberg,“<strong>Virtual</strong>-holonomic-constraints-based design <strong>of</strong> stable oscillations<strong>of</strong> Furuta pendulum: Theory and experiments,” IEEE Transactionson Robotics, vol. 23, no. 4, pp. 827–832, 2007.[13] L. Consolini and M. Maggiore, “<strong>Virtual</strong> holonomic constraints forEuler-Lagrange systems,” in Proceedings <strong>of</strong> the 8th IFAC Symposiumon Nonlinear <strong>Control</strong> Systems (NOLCOS), Bologna, Italy, 2010.[14] M. El-Hawwary and M. Maggiore, “Reduction principles for stability<strong>of</strong> closed sets,” 2009, submitted to Systems and <strong>Control</strong> Letters.[15] ——, “Reduction principles and the stabilization <strong>of</strong> closed sets forpassive systems,” 2009, http://arxiv.org/abs/0907.0686v1.s6

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!