刚体运动学-速度和加速度的表示方法(连体坐标系和世界坐标系)

0. 符号定义

刚体运动学-速度和加速度的表示方法(连体坐标系和世界坐标系)_第1张图片
自己画了一个图
刚体运动学-速度和加速度的表示方法(连体坐标系和世界坐标系)_第2张图片

  • 下标 b b b是连体坐标系原点 O b O_b Ob相对世界坐标系原点 O p O_p Op的矢量在世界坐标系下的表示。
  • 下标 p p p是观察点相对世界坐标系原点 O p O_p Op的矢量在世界坐标系下的表示。
  • 下标 p / b p/b p/b是观察点相对连体坐标系原点 O b O_b Ob的矢量在世界坐标系下的表示。

1. 刚体在连体坐标系下的物理量表示

1.1 矢量端点和刚体不固连

我们先来看最基本的情况,矢量的端点和刚体不固连。

1.1.1 速度表示

该矢量在连体坐标系下的速度为:

x ˙ p / b = x ∘ p / b + ω × x p / b = x ∘ p / b + C ( ω ) x p / b \begin{aligned}\dot{\mathbf{x}}_{p/b}&=\overset{\circ} {\mathbf{x}}_{p/b}+\boldsymbol{\omega}\times\mathbf{x}_{p/b}\\ &=\overset{\circ} {\mathbf{x}}_{p/b}+C({\boldsymbol\omega})\mathbf{x}_{p/b}\end{aligned} x˙p/b=xp/b+ω×xp/b=xp/b+C(ω)xp/b

注意这里的 ω \boldsymbol{\omega} ω是在连体坐标系下描述的(本小节同)。

其中:

  • 左边的速度是矢量 x p / b \mathbf{x}_{p/b} xp/b的相对连体坐标系的绝对导数。
  • 右边速度的第一项是矢量 x p / b \mathbf{x}_{p/b} xp/b相对连体坐标系的相对导数(局部导数),可以理解为是对连体坐标系各个基向量的变化率,用顶端空心点表示。
  • 右边速度的第二项是各基向量对时间的导数。

C ( ω ) = [ 0 − ω 3 ω 2 ω 3 0 − ω 1 − ω 2 ω 1 0 ] C({\boldsymbol\omega})=\left[\begin{array}{ccc} 0 & -\omega_{3} & \omega_{2} \\ \omega_{3} & 0 & -\omega_{1} \\ -\omega_{2} & \omega_{1} & 0 \end{array}\right] C(ω)= 0ω3ω2ω30ω1ω2ω10

1.1.2 加速度表示

该矢量在连体坐标系下的加速度为:

x ¨ p / b = x ∘ ∘ p / b + 2 ω × x ∘ p / b + ω ˙ × x p / b + ω × ( ω × x p / b ) \ddot{\mathbf{x}}_{p/b}=\overset{\circ\circ} {\mathbf{x}}_{p/b}+2\boldsymbol{\omega}\times\overset{\circ} {\mathbf{x}}_{p/b}+\dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b}+\boldsymbol{\omega}\times(\boldsymbol{\omega}\times\mathbf{x}_{p/b}) x¨p/b=x∘∘p/b+2ω×xp/b+ω˙×xp/b+ω×(ω×xp/b)

可以看到除了刚体转动引起的切向加速度 ω ˙ × x p / b \dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b} ω˙×xp/b和法向加速度 ω × ( ω × x p / b ) \boldsymbol{\omega}\times(\boldsymbol{\omega}\times\mathbf{x}_{p/b}) ω×(ω×xp/b)以外,还有矢量端点的相对加速度 x ∘ ∘ p / b \overset{\circ\circ} {\mathbf{x}}_{p/b} x∘∘p/b以及科氏加速度 2 ω × x ∘ p / b 2\boldsymbol{\omega}\times\overset{\circ} {\mathbf{x}}_{p/b} 2ω×xp/b

推导

根据速度的公式一样:
x ˙ p / b = x ∘ p / b + ω × x p / b \begin{aligned}\dot{\mathbf{x}}_{p/b}&=\overset{\circ} {\mathbf{x}}_{p/b}+\boldsymbol{\omega}\times\mathbf{x}_{p/b}\end{aligned} x˙p/b=xp/b+ω×xp/b
再求一次导数:
x ¨ p / b = x ∘ ∘ p / b + ω × x ∘ p / b + ω ˙ × x p / b + ω × x ˙ p / b \begin{aligned}\ddot{\mathbf{x}}_{p/b}&=\overset{\circ\circ} {\mathbf{x}}_{p/b}+\boldsymbol{\omega}\times\overset{\circ} {\mathbf{x}}_{p/b}+\dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b}+{\boldsymbol{\omega}}\times\dot{\mathbf{x}}_{p/b}\end{aligned} x¨p/b=x∘∘p/b+ω×xp/b+ω˙×xp/b+ω×x˙p/b
上面加速度右式的前两项是速度右边的第一项求导得出的,加速度后两项是速度右边的第二项求导得出的,于是我们得到:
再把速度的求导公式代入上式我们最后可以得到结果:
x ¨ p / b = x ∘ ∘ p / b + ω × x ∘ p / b + ω ˙ × x p / b + ω × ( x ∘ p / b + ω × x p / b ) = x ∘ ∘ p / b + 2 ω × x ∘ p / b + ω ˙ × x p / b + ω × ( ω × x p / b ) \begin{aligned}\ddot{\mathbf{x}}_{p/b}&=\overset{\circ\circ} {\mathbf{x}}_{p/b}+\boldsymbol{\omega}\times\overset{\circ} {\mathbf{x}}_{p/b}+\dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b}+{\boldsymbol{\omega}}\times(\overset{\circ} {\mathbf{x}}_{p/b}+\boldsymbol{\omega}\times\mathbf{x}_{p/b})\\&=\overset{\circ\circ} {\mathbf{x}}_{p/b}+2\boldsymbol{\omega}\times\overset{\circ} {\mathbf{x}}_{p/b}+\dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b}+\boldsymbol{\omega}\times(\boldsymbol{\omega}\times\mathbf{x}_{p/b})\end{aligned} x¨p/b=x∘∘p/b+ω×xp/b+ω˙×xp/b+ω×(xp/b+ω×xp/b)=x∘∘p/b+2ω×xp/b+ω˙×xp/b+ω×(ω×xp/b)

1.2 矢量端点和刚体固连

在连体坐标系上,如果我们要描述的是与刚体固连的点的矢量 x p / b \mathbf{x}_{p/b} xp/b相关的物理量,因为矢量和刚体固连,局部导数为零,即 x ∘ p / b = 0 , x ∘ ∘ p / b = 0 \overset{\circ} {\mathbf{x}}_{p/b}=0, \overset{\circ\circ} {\mathbf{x}}_{p/b}=0 xp/b=0,x∘∘p/b=0

1.2.1 速度表示

该矢量在连体坐标系下的速度

x ˙ p / b = ω × x p / b \dot{\mathbf{x}}_{p/b}=\boldsymbol{\omega}\times\mathbf{x}_{p/b} x˙p/b=ω×xp/b

这里其实是①的一个特殊情况。

1.2.2 加速度表示

在速度表示的基础上我们继续计算加速度,该矢量在连体坐标系下的加速度

x ¨ p / b = ω ˙ × x p / b + ω × ( ω × x p / b ) \ddot{\mathbf{x}}_{p/b}=\dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b}+\boldsymbol{\omega}\times(\boldsymbol{\omega}\times\mathbf{x}_{p/b}) x¨p/b=ω˙×xp/b+ω×(ω×xp/b)

2. 刚体在世界坐标系下的物理量表示

实际情况中,我们不是要讨论连体坐标系下的速度,我们可能要将速度定义在世界坐标系中,这时候刚体可能还会有运动,首先对于位移,我们有:

x p = x b + x p / b \mathbf{x}_p=\mathbf{x}_b+\mathbf{x}_{p/b} xp=xb+xp/b

对上式求导我们可以得到速度和加速度的表示。

2.1 矢量端点和刚体不固连

2.1.1 速度表示

该矢量在世界坐标系下的速度为:

x ˙ p = x ˙ b + x ˙ p / b = x ˙ b + x ∘ p / b + ω × x p / b \begin{aligned}\dot{\mathbf{x}}_p&=\dot{\mathbf{x}}_b+\dot{\mathbf{x}}_{p/b}\\ &=\dot{\mathbf{x}}_b+\overset{\circ} {\mathbf{x}}_{p/b}+\boldsymbol{\omega}\times\mathbf{x}_{p/b}\end{aligned} x˙p=x˙b+x˙p/b=x˙b+xp/b+ω×xp/b

注意这里的 ω \boldsymbol{\omega} ω是在世界坐标系下描述的(本小节同)。

如果这里我们还想使用连体坐标系的角速度 ω ′ \boldsymbol\omega' ω以及连体坐标系下的位移 x p / b ′ \mathbf{x}_{p/b}' xp/b、速度 x ˙ p / b ′ \dot{\mathbf{x}}_{p/b}' x˙p/b和加速度 x ¨ p / b ′ \ddot{\mathbf{x}}_{p/b}' x¨p/b。我们需要在前面加上一个旋转矩阵 R \mathbf{R} R(将世界坐标转换到连体坐标):

x ˙ p = x ˙ b + x ∘ p / b + ω × x p / b = x ˙ b + R ( x ′ ∘ p / b + ω ′ × x p / b ′ ) \begin{aligned}\dot{\mathbf{x}}_p&=\dot{\mathbf{x}}_b+\overset{\circ} {\mathbf{x}}_{p/b}+\boldsymbol{\omega}\times\mathbf{x}_{p/b}\\&=\dot{\mathbf{x}}_b+\mathbf{R}(\overset{\circ} {\mathbf{x}'}_{p/b}+\boldsymbol{\omega}'\times\mathbf{x}'_{p/b})\end{aligned} x˙p=x˙b+xp/b+ω×xp/b=x˙b+R(xp/b+ω×xp/b)

2.1.2 加速度表示

该矢量在世界坐标系下的加速度为:

x ¨ p = x ¨ b + x ¨ p / b = x ¨ b + x ∘ ∘ p / b + 2 ω × x ∘ p / b + ω ˙ × x p / b + ω × ( ω × x p / b ) = x ¨ b + R ( x ′ ∘ ∘ p / b + 2 ω ′ × x ′ ∘ p / b + ω ˙ ′ × x p / b ′ + ω ′ × ( ω ′ × x p / b ′ ) ) \begin{aligned}\ddot{\mathbf{x}}_p&=\ddot{\mathbf{x}}_b+\ddot{\mathbf{x}}_{p/b}\\ &=\ddot{\mathbf{x}}_b+\overset{\circ\circ} {\mathbf{x}}_{p/b}+2\boldsymbol{\omega}\times\overset{\circ} {\mathbf{x}}_{p/b}+\dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b}+\boldsymbol{\omega}\times(\boldsymbol{\omega}\times\mathbf{x}_{p/b})\\&=\ddot{\mathbf{x}}_b+\mathbf{R}(\overset{\circ\circ} {\mathbf{x}'}_{p/b}+2\boldsymbol{\omega}'\times\overset{\circ} {\mathbf{x}'}_{p/b}+\dot{\boldsymbol{\omega}}'\times\mathbf{x}'_{p/b}+\boldsymbol{\omega}'\times(\boldsymbol{\omega}'\times\mathbf{x}'_{p/b}))\end{aligned} x¨p=x¨b+x¨p/b=x¨b+x∘∘p/b+2ω×xp/b+ω˙×xp/b+ω×(ω×xp/b)=x¨b+R(x∘∘p/b+2ω×xp/b+ω˙×xp/b+ω×(ω×xp/b))

2.2 矢量端点和刚体固连

根据1.2 我们知道矢量端点和刚体固连有: x ∘ p / b = 0 , x ∘ ∘ p / b = 0 \overset{\circ} {\mathbf{x}}_{p/b}=0, \overset{\circ\circ} {\mathbf{x}}_{p/b}=0 xp/b=0,x∘∘p/b=0

2.2.1 速度表示

该矢量在世界坐标系下的速度为:

x ˙ p = x ˙ b + x ˙ p / b = x ˙ b + ω × x p / b = x ˙ b + R ( ω ′ × x p / b ′ ) \begin{aligned}\dot{\mathbf{x}}_p&=\dot{\mathbf{x}}_b+\dot{\mathbf{x}}_{p/b}\\ &=\dot{\mathbf{x}}_b+\boldsymbol{\omega}\times\mathbf{x}_{p/b}\\&=\dot{\mathbf{x}}_b+\mathbf{R}(\boldsymbol{\omega}'\times\mathbf{x}'_{p/b})\end{aligned} x˙p=x˙b+x˙p/b=x˙b+ω×xp/b=x˙b+R(ω×xp/b)

2.2.2 加速度表示

该矢量在世界坐标系下的加速度为:

x ¨ p = x ¨ b + x ¨ p / b = x ¨ b + ω ˙ × x p / b + ω × ( ω × x p / b ) = x ¨ b + R ( ω ˙ ′ × x p / b ′ + ω ′ × ( ω ′ × x p / b ′ ) ) \begin{aligned}\ddot{\mathbf{x}}_p&=\ddot{\mathbf{x}}_b+\ddot{\mathbf{x}}_{p/b}\\ &=\ddot{\mathbf{x}}_b+\dot{\boldsymbol{\omega}}\times\mathbf{x}_{p/b}+\boldsymbol{\omega}\times(\boldsymbol{\omega}\times\mathbf{x}_{p/b})\\&=\ddot{\mathbf{x}}_b+\mathbf{R}(\dot{\boldsymbol{\omega}}'\times\mathbf{x}'_{p/b}+\boldsymbol{\omega}'\times(\boldsymbol{\omega}'\times\mathbf{x}'_{p/b}))\end{aligned} x¨p=x¨b+x¨p/b=x¨b+ω˙×xp/b+ω×(ω×xp/b)=x¨b+R(ω˙×xp/b+ω×(ω×xp/b))

参考资料

[1] 《Representing Attitude: Euler Angles, Unit Quaternions, and Rotation Vectors》 6-7

[2] 刘延柱. 《多体系统动力学》第二版 24-25

你可能感兴趣的:(机器人学,动力学原理,刚体运动学,连体坐标系,世界坐标系,速度,加速度)