Working version with old (modded) Arduino Wire lib