Revert "Revert "[hm] Fix D term inaccurate and no alarms with native RF pit probe""

This reverts commit c732077fc8e74adbe943c3d64886a3ca67180863.