Hi BSTRobin, I tested the FOC with default range(4g) and accel_g_value are {1, 0, 0, 1} But after FOC, the acc.x value didn't reach to '0'. I don't think that the purpose of FOC is to make acc value to '0'. It can find the axis of gravity and make it to 8192. Am I correct? I added some debug message in perform_accel_foc function as below picture. And then I got a debug message as below. Do you think, the FOC function working well on my device? I'd like to know your opinion. Best Regards, Andy
... View more