Fixed velocity visualization and added in a publisher for person position and velocity.