Todo List

Member rtc::LinearSystem< T, M >::gaussianElim (const Vec< T, M > &b, Vec< T, M > &sol)

goto is often considered "bad style", consider rewriting

Member rtc::SMat3< T >::inverted () const

consider throwing exception instead