UpdateCount was only used as a first-time-initialization flag for the accel low-pass filter, not as a real counter. Replaced with a simple uint8_t flag and moved the set to the first-update path.
SkyLiCoder