[Fedor Malkin]

Для начала надо оригинальной программой посмотреть что показывают датчики в реальном времени. А потом уже думать куда лезть. Можно попробовать сделать калибровку. В подобных случаях это иногда помогает.