Регистры все из примера взяты, датчик там такой же как у меня, а так же проверил документацию датчика, с регистрами все хорошо...