Проблема была не в прошивке, заменил датчик холла и все заработало