Adapted for use of PX4 drv_hrt.h header, removed unused headers, removed unused get_dt() and elaped_time() functions, removed bool lock_integrator since this was pointless anyway