无人机刚体运动学方程

  • 平动运动学
  • 转动运动学
    • 欧拉角和方向余弦矩阵
    • 四元数
    • 姿态微分方程
    • 四元数的归一化

平动运动学

由无人机平动动力学方程得到无人机的速度后,经过积分即可得到位置信息。
在NED坐标系下
XN=∫vNE=∫[uvw]T\bm{X}_N=\int \bm{v}^E_N=\int [u\ v\ w]^T XN​=∫vNE​=∫[u v w]T
在WGS-84坐标系下
μ=∫uRN+h,(−π/2≤μ≤π/2)λ=∫vcos⁡μ(RE+h),(−π≤λ≤π)h=−∫w\mu=\int\frac{u}{R_N+h}\ \ \ ,\ (-\pi/2\leq\mu\leq\pi/2)\\ \lambda=\int\frac{v}{\cos\mu(R_E+h)}\ \ \ ,\ (-\pi\leq\lambda\leq\pi)\\ h=-\int w μ=∫RN​+hu​   , (−π/2≤μ≤π/2)λ=∫cosμ(RE​+h)v​   , (−π≤λ≤π)h=−∫w
经纬度的积分计算要特别考虑在边界附近的翻转。

转动运动学

欧拉角和方向余弦矩阵

欧拉角是用来唯一地确定定点转动刚体相对位置关系的三个角度,可以用来描述两个坐标系之间的转动关系。从参考坐标系到目标坐标系的定点转动可以通过参考坐标系绕其坐标轴作三次定轴旋转得到,每次旋转的角度统称为欧拉角。欧拉角的数值与旋转的顺序有关,不同的旋转顺序可能得到不同的欧拉角。航空中通常使用z-y-x的旋转顺序,这三次转动欧拉角分别为偏航角(ψ\psiψ)、俯仰角(θ\thetaθ)和滚转角(ϕ\phiϕ)。
欧拉角具有直观的物理意义,在通常的表达中一般采用欧拉角。欧拉角在特定位置会出现奇异,即一个确定的转动无法用唯一确定的一组欧拉角来表示。
同一个矢量在不同坐标系中的投影分量之间的转换关系,可以通过矩阵运算来表示
rB=MBNrN\bm{r}_B=\bm{M}_{BN}\bm{r}_N rB​=MBN​rN​
MBN\bm{M}_{BN}MBN​即由坐标系N到坐标系B的方向余弦矩阵(DCM,Direction Consine Matrix)。方向余弦矩阵是一个三阶正交方阵。方向余弦矩阵中的列元素为参考坐标系各坐标轴单位向量在目标坐标系中的投影分量。

根据欧拉角的定义,由NED坐标系到机体坐标系的第一次旋转是绕NED坐标系z轴转动ψ\psiψ角,相应方向余弦矩阵为
Mz=[cos⁡ψsin⁡ψ0−sin⁡ψcos⁡ψ0001]\bm{M}_z= \begin{bmatrix} \cos\psi & \sin\psi & 0\\ -\sin\psi & \cos\psi & 0\\ 0 & 0 & 1 \end{bmatrix} Mz​=⎣⎡​cosψ−sinψ0​sinψcosψ0​001​⎦⎤​
第二次绕新坐标系y轴旋转θ\thetaθ角,相应方向余弦矩阵为
My=[cos⁡θ0−sin⁡θ010sin⁡θ0cos⁡θ]\bm{M}_y= \begin{bmatrix} \cos\theta & 0 & -\sin\theta\\ 0 & 1 & 0\\ \sin\theta & 0 & \cos\theta \end{bmatrix} My​=⎣⎡​cosθ0sinθ​010​−sinθ0cosθ​⎦⎤​
第三次绕新坐标系x轴旋转ϕ\phiϕ角,相应方向余弦矩阵为
Mx=[1000cos⁡ϕsin⁡ϕ0−sin⁡ϕcos⁡ϕ]\bm{M}_x= \begin{bmatrix} 1 & 0 & 0\\ 0 & \cos\phi & \sin\phi\\ 0 & -\sin\phi & \cos\phi \end{bmatrix} Mx​=⎣⎡​100​0cosϕ−sinϕ​0sinϕcosϕ​⎦⎤​
因此,由NED坐标系到机体坐标系的方向余弦矩阵为
MBN=MxMyMz=[cos⁡θcos⁡ψcos⁡θsin⁡ψ−sin⁡θsin⁡ϕsin⁡θcos⁡ψ−cos⁡ϕsin⁡ψsin⁡ϕsin⁡θsin⁡ψ+cos⁡ϕcos⁡ψsin⁡ϕcos⁡θcos⁡ϕsin⁡θcos⁡ψ+sin⁡ϕsin⁡ψcos⁡ϕsin⁡θsin⁡ψ−sin⁡ϕcos⁡ψcos⁡ϕcos⁡θ]\bm{M}_{BN}=\bm{M}_x\bm{M}_y\bm{M}_z= \begin{bmatrix} \cos\theta\cos\psi & \cos\theta\sin\psi & -\sin\theta\\ \sin\phi\sin\theta\cos\psi-\cos\phi\sin\psi & \sin\phi\sin\theta\sin\psi+\cos\phi\cos\psi & \sin\phi\cos\theta\\ \cos\phi\sin\theta\cos\psi+\sin\phi\sin\psi & \cos\phi\sin\theta\sin\psi-\sin\phi\cos\psi & \cos\phi\cos\theta \end{bmatrix} MBN​=Mx​My​Mz​=⎣⎡​cosθcosψsinϕsinθcosψ−cosϕsinψcosϕsinθcosψ+sinϕsinψ​cosθsinψsinϕsinθsinψ+cosϕcosψcosϕsinθsinψ−sinϕcosψ​−sinθsinϕcosθcosϕcosθ​⎦⎤​
由方向余弦矩阵求欧拉角的方法为
{ϕ=tan⁡−1m23m33θ=−sin⁡−1m13ψ=tan⁡−1m12m11\left\{\begin{matrix} \phi=\tan^{-1}\frac{m_{23}}{m_{33}}\\ \theta=-\sin^{-1}m_{13}\\ \psi=\tan^{-1}\frac{m_{12}}{m_{11}} \end{matrix}\right. ⎩⎨⎧​ϕ=tan−1m33​m23​​θ=−sin−1m13​ψ=tan−1m11​m12​​​
可见,当θ→±90∘\theta\rightarrow\pm 90 ^{\circ}θ→±90∘的时候,cos⁡θ→0\cos\theta\rightarrow 0cosθ→0,ϕ\phiϕ和ψ\psiψ将无法确定。

四元数

利用四元数表示姿态不会产生奇异问题,且运算量较小,通常在计算中采用四元数进行运算。
四元数定义为
Q=q0+q1i+q2j+q3k=[q0q1q2q3]T\bm{Q}=q_0+q_1\bm{i}+q_2\bm{j}+q_3\bm{k}= \begin{bmatrix} q_0 & q_1 & q_2 & q_3 \end{bmatrix}^T Q=q0​+q1​i+q2​j+q3​k=[q0​​q1​​q2​​q3​​]T
两个四元数的乘积仍为四元数,四元数乘法满足结合律,但不满足交换律。两个四元数P\bm{P}P和Q\bm{Q}Q的乘积为
P∘Q=[p0−p1−p2−p3p1p0−p3p2p2p3p0−p1p3−p2p1p0][q0q1q2q3]=[q0−q1−q2−q3q1q0q3−q2q2−q3q0q1q3q2−q1q0][p0p1p2p3]\bm{P}\circ\bm{Q}= \begin{bmatrix} p_0 & -p_1 & -p_2 & -p_3\\ p_1 & p_0 & -p_3 & p_2\\ p_2 & p_3 & p_0 & -p_1\\ p_3 & -p_2 & p_1 & p_0 \end{bmatrix} \begin{bmatrix} q_0\\ q_1\\ q_2\\ q_3 \end{bmatrix}= \begin{bmatrix} q_0 & -q_1 & -q_2 & -q_3\\ q_1 & q_0 & q_3 & -q_2\\ q_2 & -q_3 & q_0 & q_1\\ q_3 & q_2 & -q_1 & q_0 \end{bmatrix} \begin{bmatrix} p_0\\ p_1\\ p_2\\ p_3 \end{bmatrix} P∘Q=⎣⎢⎢⎡​p0​p1​p2​p3​​−p1​p0​p3​−p2​​−p2​−p3​p0​p1​​−p3​p2​−p1​p0​​⎦⎥⎥⎤​⎣⎢⎢⎡​q0​q1​q2​q3​​⎦⎥⎥⎤​=⎣⎢⎢⎡​q0​q1​q2​q3​​−q1​q0​−q3​q2​​−q2​q3​q0​−q1​​−q3​−q2​q1​q0​​⎦⎥⎥⎤​⎣⎢⎢⎡​p0​p1​p2​p3​​⎦⎥⎥⎤​
Q\bm{Q}Q的共轭四元数可表示为
Q−1=q0−q1i−q2j−q3k=[q0−q1−q2−q3]T\bm{Q}^{-1}=q_0-q_1\bm{i}-q_2\bm{j}-q_3\bm{k}= \begin{bmatrix} q_0 & -q_1 & -q_2 & -q_3 \end{bmatrix}^T Q−1=q0​−q1​i−q2​j−q3​k=[q0​​−q1​​−q2​​−q3​​]T
Q\bm{Q}Q的模为
∥Q∥=Q∘Q−1=q02+q12+q22+q32\left \| \bm{Q} \right \| =\sqrt{\bm{Q}\circ\bm{Q}^{-1}}=\sqrt{q_0^2+q_1^2+q_2^2+q_3^2} ∥Q∥=Q∘Q−1​=q02​+q12​+q22​+q32​​
若Q\bm{Q}Q的模为1,则称Q\bm{Q}Q为单位四元数。
空间中矢量的旋转可由绕转轴ξ\bm{\xi}ξ转动有限转角ρ\rhoρ的一次旋转完成,该过程可用单位四元数表示
Q=cos⁡ρ2+sin⁡ρ2ξ\bm{Q}=\cos\frac{\rho}{2}+\sin\frac{\rho}{2}\bm{\xi} Q=cos2ρ​+sin2ρ​ξ
对于四元数矢量r=[0rxryrz]T\bm{r}=\left[0\ r_x\ r_y\ r_z\right]^Tr=[0 rx​ ry​ rz​]T,在空间中绕转轴ξ\bm{\xi}ξ转动有限转角ρ\rhoρ的转动可以表示为
r′=Q∘r∘Q−1\bm{r}'=\bm{Q}\circ\bm{r}\circ\bm{Q}^{-1} r′=Q∘r∘Q−1
而坐标系的旋转的过程也可由四元数运算体现,与矢量的旋转相反。若QBN\bm{Q}_{BN}QBN​表示由NED坐标系到机体坐标系的旋转四元数,则相应的同一矢量的在两个坐标系中投影坐标的变换过程为
rb=QBN−1∘rn∘QBN\bm{r}_b=\bm{Q}_{BN}^{-1}\circ\bm{r}_n\circ\bm{Q}_{BN} rb​=QBN−1​∘rn​∘QBN​
姿态四元数之间的递推关系为
QBI=QNI∘QBN\bm{Q}_{BI}=\bm{Q}_{NI}\circ\bm{Q}_{BN} QBI​=QNI​∘QBN​
!千万注意不要混淆矢量旋转和坐标变换,否则后续的推导将出错!
姿态四元数与欧拉角、方向余弦矩阵的转换关系为
{q0=cos⁡ϕ2cos⁡θ2cos⁡ψ2+sin⁡ϕ2sin⁡θ2sin⁡ψ2q1=sin⁡ϕ2cos⁡θ2cos⁡ψ2−cos⁡ϕ2sin⁡θ2sin⁡ψ2q2=cos⁡ϕ2sin⁡θ2cos⁡ψ2+sin⁡ϕ2cos⁡θ2sin⁡ψ2q3=cos⁡ϕ2cos⁡θ2sin⁡ψ2−sin⁡ϕ2sin⁡θ2cos⁡ψ2\left\{\begin{matrix} q_0=\cos\frac{\phi}{2}\cos\frac{\theta}{2}\cos\frac{\psi}{2}+\sin\frac{\phi}{2}\sin\frac{\theta}{2}\sin\frac{\psi}{2}\\ q_1=\sin\frac{\phi}{2}\cos\frac{\theta}{2}\cos\frac{\psi}{2}-\cos\frac{\phi}{2}\sin\frac{\theta}{2}\sin\frac{\psi}{2}\\ q_2=\cos\frac{\phi}{2}\sin\frac{\theta}{2}\cos\frac{\psi}{2}+\sin\frac{\phi}{2}\cos\frac{\theta}{2}\sin\frac{\psi}{2}\\ q_3=\cos\frac{\phi}{2}\cos\frac{\theta}{2}\sin\frac{\psi}{2}-\sin\frac{\phi}{2}\sin\frac{\theta}{2}\cos\frac{\psi}{2} \end{matrix}\right. ⎩⎪⎪⎨⎪⎪⎧​q0​=cos2ϕ​cos2θ​cos2ψ​+sin2ϕ​sin2θ​sin2ψ​q1​=sin2ϕ​cos2θ​cos2ψ​−cos2ϕ​sin2θ​sin2ψ​q2​=cos2ϕ​sin2θ​cos2ψ​+sin2ϕ​cos2θ​sin2ψ​q3​=cos2ϕ​cos2θ​sin2ψ​−sin2ϕ​sin2θ​cos2ψ​​
MBN=[q02+q12−q22−q322(q1q2+q0q3)2(q1q3−q0q2)2(q1q2−q0q3)q02−q12+q22−q322(q2q3+q0q1)2(q1q3+q0q2)2(q2q3−q0q1)q02−q12−q22+q32]\bm{M}_{BN}= \begin{bmatrix} q_0^2+q_1^2-q_2^2-q_3^2 & 2\left(q_1q_2+q_0q_3\right) & 2\left(q_1q_3-q_0q_2\right)\\ 2\left(q_1q_2-q_0q_3\right) & q_0^2-q_1^2+q_2^2-q_3^2 & 2\left(q_2q_3+q_0q_1\right)\\ 2\left(q_1q_3+q_0q_2\right) & 2\left(q_2q_3-q_0q_1\right) & q_0^2-q_1^2-q_2^2+q_3^2 \end{bmatrix} MBN​=⎣⎡​q02​+q12​−q22​−q32​2(q1​q2​−q0​q3​)2(q1​q3​+q0​q2​)​2(q1​q2​+q0​q3​)q02​−q12​+q22​−q32​2(q2​q3​−q0​q1​)​2(q1​q3​−q0​q2​)2(q2​q3​+q0​q1​)q02​−q12​−q22​+q32​​⎦⎤​

姿态微分方程

欧拉角的变化率ϕ˙\dot{\phi}ϕ˙​、θ˙\dot{\theta}θ˙、ψ˙\dot{\psi}ψ˙​,机体坐标系相对于导航坐标系的转动角速度ωBNB=[pqr]T\bm{\omega}^{NB}_B=[p\ q\ r]^TωBNB​=[p q r]T,两者并不等价。两者之间的关系可由欧拉运动方程表示
[pqr]=[10−sin⁡θ0cos⁡ϕsin⁡ϕcos⁡θ0−sin⁡ϕcos⁡ϕcos⁡θ][ϕ˙θ˙ψ˙]\begin{bmatrix} p\\ q\\ r \end{bmatrix}= \begin{bmatrix} 1 & 0 & -\sin\theta\\ 0 & \cos\phi & \sin\phi\cos\theta\\ 0 & -\sin\phi & \cos\phi\cos\theta \end{bmatrix} \begin{bmatrix} \dot{\phi}\\ \dot{\theta}\\ \dot{\psi} \end{bmatrix} ⎣⎡​pqr​⎦⎤​=⎣⎡​100​0cosϕ−sinϕ​−sinθsinϕcosθcosϕcosθ​⎦⎤​⎣⎡​ϕ˙​θ˙ψ˙​​⎦⎤​
根据欧拉动力学方程求出机体运动角速度,求解上述微分方程,可以得到相应欧拉角。但由于方程具有大量三角函数运算,一般不直接求解该微分方程,而是采用四元数的方法求解。

简单推导
[pqr]=[ϕ˙00]+Mx[0θ˙0]+MxMy[00ψ˙]\begin{bmatrix} p\\ q\\ r \end{bmatrix}= \begin{bmatrix} \dot{\phi}\\ 0\\ 0 \end{bmatrix}+\bm{M}_x \begin{bmatrix} 0\\ \dot{\theta}\\ 0 \end{bmatrix}+\bm{M}_x\bm{M}_y \begin{bmatrix} 0\\ 0\\ \dot{\psi} \end{bmatrix} ⎣⎡​pqr​⎦⎤​=⎣⎡​ϕ˙​00​⎦⎤​+Mx​⎣⎡​0θ˙0​⎦⎤​+Mx​My​⎣⎡​00ψ˙​​⎦⎤​
整理后可得到欧拉运动学方程。
取逆过程即可得到欧拉角的微分方程
[ϕ˙θ˙ψ˙]=[1sin⁡ϕtan⁡θcos⁡ϕtan⁡θ0cos⁡ϕ−sin⁡ϕ0sin⁡ϕsec⁡θcos⁡ϕsec⁡θ][pqr]\begin{bmatrix} \dot{\phi}\\ \dot{\theta}\\ \dot{\psi} \end{bmatrix}= \begin{bmatrix} 1 & \sin\phi\tan\theta & \cos\phi\tan\theta\\ 0 & \cos\phi & -\sin\phi\\ 0 & \sin\phi\sec\theta & \cos\phi\sec\theta \end{bmatrix} \begin{bmatrix} p\\ q\\ r \end{bmatrix} ⎣⎡​ϕ˙​θ˙ψ˙​​⎦⎤​=⎣⎡​100​sinϕtanθcosϕsinϕsecθ​cosϕtanθ−sinϕcosϕsecθ​⎦⎤​⎣⎡​pqr​⎦⎤​

四元数表示的姿态微分方程为
Q˙NB=12QNB∘ωBNB\bm{\dot{Q}}_{NB}=\frac{1}{2}\bm{Q}_{NB}\circ\bm{\omega}^{NB}_B Q˙​NB​=21​QNB​∘ωBNB​
展开可得
[q0˙q1˙q2˙q3˙]=12[0−p−q−rp0r−qq−r0prqp0][q0q1q2q3]\begin{bmatrix} \dot{q_0}\\ \dot{q_1}\\ \dot{q_2}\\ \dot{q_3} \end{bmatrix}=\frac{1}{2} \begin{bmatrix} 0 & -p & -q & -r\\ p & 0 & r & -q\\ q & -r & 0 & p\\ r & q & p & 0 \end{bmatrix} \begin{bmatrix} q_0\\ q_1\\ q_2\\ q_3 \end{bmatrix} ⎣⎢⎢⎡​q0​˙​q1​˙​q2​˙​q3​˙​​⎦⎥⎥⎤​=21​⎣⎢⎢⎡​0pqr​−p0−rq​−qr0p​−r−qp0​⎦⎥⎥⎤​⎣⎢⎢⎡​q0​q1​q2​q3​​⎦⎥⎥⎤​
根据动力学方程求出机体运动角速度,求解上述微分方程,可以得到QNB\bm{Q}_{NB}QNB​,再通过姿态四元数与欧拉角和方向余弦矩阵关系可转换为欧拉角和方向余弦矩阵。

简单推导过程
姿态四元数随时间的变化率定义为
Q˙NB=lim⁡δt→0QNB(t+δt)−QNB(t)δt=lim⁡δt→0QNB(t)∘QNB(δt)−QNB(t)δt=QNB∘lim⁡δt→0QNB(δt)−Q(1)δt\bm{\dot{Q}}_{NB}= \lim_{\delta t\rightarrow 0}\frac{\bm{Q}_{NB}\left(t+\delta t\right)-\bm{Q}_{NB}\left(t\right)}{\delta t}= \lim_{\delta t\rightarrow 0}\frac{\bm{Q}_{NB}\left(t\right)\circ\bm{Q}_{NB}\left(\delta t\right) -\bm{Q}_{NB}\left(t\right)}{\delta t}= \bm{Q}_{NB}\circ\lim_{\delta t\rightarrow 0}\frac{\bm{Q}_{NB}\left(\delta t\right) -\bm{Q}\left(1\right)}{\delta t} Q˙​NB​=δt→0lim​δtQNB​(t+δt)−QNB​(t)​=δt→0lim​δtQNB​(t)∘QNB​(δt)−QNB​(t)​=QNB​∘δt→0lim​δtQNB​(δt)−Q(1)​
其中,Q(1)=[1000]T\bm{Q}(1)=[1\ 0\ 0\ 0]^TQ(1)=[1 0 0 0]T,QNB(δt)\bm{Q}_{NB}\left(\delta t\right)QNB​(δt)为ttt时刻到t+δtt+\delta tt+δt时刻转动的姿态四元数,当δt→0\delta t\rightarrow 0δt→0时,转动的角度为小角度,可作小角度近似QNB(δt)=[1ϕ/2θ/2ψ/2]T\bm{Q}_{NB}\left(\delta t\right)=[1\ \ \phi/2\ \ \theta/2\ \ \psi/2]^TQNB​(δt)=[1  ϕ/2  θ/2  ψ/2]T,同时,利用机体坐标系相对于NED坐标系的转动角速度近似代替小角度欧拉角的微分,可得
Q˙NB=QNB∘lim⁡δt→0QNB(δt)−Q(1)δt=QNB∘lim⁡δt→0[1ϕ2θ2ψ2]T−[1000]Tδt=12QNB∘[0pqr]T\bm{\dot{Q}}_{NB}= \bm{Q}_{NB}\circ\lim_{\delta t\rightarrow 0}\frac{\bm{Q}_{NB}\left(\delta t\right) -\bm{Q}\left(1\right)}{\delta t}= \bm{Q}_{NB}\circ\lim_{\delta t\rightarrow 0}\frac{\left[1\ \frac{\phi}{2}\ \frac{\theta}{2}\ \frac{\psi}{2}\right]^T - \left[1\ 0\ 0\ 0\right]^T}{\delta t}= \frac{1}{2}\bm{Q}_{NB}\circ \left[0\ p\ q\ r\right]^T Q˙​NB​=QNB​∘δt→0lim​δtQNB​(δt)−Q(1)​=QNB​∘δt→0lim​δt[1 2ϕ​ 2θ​ 2ψ​]T−[1 0 0 0]T​=21​QNB​∘[0 p q r]T

在不考虑地球自转和地球曲率的情况下(通常情况),可以认为ωBNB=ωBIB\bm{\omega}^{NB}_B=\bm{\omega}^{IB}_BωBNB​=ωBIB​,直接采用陀螺仪测量数据进行计算即可。一般的陀螺仪精度不足以测量出地球转动的角速度,因此在导航计算中一般不考虑地球自转等影响。

四元数的归一化

姿态四元数为单位四元数,在微分方程求解过程中有可能因为数值误差使四元数模式偏离1,因此需要对四元数进行归一化处理。一般情况下,归一化可简单进行
Q=Q∥Q∥\bm{Q}=\frac{\bm{Q}}{\left \| \bm{Q}\right \|} Q=∥Q∥Q​
引入反馈控制的思想,可令λ=k(1−∥Q∥2)\lambda=k(1-\left \| \bm{Q}\right \|^2)λ=k(1−∥Q∥2),作为反馈补偿项加入到四元数微分方程的求解中,使姿态四元数在求解微分方程的过程中自动逐渐收敛到1。
[q0˙q1˙q2˙q3˙]=12[λ−p−q−rpλr−qq−rλprqpλ][q0q1q2q3]\begin{bmatrix} \dot{q_0}\\ \dot{q_1}\\ \dot{q_2}\\ \dot{q_3} \end{bmatrix}=\frac{1}{2} \begin{bmatrix} \lambda & -p & -q & -r\\ p & \lambda & r & -q\\ q & -r & \lambda & p\\ r & q & p & \lambda \end{bmatrix} \begin{bmatrix} q_0\\ q_1\\ q_2\\ q_3 \end{bmatrix} ⎣⎢⎢⎡​q0​˙​q1​˙​q2​˙​q3​˙​​⎦⎥⎥⎤​=21​⎣⎢⎢⎡​λpqr​−pλ−rq​−qrλp​−r−qpλ​⎦⎥⎥⎤​⎣⎢⎢⎡​q0​q1​q2​q3​​⎦⎥⎥⎤​

无人机刚体运动学方程相关推荐

  1. 无人机刚体动力学方程

    无人机刚体动力学方程 无人机平动动力学 推导 应用 无人机转动动力学 无人机平动动力学 推导 无人机相对地球(地心地固坐标系)表面的速度与惯性速度的关系可表示为 vI=vE+ωIE×r(1.1)\bm ...

  2. 室内定位算法_【好设计论文】基于行人航迹推算的室内定位算法研究

    摘要:针对室内定位的实际应用需求,提出了基于行人航迹推算算法(PDR)的适用于手机采集数据的室内定位方法.不同于传统的数据采集方法,该种定位方法利用手机得到加速度.陀螺仪以及地磁原始数据,通过分析加速 ...

  3. Backstepping反步法控制四旋翼无人机(一)

    目录 四旋翼基本参数 基本假设 转换矩阵 基本方程 线性化 综合 四旋翼基本参数 四旋翼作为一种可以在空间中自由飞行的无人飞行器,具有6个自由度和4个螺旋桨.其中,4个螺旋桨提供动力,作为四旋翼的动力 ...

  4. 机器人运动估计系列(二)——运动学方程(上)

    机器人运动估计系列(二)--运动学方程(上) 前言 在上一篇文章中,我们了解了用于表示机器人位置.速度的坐标系的定义,学习了如何表示姿态,也就是旋转的三种表达方式:旋转矩阵.欧拉角以及四元数.在这一节 ...

  5. 四轴FPV无人机手动操作简明介绍

    四轴FPV无人机手动操作简明介绍 通常航拍机都是有自稳算法 + GPS导航 + 辅助功能(避障)的支持,从而保证飞手能够相对容易且稳定的操作模型飞机,通常通过阅读说明书都能很快上手,这里就不在赘述. ...

  6. 【控制】四旋翼无人机姿态角分析

    搞起来,从建模到控制,再到仿真 Link: [控制]<多无人机协同控制技术>周伟老师-第3章-面向协同控制的无人机单机控制 文章目录 1. 坐标系 2. 角度介绍 航向角 yaw ange ...

  7. 深入浅出无人机姿态,欧拉角,四元数,指数表示及数据转换与程序实现

    很多朋友留言或私信问到书名和出版日期.先感谢这么多朋友的支持和信任,MR.城堡会努力为大家带来更多干货.另外,交稿日期是今年12月,出版要看机械工业出版社的安排,书名和出版情况确定后,会在专栏告知大家 ...

  8. 【Nokov】关于动捕系统获取刚体姿态的说明

    动作捕捉系统Nokov获取刚体的姿态信息 前言:对于动捕系统软件Seeker的基本使用以及获取单个Marker的位置操作已经比较熟悉了,对于机械臂而言,接下来就是获取它的姿态信息,经过昨天下午的操作后 ...

  9. 无人机飞控技术最详细解读

    已剪辑自: https://zhuanlan.zhihu.com/p/64519280 [导读]被称作是"飞行器的大脑"的飞控到底是什么? 以前,搞无人机的十个人有八个是航空.气动 ...

最新文章

  1. java 获取java文件路径_Java怎么获取相对路径下所有的.java文件的信息
  2. java虚拟机改装_java虚拟机线上配置
  3. springBoot使用PageHelper当超过最大页数后仍然返回数据
  4. 安卓中的单例模式和工厂模式
  5. 001 JAVA基础
  6. 领域应用 | 智能导购?你只看到了阿里知识图谱冰山一角
  7. Xshell连接Ubuntu时提示SSH服务器拒绝了密码
  8. 简单的C#字符串数组转字符串方法
  9. 成功解决internal/modules/cjs/loader.js:596 throw err; ^ Error: Cannot find module 'express'
  10. PyTorch:安装和配置
  11. mysql iostat_iostat命令详解_MySQL
  12. 文档控件正在将数据上传到服务器,关于CellWeb插件中文件打开、上传、以及导入数据库中的问题...
  13. CodeGenerator代码生成器使用
  14. SATA 模式相关概念
  15. java操作k8s api报错:SSLHandshakeException: should not be presented in certificate_request
  16. 【极简笔记】VPGNet: Vanishing Point Guided Network for Lane and Road Marking Detection and Recognition
  17. Win10安装了Office右键没有新建Word,excel,PPT等选项解决方法
  18. 1665 完成所有任务的最少初始能量
  19. c++ vector二维数组初始化与vector切片
  20. 【转载】让盐和味精告诉你,「变量」是什么 | 亲子课堂 第 4 课

热门文章

  1. Word2016(2013)页码、分节符
  2. 拼死抢到一个猫爪杯,粉丝却说他想要这个?!(文末抢福利)
  3. cent os 安装
  4. DB2处理数据由原来六小时优化到二十分钟(一)
  5. .Net Core DI依赖注入:一个接口注入多个实现类
  6. 什么是HTML?HTML怎么学?HTML基础教程
  7. python uniform函数均匀分布_numpy.random.uniform均匀分布
  8. 代理模式——游戏代练
  9. JavaScript(基础)
  10. 2021新宁二中高考喜报成绩查询,新宁各校高考喜报!最高分684,全县大获得丰收!看有你认识的吗?...