The sensor is powered correctly I think. No issues with that. And thanks for sharing the code. It looks very complex but can you just drop me some hints how can I use it in my case? (I mean I have no idea what this means "to get maximum precision out of arduino's ICP feature")