Matrix: 対角線上の値を指定して初期化する処理のバグ修正
Matrix&Vector: std::ostreamに出力する関数を追加
Pose2D: スケーリングが初期値0になっていた点とgetFinal()で更新されてない問題を修正