摘要

本文介绍了基于反作用轮的 3D 倒立摆 Cubli 的非线性分析和控制设计。 使用广义动量的概念,将基于反作用轮的 3D 倒立摆的关键特性与 1D 情况的特性进行比较,以提出相对简单和直观的非线性控制器。 最后,在 Cubli 上实现了所提出的控制器,并给出了实验结果

INTRODUCTION

本文介绍了图 1 所示 Cubli 的非线性分析和控制。Cubli 是一个边长为 150 mm 的立方体,三个反作用轮相互垂直安装。 与其他 3D 倒立摆试验台 [1] 和 [2] 相比,Cubli 具有两个独特的功能。 一是其占地面积相对较小(因此得名 Cubli,源自瑞士德语中“立方体”的缩略词)。 另一个特点是它能够在没有任何外部支撑的情况下从静止位置跳起来,通过突然制动以高角速度旋转的反作用轮。 在 [3] 中介绍了跳跃的概念,在 [4] 中介绍了线性控制器,本文重点分析非线性模型和非线性控制策略。

与 [5] 和 [6] 中提出的工作相反,本文从纯机械的角度来处理控制器设计。 Cubli 的基本机械特性被利用来提出具有物理洞察力的简单直观的推导([5]:1D,反作用轮,反馈线性化;[6]:3D,检测质量,线性控制器,局部稳定性)。 由此产生的平滑、渐近稳定的控制律提供了基于四个直观参数的相对简单的调整策略,从而使控制律适用于实际实现

本文的其余部分结构如下:第 II 节首先介绍了反作用轮基于一维倒立摆的简要非线性分析和控制。 接下来,非线性系统动力学是从第 III 节中的第一原理推导出来的,然后分别在第 IV 节和第 V 节中进行详细的分析和控制设计。 最后,实验结果在第六节中给出,结论在第七节中得出。

ANALYSIS AND CONTROL OF A 1D INVERTED PENDULUM

本节介绍了基于 1D 反作用轮倒立摆的分析和非线性控制策略。 由于 1D 和 3D 情况下某些关键属性的相似性,分析 3D 倒立摆在后面的部分。

Modelling

描述如图 2 所示的一维倒立摆的位置。接下来,让 w 表示反作用轮的转动惯量,Φo 表示系统围绕身体固定坐标系中枢轴点的总转动惯量,以及 mtotl 代表总质量和枢轴点到整个系统重心的距离。

系统的拉格朗日 [7] 由下式给出:

(1)ι=12Θo^φ2˙+12Θw(φ˙+ψ˙)2mgcosφ

其中 Θo^=ΘoΘw>0m=mtotl,g 是恒定的重力加速度。 广义动量定义为:

(2)pφ:=ιφ=Θoφ+Θwψ˙

(3)pψ:=ιψ=Θw(φ+ψ˙)

让 T 表示电机施加到反作用轮上的扭矩。 现在,可以使用欧拉-拉格朗日方程将扭矩 T 作为非势能推导出运动方程。 这产生:

(4)p˙φ=ιφ=mgsinφ

(5)p˙ψ=ιψ+T=T

请注意,(2)和(3)中广义动量的引入导致系统的简化表示,其中(4)类似于由(5)中的积分器增强的倒立摆。

由于反作用轮的实际位置并不重要,我们引入 x:=(φ;pφ;pψ) 来表示简化的状态集并描述机械系统的动力学如下:

(6)x˙=(φ˙p˙φp˙ψ)=f(x,T)=(Θo^1(pφpψ)mgsinφT)

Analysis

(1)状态空间:对于后续分析,状态空间定义为:χ=x|φ(π,π],pφR,pψR (2)均衡:系统的均衡由下式给出:ε=(x,T)χ×R|f(x,T)=0 评估pφ˙=pψ˙=φ˙=0给出以下平衡:

(7)ε1={(x,T)χ×R|φ=0,pφ=pψ,T=0}

(8)ε2={(x,T)χ×R|φ=π,pφ=pψ,T=0}

每个均衡都是一个封闭的不变量集,其常数 p可能不为零。 从机械上讲,这意味着摆锤可以在直立位置静止,而其反作用轮以恒定角速度旋转。 进一步的线性分析表明,在李雅普诺夫的意义上,直立平衡点 ε1 是不稳定的,而悬挂平衡点 ε2 是稳定的

Control Design

控制器的目标是将倒立摆驱动到直立位置 =0 并使反作用轮的角速度 ψ˙=0 为零,具体来说:

(9)limtx=0

现在,考虑以下反馈控制律:

(10)u(φ,pφ,pψ)=k1mgsinφ+k2pφk3pψ

其中:

k1=1+αΘ0^+βγmg+δk2=βΘ0^cosφ+γ(1+αΘ0^)k3=βΘ0^cosφ+γα,β,γ,δ>0

定理 2.1:(10)中给出的控制律 T=u(φ,pφ,pψ)使得平衡点 x=0在域==,p=0,p=0 上稳定且渐近稳定

证明:考虑下面的李雅普诺夫候选函数 V:x

(11)V(x)=12αpφ2+mg(1cosφ)12δΘ0^z2

where z=z(x)=pφ(1+αΘ0^)+βsinφpψ存在类κ1函数a(x):=x2 with <min,, such that Vxa(pφ,φ,z)2,xχ and V(0)=0 这里V(x) 是正定和有效的李雅普诺夫候选。 上述李雅普诺夫候选函数沿闭环轨迹的时间导数为:

V˙(x)=mgΘ^0(zβsinφ)sinφ+1δΘ^0zz˙=mgΘ^0βsin2φγδΘ^0z20,xX.

由于x,x 我们从李雅普诺夫稳定性定理得出结论,点 x=0 是稳定的。 现在,为了证明 x=0χ 中的渐近稳定性,让我们定义集合:

R={xXV˙(x)=0}

考虑 R 的不变集内的轨迹 x(t)。显然,它们必须满足 =0,z=0 和系统动力学 (6)。 这意味着 x(t)0,因此 R 中最大的不变量集是 x=0。 现在,根据 Krasovskii-LaSalle 原理 [9](定理 4.4),对于任何轨迹 x(t)

limtx(t)=0,x(0)X

有关基于一维反作用轮的倒立摆的类似控制设计和稳定性证明,请参见 [10]。

Remarks

(1)、Lyapunov 函数 (11) 的解释:Lyapunov 函数 (11) 可以通过标准的反推方法 [9]、[10] 找到。 如果忽略反作用轮动力学并且假设 p 是控制输入,则函数V~(φ,pφ)=12αpφ2+mg(1cosφ) 是有效的李雅普诺夫函数候选。 沿轨迹要求V~˙0将意味着pψ=pφ(1+αΘ^0)+βsinφ,即 z=0。这导致解释 z 惩罚与控制律的偏差,该偏差将应用于 忽略车轮动力学时的系统。 因此,降低调整参数 δ 会导致更积极的控制器,该控制器将倾斜置于车轮速度之上。 (2)、控制器 (10) 的扩展:Lyapunov 函数 (11) 可以通过额外的积分器状态进行扩充:

V^(x)=V(x)+ν2δΘ^0zint2 where zint(t)=z0+0tz(τ)dτ 因此,控制器 (10) 必须扩展 zint,u^=u+νzint 以提供直立平衡的稳定性。 这对于实际实施也可能很重要,因为它考虑了建模错误。

控制律(10)的解释:(10)中给出的控制律可以改写为 :

u=βmgp¨φ+k1p˙φ+γ(1+αΘ^0)pφγpψ

where :

pψ=u0+0tu(τ)dτ

这只不过是由比例、(双)微分和积分部分组成的线性控制器。 此外 $$可以解释为积分器权重。

SYSTEM DYNAMICS OF THE REACTION WHEEL-BASED 3D INVERTED PENDULUM

Θ0 表示整个 Cubli 围绕枢轴点 O 的总转动惯量(见图 3),Θwi;i=1,2,3 表示每个反作用轮的转动惯量(在相应旋转轴的方向上)并定义 Θw:=diag(Θw1,Θw2,Θw3),Θ0:=Θ0Θw。接下来,让 表示从枢轴点到重心的位置向量乘以总质量, 表示重力向量。张量在特定坐标系上的投影由前面的上标表示,即BΘ0R3×3,B(m)=BmR3。箭头符号用于强调向量(和张量)应该先验地被认为是赋范向量空间中的线性对象,与其相对于特定坐标系的坐标表示分离。由于身体固定坐标系 B 是最常用的投影坐标系,为了简单起见,我们通常将其前面的上标去掉。进一步注意,BΘ^0=Θ^0R3×3是正定的。

系统的拉格朗日由下式给出:

(12)L(ωh,g,ωw,ϕ)=12ωhTΘ^0ωh+12(ωh+ωw)TΘw(ωh+ωw)+mTg

其中B(ωh)=ωhR3 表示主体角速度B(ωw)=ωwR3表示反作用轮角速度。 TR3 的组件包含施加到反作用轮上的扭矩。 在身体固定坐标系中,向量 m 是常数,而 g 的时间导数由 B(g˙)=0=g˙+ωh×g=g˙+ω~hg 给出。 应用于向量 vR3 的波浪号运算符,即 v~表示v~a=v×a holds aR3 的偏斜对称矩阵。 介绍广义动量。

\tag not allowed in aligned environment p_{{w}}= ^{}={w}({h}+{w}) $$

导致运动方程由下式给出:

\tag not allowed in aligned environment

(16)p˙ωh=ω~hpωh+m~g,

(17)p˙ωw=T.

请注意,有多种推导运动方程的方法; 例如,在 [4] 中使用了虚拟功率的概念。 附录 2 显示了使用拉格朗日形式主义的推导,并强调了 1D 和 3D 情况之间的相似之处。 拉格朗日形式主义也激发了广义动量的引入。

现在,使用v˙=v˙+ωh×v,旋转坐标系中向量的时间导数,(15)-(17)可以进一步简化为:

\tag not allowed in aligned environment

(19)p˙ωh=m×g,

(20)p˙ωw=T.

这特别突出了 1D 和 3D 倒立摆之间的相似性。 由于向量的范数与其在坐标系中的表示无关,因此脉冲变化的 2 范数由p˙ωh2=m2g2sinϕ给出。 在这种情况下,ϕ 表示向量 mg 之间的角度。 此外,在 1D 情况下,pww 是所施加扭矩 T 的积分。

ANALYSIS

Conservation of Angular Momentum

从(19)可以看出 的变化率总是与mg 正交。 由于g 是常数, 在整个轨迹中永远不会改变它在g方向上的分量。 用 Cubli 的身体固定坐标系表示,可以写成ddt(pωhTg)0 这不过是绕轴角动量守恒~

State Space

由于后续的分析和控制将在固定体坐标系中进行,状态空间定义为集合 $={x=(g, p_{{h}}, p{{w}}) ^{9} |g|{2}= 9.81} {h}={0}^{-1}(p_{{h}}-p{_{w}})$。

Equilibria

该程序与第 II-B.2 小节中介绍的程序相同。 从 (19) 中可以看出,只有当mg, i.e., g=±mm2g2 时,才满足条件 p˙ωh=0。 从 (20) 得出 pww=const,T=0。使用 (15) 和 (16) 导致 ωh=Θ^01(pωhpωw)g and pωhg, 这正好对应于pwh 的守恒部分。 将所有内容结合在一起会导致以下平衡:

E1={(x,T)X×R3gTm=g2m2,pωhm,Θ^01(pωhpωw)m,T=0},E2={(x,T)X×R3gTm=g2m2,pωhm,Θ^01(pωhpωw)m,T=0}.

线性化表明,在李雅普诺夫的意义上,直立平衡点 E1 是不稳定的,而悬挂平衡点 E2 是稳定的。

NONLINEAR CONTROL OF THE REACTION WHEEL-BASED 3D INVERTED PENDULUM

让我们首先定义控制目标。 由于角动量g 的方向上是守恒的,控制器只能将 的与g 正交的分量归零。 因此,将向量 分成两部分是很方便的:一个在 g 的方向上,另一个与它正交,即: pωh=pωh+pωhg and pωhg=(pωhTg)gg22.

从 (19) 和角动量守恒,可以直接得出:

(21)B(p˙ωh)=p˙ωh+ω~hpωh=m~g

控制目标的另一个合理补充是 Cubli 的角速度 !h 渐近收敛到零。 因此,控制目标可以表述为将系统推向闭不变量:

T={xXgTm=g2m2,ωh=Θ^01(pωhpωw)=0,pωh=0}

为了证明渐近稳定性,必须排除悬挂平衡(稍后将变得清楚)。 这可以通过引入集合 =来完成,其中 x 表示悬垂平衡 wh=0

x={xXg=g2m2m,pωh=0,pωh=pωw}

接下来,考虑控制器:

(22)u=K1m~g+K2ωh+K3pωhK4pωw

where:

K1=(1+βγ+δ)I+αΘ^0K2=αΘ^0p~ωh+βm~g~+p~ωhK3=γ(I+αΘ^0(IggTg22))K4=γI,α,β,γ,δ>0

and IR3×3 is the identity matrix

定理 5.1:(22)中给出的控制器使由(18)-(20)定义的系统的闭不变集 $$在 x 上稳定和渐近稳定。

证明:考虑以下李雅普诺夫候选函数x

(23)V(x)=12αpωhTpωh+mTg+m2g2+12δzTΘ^01z

with:

z=z(x)=αΘ^0pωh+pωh+βm~gpωw

K函数a(x):=ϵx2, with ϵ<min{2π2m2g2,12δΘ^02,α2} is such that V(x)a((pωh,pωw,z)2),xX 此外V(x=x0)=0 意味着 x=x0,其中 x0 。 因此 V 是一个正定函数和一个有效的 Lyapunov 候选

接下来,沿着闭环系统的轨迹评估

V˙(x)=αpωhpωh+mTg˙+1δzTΘ^01z˙=mTg~Θ^01(βg~m+z)+1δzTΘ^01z˙=β(g~m)TΘ^01(g~m)+zTΘ^01(m~g+1δz˙)=β(g~m)TΘ^01(g~m)γδzTΘ^01z0,xX.

由于 V˙(x)0,xX,我们从李雅普诺夫稳定性定理得出结论,点 x0是稳定的:

为了证明集合 τχ 中的渐近稳定性,定义集合 R:={xXV˙(x)=0}。 条件 V˙(x)=0 立即导致 z=0,m||g,使得R 可以重写为 R={xXmg,pωw=αΘ^0pωh+pωh}。 现在,让我们考虑包含在 R 中的不变集内轨迹的系统动力学。这给出:

(24)gmg=mm2g2g˙=0ωhgg˙=ω~hg

(25)gm,z=0ωh=αpωhωhpωh

然而,由于 pwhg 根据定义,(24) 和 (25) 意味着 wh=0pwh=0。这表明 $$ 是 的最大不变子集。现在,根据 Krasovskii-LaSalle 原理 [9](定理 4.4) ,由此可知,对于任何轨迹x(t)

limtx(t)=xf,x(0)X,xfT

Remarks