If the foc_rdy is always 1, can you check the reigster 0x02 after time out?
Only for the printed offset value, looks fine but it is not just simple answer. you can also compare the data before and after FOC to see if data quality becomes good or not.
In case, please also print out the related register content (power_CONF, FOC_CONF, others used in the FOC function) for further debug.
... View more