Update vicon_odom_node.cpp