vicon_odom: Big cleanup
Reformat using clang-format (no functional changes)
Set default CMAKE_BUILD_TYPE to RelWithDebInfo