Thomas Traoré / 7dof_cpp