1 parent
7d39832b2a
commit
785feb7f26
1 file changed
+71
@@ -0,0 +1,71 @@
|
|||||||
|
+++
|
||||||
|
title = "Mass Matrix"
|
||||||
|
author = ["Dehaeze Thomas"]
|
||||||
|
draft = false
|
||||||
|
+++
|
||||||
|
|
||||||
|
Tags
|
||||||
|
:
|
||||||
|
|
||||||
|
|
||||||
|
## Mass matrix of a rigid body at its center of mass {#mass-matrix-of-a-rigid-body-at-its-center-of-mass}
|
||||||
|
|
||||||
|
The 6x6 mass matrix of a rigid body relates the forces/torques applied to the body to its translational/rotational accelerations.
|
||||||
|
Expressed at a point \\(P\\) and in a given frame, it is:
|
||||||
|
|
||||||
|
\begin{equation}
|
||||||
|
\bm{M}\_P = \begin{bmatrix} m \bm{I}\_3 & -m [\bm{r}\_c]\_\times \\\ m [\bm{r}\_c]\_\times & \bm{I}\_P \end{bmatrix}
|
||||||
|
\end{equation}
|
||||||
|
|
||||||
|
with \\(\bm{r}\_c\\) the position of the CoM relative to \\(P\\), and \\([\bm{r}\_c]\_\times\\) the skew-symmetric matrix of \\(\bm{r}\_c\\).
|
||||||
|
|
||||||
|
|
||||||
|
### Translation: always diagonal at the CoM {#translation-always-diagonal-at-the-com}
|
||||||
|
|
||||||
|
- The translational block is \\(m \bm{I}\_3\\) (mass is a scalar), so the three translations are decoupled from each other.
|
||||||
|
- The translation/rotation coupling block is \\(m [\bm{r}\_c]\_\times\\), which vanishes if and only if \\(P\\) is the CoM.
|
||||||
|
- Therefore, at the CoM, the mass matrix is block-diagonal:
|
||||||
|
|
||||||
|
\begin{equation}
|
||||||
|
\bm{M}\_{\text{CoM}} = \begin{bmatrix} m \bm{I}\_3 & \bm{0} \\\ \bm{0} & \bm{I}\_c \end{bmatrix}
|
||||||
|
\end{equation}
|
||||||
|
|
||||||
|
|
||||||
|
### Rotation: diagonal only in the principal frame {#rotation-diagonal-only-in-the-principal-frame}
|
||||||
|
|
||||||
|
The rotational block is the inertia tensor at the CoM:
|
||||||
|
|
||||||
|
\begin{equation}
|
||||||
|
\bm{I}\_c = \begin{bmatrix} I\_{xx} & -I\_{xy} & -I\_{xz} \\\ -I\_{xy} & I\_{yy} & -I\_{yz} \\\ -I\_{xz} & -I\_{yz} & I\_{zz} \end{bmatrix}
|
||||||
|
\end{equation}
|
||||||
|
|
||||||
|
- It is symmetric positive (semi-)definite, but in general **not diagonal**, even when evaluated at the CoM.
|
||||||
|
The products of inertia \\(I\_{xy}, I\_{xz}, I\_{yz}\\) couple the rotations.
|
||||||
|
- Example: a thin rod of mass \\(m\\) and length \\(L\\), centered on the CoM and tilted by \\(\theta\\) from the x axis in the x-y plane.
|
||||||
|
\\(I\_{xx} = \tfrac{mL^2}{12}\sin^2\theta\\), \\(I\_{yy} = \tfrac{mL^2}{12}\cos^2\theta\\), \\(I\_{xy} = -\tfrac{mL^2}{12}\sin\theta\cos\theta \neq 0\\) unless \\(\theta = 0, 90^\circ\\).
|
||||||
|
A torque about x then produces an angular acceleration about both x and y.
|
||||||
|
- Since \\(\bm{I}\_c\\) is real and symmetric, a rotation \\(\bm{R}\\) always exists (spectral theorem) such that:
|
||||||
|
|
||||||
|
\begin{equation}
|
||||||
|
\bm{R}^T \bm{I}\_c \bm{R} = \text{diag}(I\_1, I\_2, I\_3)
|
||||||
|
\end{equation}
|
||||||
|
|
||||||
|
The columns of \\(\bm{R}\\) are the **principal axes** (eigenvectors) and \\(I\_i\\) the **principal moments of inertia** (eigenvalues).
|
||||||
|
Axes are unique when the eigenvalues are distinct; for a symmetric top (two equal) or a sphere (all equal), there is freedom in the choice.
|
||||||
|
|
||||||
|
```matlab
|
||||||
|
[R, D] = eig(I_c); % I_c symmetric -> R orthogonal
|
||||||
|
if det(R) < 0, R(:,3) = -R(:,3); end % proper rotation
|
||||||
|
I_principal = R' * I_c * R; % = D (diagonal)
|
||||||
|
```
|
||||||
|
|
||||||
|
|
||||||
|
### Resulting dynamics {#resulting-dynamics}
|
||||||
|
|
||||||
|
In the principal frame at the CoM, for small motion about rest and no stiffness:
|
||||||
|
|
||||||
|
\begin{equation}
|
||||||
|
m \ddot{x} = f\_x,\quad m \ddot{y} = f\_y,\quad m \ddot{z} = f\_z,\quad I\_1 \ddot{\theta}\_x = t\_x,\quad I\_2 \ddot{\theta}\_y = t\_y,\quad I\_3 \ddot{\theta}\_z = t\_z
|
||||||
|
\end{equation}
|
||||||
|
|
||||||
|
i.e. six decoupled double integrators: \\(\bm{G}(s) = \text{diag}\left(\tfrac{1}{ms^2}, \tfrac{1}{ms^2}, \tfrac{1}{ms^2}, \tfrac{1}{I\_1 s^2}, \tfrac{1}{I\_2 s^2}, \tfrac{1}{I\_3 s^2}\right)\\).
|
||||||
Reference in new issue
Block a user