Rework lq_fpm calculation to increase calculation accuracy