Can you display raw register data?
So you can compare result of your calculation with register value. Maybe sensor have some drift issues.