VelPosFusion.cpp : Coded for ease of test harness integration