Add crank angle estimate back in