Hi Sakari, >I'll apply this now, however I see that most of the registers in the four modes are the same. In the future it'd be good to separate the parts that are common in all of them (to be written in sensor power-on) to make this (slightly) more maintainable. Thanks for the review. Makes sense. Not sure how it impacts because the sequence of writes will be different, need thorough testing to confirm nothing is broken.