セクション2「オイラー角を利用して速度の回転成分を求めよう」は{ }, [ ] などを使って分けられていますが、読みにくいです。サブセクションに分けるなど、もう少しすっきりした構成にならないでしょうか?