Fixed timestamp if sonar interrupt happens before reading current value.