Update mocap_node.cpp