标签：gen 投影 数值计算 soc err 仿真 堆叠 sam 数值
对于给定的物体，惯性积的值与建立的坐标系的位置及方向有关，如果我们选择的坐标系合适，可使惯性积的值为零。当对于某一坐标轴的惯性积为零时，这种特定的坐标轴称为惯性主轴或主轴（principal axes），相应的质量惯性矩称为主惯性矩（principal moments of inertia）。显然，如果刚体本身具有某种几何对称性，那么它的主轴方向总是沿着它的对称轴的。但是即使是完全没有任何对称性的刚体也是存在惯性主轴的。
惯性张量描述了物体的质量分布。以{A}为参考坐标系，刚体相对于坐标系{A}的惯性张量用3×3的矩阵表达：
惯性张量矩阵的特征值是主惯性矩，其对应的特征向量是惯性主轴的方向向量（The eigenvalues of an inertia tensor are the principal moments for the body. The associated eigenvectors are the principal axes.） 已知某参考坐标系下的惯性张量，要计算惯性主轴可以参考惯性主轴计算。
刚体运动 = 质心的平动 + 绕质心的转动。其中，质心平动用牛顿方程描述；绕质心的转动用欧拉方程描述，它们都涉及到质量及其分布。
力F作用在刚体的质心上，使得质量为m的刚体产生加速度$\dot{v_c}$，根据牛顿第二运动定律有：$$F=m \dot{v_c}$$
作用在刚体上的力矩N使刚体以角速度$\omega$、角加速度$\dot{\omega}$旋转。根据欧拉方程有：$$N=^{C}I\dot{\omega}+\omega \times ^{C}I \omega$$
其中$^{C}I$是以质心参考系{C}为参照的刚体惯性张量。
需要注意的是，刚体绕定轴转动时，角速度矢量$\omega$和角加速度矢量$\dot{\omega}$都是沿着固定的轴线；而刚体绕定点运动时，角速度矢量$\omega$的大小和方向都将不断变化。角加速度矢量$\dot{\omega}$沿$\omega$的矢端曲线的切线，在一般情况下，它不与角速度矢量$\omega$重合。
刚体定点运动时的动量矩
刚体运动中，若刚体或其延拓空间上有一点的位置始终保持不动，这种运动称为刚体定点运动。刚体定点运动是刚体运动较为复杂的一种运动形式，在工程技术上有着广泛的应用。定点运动刚体的任何位移都可由绕过定点的某一轴（转动瞬轴）的一次转动来实现。瞬轴通过刚体的定点，在不同瞬时有不同的方位。定点运动刚体每瞬时的真实运动就是绕过定点的一系列不同方位的瞬轴的转动过程。
刚体定点运动时，对点O的动量矩为：$$\vec{L}=\sum_{i=1}^{n}\vec{r_i}\times m_i \vec{v_i}$$
因为$\vec{v_i}=\vec{\omega} \times \vec{r_i}$
故有$$\vec{L}=\sum_{i=1}^{n} m_i[\vec{r_i}\times (\vec{\omega} \times \vec{r_i})]$$
上式中各矢量向坐标轴投影，有：
$$\left\{\begin{matrix}
\vec{r_i}=x_i \vec{i}+y_i \vec{j}+z_i \vec{k}\\
\vec{\omega}=\omega_x \vec{i}+\omega_y \vec{j}+\omega_z \vec{k}\\
\vec{L}=L_x \vec{i}+L_y \vec{j}+L_z \vec{k}\
\end{matrix}\right.$$
将上面两式子结合起来写成矩阵形式如下：
$$\begin{bmatrix}L_x\\ L_y\\ L_z\end{bmatrix}=\begin{bmatrix}
I_{xx} & -I_{xy} & -I_{xz}\\
-I_{yx} & I_{yy} & -I_{yz}\\
-I_{zx}& -I_{zy} & I_{zz}
\end{bmatrix}\begin{bmatrix}
\omega_x\\
\omega_y\\
\omega_z
\end{bmatrix}$$
式子中$I_{xx}=\sum m_i(y^2_i + z^2_i)$，$I_{yy}=\sum m_i(x^2_i + z^2_i)$，$I_{zz}=\sum m_i(y^2_i +x^2_i)$，$I_{xy}=I_{yx}=\sum m_i x_i y_i$，$I_{xz}=I_{zx}=\sum m_i x_i z_i$，$I_{yz}=I_{zy}=\sum m_i z_i y_i$
简写成向量形式为：$$\vec{L}=I \vec{\omega}, \quad I =\begin{bmatrix}
I_{xx} & -I_{xy} & -I_{xz}\\
-I_{yx} & I_{yy} & -I_{yz}\\
-I_{zx}& -I_{zy} & I_{zz}
\end{bmatrix} $$
欧拉动力学方程推导
我们首先在静止坐标系$Oxyz$（固定坐标系/世界坐标系/绝对坐标系）中描述刚体的动力学。刚体有6个自由度，可以选为质心的坐标（3个）和固连在刚体上的动坐标系相对于静止坐标系的三个欧拉角来表征。假设N为作用在刚体上的总力矩，这里仅仅需要考虑外力，因为内部的内力的力矩为零。求刚体一般运动的关键是应用角动量定力，由已知受力情况去求刚体转动的角速度：
$$\mathbf{N}= \frac{d\mathbf{L}}{dt}=\frac{I\omega}{dt}$$
由于$I$是一个惯性张量，而且要考虑$I\omega$的变化率，如果选固定坐标系作参考，那么刚体相对固定坐标系的惯性张量$I$的各个分量随时间改变，这样求解上式并不容易。我们可以选取刚体的惯量主轴作为参考坐标系（固定在刚体上随着刚体运动的参照系）使得刚体的惯性张量具有对角形式，且对角线上的分量不随时间变化。对于这个主轴坐标系，刚体的质量分布是固定的。
下面我们试图在动坐标系（随体坐标系$O{x}‘{y}‘{z}‘$）中讨论刚体的动力学问题。${i}‘$、${j}‘$、${k}‘$为随动体参考系坐标轴的三个单位矢量，$\omega_{{x}‘}$、$\omega_{{y}‘}$、$\omega_{{z}‘}$为角速度沿三个坐标轴的分量。若$O{x}‘$、$O{y}‘$、$O{z}‘$为三个惯量主轴，则惯性张量中所有惯性积为零。刚体动量矩为：$$L=I_{{x}‘}\omega_{{x}‘}{i}‘+I_{{y}‘}\omega_{{y}‘}{j}‘+I_{{z}‘}\omega_{{z}‘}{k}‘$$
可以看出，$L$和$\omega$通常不共线，因为三个转动惯量一般并不相等，仅当刚体绕惯量主轴转动时，$L$和$\omega$才共线。
下面涉及到两个不同坐标系观测到的向量对时间求导的关系 (time derivative in rotating reference frame)。假设刚体以角速度$\omega$绕着某一瞬时轴旋转，与刚体固连的动坐标系的单位向量$\vec{u}$随时间变化，变化规律如下：$$\frac{d \vec{u}}{dt}=v=\omega \times \vec{u}$$
如果我们在动坐标系中观测到向量$f$（这时动坐标系的基矢${i}‘$、${j}‘$、${k}‘$相对观察者是不变的），$f(t)=f_x(t){i}‘+f_y(t){j}‘+f_z(t){k}‘$，现在我们要以静止参考系为参照（这时${i}‘$、${j}‘$、${k}‘$是随时间变化的）对$f$求导$$\begin{align*}
\frac{d \mathbf{f}}{dt} &=\frac{df_x}{dt}{i}‘+\frac{d{i}‘}{dt}f_x+ \frac{df_y}{dt}{j}‘+\frac{d{j}‘}{dt}f_y + \frac{df_z}{dt}{k}‘+\frac{d{k}‘}{dt}f_z \\
&=\frac{df_x}{dt}{i}‘+\frac{df_y}{dt}{j}‘+\frac{df_z}{dt}{k}‘+[\mathbf{\omega} \times(f_x {i}‘+f_y {j}‘+f_z {k}‘)]\\
&=(\frac{d \mathbf{f}}{dt})_r+ \mathbf{\omega} \times \mathbf{f}(t)
\end{align*}$$
牛顿第一定律和第二定律只适用于惯性参考系，对于非惯性参考系是不适用的。在非惯性参考系中动力学的基本方程不同于惯性系。根据上面的结论，可以推导出随体坐标系中的欧拉动力学方程：$$\begin{align*}
N=\frac{dL}{dt}&=(\frac{dL}{dt})_r+\omega \times L \\
&=\frac{d(I\omega)}{dt}+\omega \times I\omega\\
&=I\frac{d\omega}{dt}+\omega \times I\omega
\end{align*}$$
下标$r$表示向量在刚体上的动坐标系中描述，一般为惯性主轴坐标系。写成分量方程如下：$$\left\{\begin{matrix}
I_{{x}‘} \frac{d\omega_{{x}‘}}{dt}+(I_{{z}‘}-I_{{y}‘})\omega_{{y}‘}\omega_{{z}‘}=N_{{x}‘}\\
I_{{y}‘} \frac{d\omega_{{y}‘}}{dt}+(I_{{x}‘}-I_{{z}‘})\omega_{{x}‘}\omega_{{z}‘}=N_{{y}‘}\\
I_{{z}‘} \frac{d\omega_{{z}‘}}{dt}+(I_{{y}‘}-I_{{x}‘})\omega_{{x}‘}\omega_{{y}‘}=N_{{z}‘}
\end{matrix}\right.$$
其中，$N_{{x}‘}$、$N_{{y}‘}$、$N_{{z}‘}$分别为外力对$O{x}‘$、$O{y}‘$、$O{z}‘$轴之矩，$I_{{x}‘}$、$I_{{y}‘}$、$I_{{z}‘}$为刚体相对过质心的三个惯量主轴的转动惯量。这就是求解刚体定点运动的基本方程（一般为非线性微分方程组），称为欧拉方程。需要注意的是，欧拉方程中各矢量的分量都是按照刚体惯性主轴投影的分量。
一般来说，不能从上式求出世界坐标系下角速度的三个分量，因为欧拉动力学方程中所取的主轴坐标系是固定在刚体上的。还需要结合欧拉运动学方程（动坐标系中角速度与欧拉角的关系）：$$\left\{\begin{matrix}\begin{align*}
\omega_{{x}‘}&=\dot{\psi}sin\theta sin\phi+\dot{\theta}cos\phi\\
\omega_{{y}‘}&=\dot{\psi}sin\theta cos\phi-\dot{\theta}sin\phi\\
\omega_{{z}‘}&=\dot{\psi}cos\theta +\dot{\phi}
\end{align*}\end{matrix}\right.$$
将欧拉动力学方程和运动学方程结合起构成求解定点运动的微分方程组，消去$\omega_{{x}‘}$、$\omega_{{y}‘}$、$\omega_{{z}‘}$后，便得到关于欧拉角$\psi$、$\phi$、$\theta$的二阶微分方程。这是一组非线性常微分方程组，它只在特殊条件下才存在解析解。一般情况下，只能通过数值计算得到方程的数值解。
在物体属性对话框中点击Show dynamic properties dialog按钮，弹出刚体动力学属性对话框。在这个界面中可以定义物体的质量以及质量分布参数：
通常，规则几何体绕质心坐标系的转动惯量可以查表得到，省去了计算过程。在VREP中添加一个默认大小的圆柱体，底面圆的半径为0.05m，高为0.1m，默认密度为1000Kg/m3. 那么：
$$\begin{align*}
m &= \rho \pi r^2 h = 0.785398 \\
I_{xx}m^{-1} &= \frac{m}{12} \left(h^2+3 r^2\right)/m=0.00145833 \\
I_{yy}m^{-1} &= \frac{m}{12} \left(h^2+3 r^2\right)/m=0.00145833 \\
I_{zz}m^{-1} &= \frac{m}{2} r^2/m=0.00125
\end{align*}$$
下图分别是长方体、圆柱体、椭球体以质心坐标系为参考的质量惯性矩（转动惯量）计算公式：
进行动力学仿真，可以看出圆柱体的质心由于偏离中心太远，在倾覆力矩的作用下倒下：
大多数三维建模软件（例如 SolidWorks、CATIA）以及一些仿真软件（如 Adams、VREP）都提供惯性计算功能。下面以SolidWorks为例对介绍一下如何获取惯性参数，并与VREP进行对比。在Solidworks中新建一个零件，该零件由两个圆柱体堆叠而成（零件原点在大圆柱体底面中心），半径分别为50mm、30mm，两个圆柱体的高都为50mm。为了软件能正确计算惯性参数，需要给零件设定材料，这里选为普通碳钢，密度为7800Kg/m3
在工具→评估→质量属性中可以查看零件的惯性参数（如果单位或显示的数值不合适可以在选项中调整）
注意以下几点：
$$I_{A}=\left[
\begin{matrix}
\rm Px & 0 & 0\\
0 & \rm Py & 0\\
0 & 0 & \rm Pz\\
\end{matrix}
\right]$$
下面将Solidworks中的零件导出成STL网格模型，然后再导入VREP中。这种导入的STL模型在VREP中为Simple random shape：can represent any mesh. It has one color and one set of visual attributes. Not optimised nor recommended for dynamics collision response calculation (since very slow and unstable). 但是由于这种类型的几何体不支持自动计算质量属性，因此先将其转换为凸壳或组合凸壳：
然后设置密度为7800Kg/m3，点击按钮进行自动计算：
经验算，零件质量、质心位置以及惯性主矩与Solidworks的计算结果一致。区别是VREP中零件的固定参考坐标系是默认在包围盒的中心位置，目前还没发现可以更改这一参考点的地方。
参考：
Introduction to Robotics - Mechanics and Control Chapter 6. Manipulator dynamics
Modern Robotics Mechanics, Planning, and Control Chapter 8. Dynamics of Open Chains
标签：gen 投影 数值计算 soc err 仿真 堆叠 sam 数值
原文地址：https://www.cnblogs.com/21207-iHome/p/7765508.html
