Geras выложите обе прошивки с указанием где-что, попробуем сваять что-нибудь. Ну в смысле 1 с рабочим датчиком из 1 поста уж и так скачаю)