Update VelPosFusion.cpp