Added velocity tracking, need to tweak scale.