Add Velocity to Pose