* Fix SE(2) inverse * Add missing ]
upper_triangular_matrix_to_full_matrix
* fix deprication version for latest numpy * fix deprication version for latest numpy * fix deprication version for latest numpy * fix deprication version for latest numpy