Added velocity back into error estimate