无人机刚体动力学方程
无人机刚体动力学方程
- 无人机平动动力学
- 推导
- 应用
- 无人机转动动力学
无人机平动动力学
推导
无人机相对地球(地心地固坐标系)表面的速度与惯性速度的关系可表示为
vI=vE+ωIE×r(1.1)\bm{v}^I=\bm{v}^E+\bm{\omega}^{IE}\times\bm{r} \tag{1.1} vI=vE+ωIE×r(1.1)
vE\bm{v}^EvE相对于机体系求导
(ddt)BvE=(ddt)IvE−ωIB×vE(1.2)\left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^B\bm{v}^E=\left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^I\bm{v}^E-\bm{\omega}^{IB}\times\bm{v}^E \tag{1.2} (dtd)BvE=(dtd)IvE−ωIB×vE(1.2)
根据矢量在旋转坐标系下的求导规则,对式(1.1)两边在惯性坐标系下求导
aI=[(ddt)IvE+ωIE×vE]+[αIE×r+ωIE×(ωIE×r)](1.3)\bm{a}^I=\left[\left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^I\bm{v}^E + \bm{\omega}^{IE}\times\bm{v}^E\right] + \left[\bm{\alpha}^{IE}\times\bm{r} + \bm{\omega}^{IE}\times\left(\bm{\omega}^{IE}\times\bm{r}\right)\right] \tag{1.3} aI=[(dtd)IvE+ωIE×vE]+[αIE×r+ωIE×(ωIE×r)](1.3)
(1.3)式中,aI\bm{a}^IaI为惯性加速度,有
aI=f+μ(1.4)\bm{a}^I=\bm{f}+\bm{\mu} \tag{1.4} aI=f+μ(1.4)
(1.4)式中,f\bm{f}f为无人机比力,μ\bm{\mu}μ为万有引力加速度。
地球万有引力加速度与地球重力加速度的关系为
g=μ−[αIE×r+ωIE×(ωIE×r)](1.5)\bm{g}=\bm{\mu}-\left[\bm{\alpha}^{IE}\times\bm{r} + \bm{\omega}^{IE}\times\left(\bm{\omega}^{IE}\times\bm{r}\right)\right] \tag{1.5} g=μ−[αIE×r+ωIE×(ωIE×r)](1.5)
即重力加速度是万有引力加速度去除了地球自转引起的加速度项的影响。
αIE\bm{\alpha}^{IE}αIE为地球自转加速度,可认为地球为匀速转动,因此此项为0。将(1.3)(1.4)带入(1.2)中整理可得
(ddt)BvE=f+μ−ωIE×vE−[αIE×r+ωIE×(ωIE×r)]−ωIB×vE(1.6)\left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^B\bm{v}^E = \bm{f}+\bm{\mu} - \bm{\omega}^{IE}\times\bm{v}^E - \left[\bm{\alpha}^{IE}\times\bm{r} + \bm{\omega}^{IE}\times\left(\bm{\omega}^{IE}\times\bm{r}\right)\right]-\bm{\omega}^{IB}\times\bm{v}^E \tag{1.6} (dtd)BvE=f+μ−ωIE×vE−[αIE×r+ωIE×(ωIE×r)]−ωIB×vE(1.6)
将式(1.5)带入式(1.6)可得
(ddt)BvE=f+g−ωIE×vE−ωIB×vE(1.7)\left(\frac{\mathrm{d}}{\mathrm{d}t}\right)^B\bm{v}^E = \bm{f}+\bm{g} - \bm{\omega}^{IE}\times\bm{v}^E - \bm{\omega}^{IB}\times\bm{v}^E \tag{1.7} (dtd)BvE=f+g−ωIE×vE−ωIB×vE(1.7)
式(1.7)在机体系下的投影可表示为
aBEB=fB+gB−ωBIE×vBE−ωBIB×vBE(1.8)\bm{a}^{EB}_B = \bm{f}_B+\bm{g}_B - \bm{\omega}^{IE}_B\times\bm{v}^E_B - \bm{\omega}^{IB}_B\times\bm{v}^E_B \tag{1.8} aBEB=fB+gB−ωBIE×vBE−ωBIB×vBE(1.8)
应用
求解式(1.8)微分方程,可以得到无人机的速度在机体系下的表示。
fB+gB\bm{f}_B+\bm{g}_BfB+gB为无人机动力、气动力、重力等合外力产生的加速度,合起来可以表示为
fB+gB=FBm+MBN[00g](1.9)\bm{f}_B+\bm{g}_B=\frac{\bm{F}_B}{m}+\bm{M}_{BN} \begin{bmatrix} 0 \\ 0 \\ g \end{bmatrix} \tag{1.9} fB+gB=mFB+MBN⎣⎡00g⎦⎤(1.9)
ωBIE\bm{\omega}^{IE}_BωBIE为地球转动角速度在机体系下的投影,可以表示为
ωBIE=MBNMNE[00ωIE]=MBN[−sinμcosλ−sinμsinλ−cosμ−sinλcosλ0−cosμcosλ−cosμsinλ−sinμ][00ωIE](1.10)\bm{\omega}^{IE}_B=\bm{M}_{BN}\bm{M}_{NE} \begin{bmatrix} 0 \\ 0 \\ \omega^{IE} \end{bmatrix}=\bm{M}_{BN} \begin{bmatrix} -\sin\mu\cos\lambda & -\sin\mu\sin\lambda & -\cos\mu\\ -\sin\lambda & \cos\lambda & 0\\ -\cos\mu\cos\lambda & -\cos\mu\sin\lambda & -\sin\mu \end{bmatrix} \begin{bmatrix} 0 \\ 0 \\ \omega^{IE} \end{bmatrix} \tag{1.10} ωBIE=MBNMNE⎣⎡00ωIE⎦⎤=MBN⎣⎡−sinμcosλ−sinλ−cosμcosλ−sinμsinλcosλ−cosμsinλ−cosμ0−sinμ⎦⎤⎣⎡00ωIE⎦⎤(1.10)
ωBIB\bm{\omega}^{IB}_BωBIB为无人机转动角速度在机体系下的投影,即陀螺仪的测量值。
带入式(1.8)可得
v˙BE=FBm+MBN[00g]−MBN[−sinμcosλ−sinμsinλ−cosμ−sinλcosλ0−cosμcosλ−cosμsinλ−sinμ][00ωIE]×vBE−ωBIB×vBE(1.11)\bm{\dot{v}}^{E}_B = \frac{\bm{F}_B}{m}+\bm{M}_{BN} \begin{bmatrix} 0 \\ 0 \\ g \end{bmatrix} - \bm{M}_{BN} \begin{bmatrix} -\sin\mu\cos\lambda & -\sin\mu\sin\lambda & -\cos\mu\\ -\sin\lambda & \cos\lambda & 0\\ -\cos\mu\cos\lambda & -\cos\mu\sin\lambda & -\sin\mu \end{bmatrix} \begin{bmatrix} 0 \\ 0 \\ \omega^{IE} \end{bmatrix}\times\bm{v}^E_B - \bm{\omega}^{IB}_B\times\bm{v}^E_B \tag{1.11} v˙BE=mFB+MBN⎣⎡00g⎦⎤−MBN⎣⎡−sinμcosλ−sinλ−cosμcosλ−sinμsinλcosλ−cosμsinλ−cosμ0−sinμ⎦⎤⎣⎡00ωIE⎦⎤×vBE−ωBIB×vBE(1.11)
根据当前姿态转换矩阵、经纬度、陀螺仪测量角速度、机体系合外力、当前重力加速度可以求解微分方程(1.11),得到无人机速度在机体系下的分量。经过姿态转换矩阵,可得到无人机在NED坐标系下的速度。
无人机转动动力学
无人机刚体绕质心转动的过程可以由欧拉动力学方程描述
ω˙IB=I−1[M−ωIB×(IωIB)](2.1)\bm{\dot{\omega}}^{IB}=\bm{I}^{-1}\left[\bm{M}-\bm{\omega}^{IB}\times\left(\bm{I}\bm{\omega}^{IB}\right)\right] \tag{2.1} ω˙IB=I−1[M−ωIB×(IωIB)](2.1)
其中,ωIB\bm{\omega}^{IB}ωIB为机体系相对惯性系转动的角速度,可由陀螺仪测量出。I\bm{I}I为原点在刚体质心的惯量矩阵,可表示为
I=[Ixx−Ixy−Ixz−IyxIyy−Iyz−Izx−IzyIzz](2.2)\bm{I}=\begin{bmatrix} I_{xx} & -I_{xy} & -I_{xz}\\ -I_{yx} & I_{yy} & -I_{yz}\\ -I_{zx} & -I_{zy} & I_{zz} \end{bmatrix} \tag{2.2} I=⎣⎡Ixx−Iyx−Izx−IxyIyy−Izy−Ixz−IyzIzz⎦⎤(2.2)
对于结构上关于x-z、y-z平面对称的多旋翼,惯量矩阵可以简化为对角阵,即I=diag{IxxIyyIzz}\bm{I}=\textup{diag}\{I_{xx}\:I_{yy}\:I_{zz}\}I=diag{IxxIyyIzz}。
(2.1)式在机体系下的投影表达式为
ω˙BIB=I−1[MB−ωBIB×(IωBIB)](2.3)\bm{\dot{\omega}}^{IB}_B=\bm{I}^{-1}\left[\bm{M}_B-\bm{\omega}^{IB}_B\times\left(\bm{I}\bm{\omega}^{IB}_B\right)\right] \tag{2.3} ω˙BIB=I−1[MB−ωBIB×(IωBIB)](2.3)
根据当前的合外力矩、无人机惯量矩阵求解微分方程(2.3),可以得到无人机相对惯性系转动角速度在机体系下的分量。
得出ωIB\bm{\omega}^{IB}ωIB后,可容易得出机体系相对于NED坐标系的转动角速度:
ωBNB=ωBIB−ωBIE−ωBEN(2.4)\bm{\omega}^{NB}_B=\bm{\omega}^{IB}_B - \bm{\omega}^{IE}_B - \bm{\omega}^{EN}_B \tag{2.4} ωBNB=ωBIB−ωBIE−ωBEN(2.4)
其中,ωBEN\bm{\omega}^{EN}_BωBEN可以表示为
ωBEN=MBN[−uRN+hvRE+h−vtanμRE+h]\bm{\omega}^{EN}_B=\bm{M}_{BN} \begin{bmatrix} -\frac{u}{R_N+h}\\ \frac{v}{R_E+h}\\ -\frac{v\tan\mu}{R_E+h} \end{bmatrix} ωBEN=MBN⎣⎡−RN+huRE+hv−RE+hvtanμ⎦⎤
无人机刚体动力学方程相关推荐
- 无人机刚体运动学方程
无人机刚体运动学方程 平动运动学 转动运动学 欧拉角和方向余弦矩阵 四元数 姿态微分方程 四元数的归一化 平动运动学 由无人机平动动力学方程得到无人机的速度后,经过积分即可得到位置信息. 在NED坐标 ...
- 从刚体动力学方程到 MATLAB 多种方法仿真验证
终于结束了自己的毕设设计,这半年的时间一直在和刚体动力学仿真硬磕,关于这方面的网络资源不太多,因此在这里将自己不断摸索学到的方法做一个概括阐述,希望能够为同样饱受困扰的读者提供一些帮助. 文章目录 〇 ...
- [四旋翼无人机PID仿真(一)
@四旋翼无人机串级PID仿真 四旋翼无人机的数学模型的建立:在建立模型的过程中,采用了欧拉角来进行数学模型的建立.首先进行无人机结构以及飞行原理的分析,然后进行系统建模,在建模的过程中,首先对四旋翼无 ...
- 机器人导论知识点总结
机器人导论知识点总结 第1章 概论 第一节 机器人的基本概念 1.机器人名称的由来 机器人的英文名词是Robot,Robot一词最早出现在1920年捷克作家卡雷尔·恰佩克(Karel Capek)所写 ...
- 二自由度1/4车辆悬架建模及垂向动力学仿真分析
203-四分之一车体模型simulink 企q号q:1762016542 车辆悬架是指车桥(车轮)和车架(车身)之间连接传力装置的总称.其主要功能是传递作用在车轮和车身之间一切力和力矩,缓和路面给车身 ...
- 【控制】四旋翼无人机姿态角分析
搞起来,从建模到控制,再到仿真 Link: [控制]<多无人机协同控制技术>周伟老师-第3章-面向协同控制的无人机单机控制 文章目录 1. 坐标系 2. 角度介绍 航向角 yaw ange ...
- 机器人动力学方程的性质
一个nn连杆的机器人的动力学方程含有很多项,特别是全部是转动关节的机械臂,让人看着害怕.但是,机器人动力学方程含有一些有助于开发控制算法的重要性质,其中最重要的是反对称性.无源性.有界性和参数的线性性 ...
- 深入浅出无人机姿态,欧拉角,四元数,指数表示及数据转换与程序实现
很多朋友留言或私信问到书名和出版日期.先感谢这么多朋友的支持和信任,MR.城堡会努力为大家带来更多干货.另外,交稿日期是今年12月,出版要看机械工业出版社的安排,书名和出版情况确定后,会在专栏告知大家 ...
- 3点 刚体运动 opencv_模态法动力学分析中的刚体模态
01 - 概述 在对汽车结构进行动力学有限元分析时,无论是瞬态问题还是频响问题,都经常使用模态叠加法. 模态叠加法动力学分析是常规模态分析的自然扩展,它利用结构振型来缩减问题求解规模,从而使数值求解更 ...
最新文章
- linux ”我的草稿“
- 2019RPA财务行业峰会:财务数字化转型
- webpack入门与笔记
- 经典C语言程序100例之十五
- xilinx SoC学习笔记之PetaLinux
- 有哪些命令行工具堪称神器?
- 模糊查询关键字不区分大小写_SQL简单查询
- 高级PHP应用程序漏洞审核技术
- uartz Spring与Spring Task总结
- fiddler的设置与简单使用
- 牙疼怎么快速止痛,三招解决牙痛立竿见影
- 利用输入法输入汉字,如何统计字数
- 移动硬盘显示设备未就绪的文件寻回方法
- 全国计算机四级——操作系统原理笔记
- 毕业生社保、档案和户口详解 2
- H5浪漫告白气球表白
- python、idel、pycharm的安装使用
- 干货!毫米波雷达超强解读
- C语言:实现一个函数itoa(int n,char s[]),将整数n这个数字转换为对应的字符串,保存到s中...
- dcp-9020cdn硒鼓停止_dcp9020cdn硒鼓!错误_显示硒鼓错误的解决办法