Форум arduino.ua

Здравствуйте, помогите пожалуйста с кодом для обработки датчика Холла(измеряю частоту вращения вала, в диапазоне 5-40 тыс.об./мин.). Есть Ардуино Уно, необходимо преобразовать сигнал с двух датчиков Холла, и есть вот такой пример кода:

#include <MsTimer2.h>  //библиотека таймера
unsigned int state=0;
unsigned int rmp=0;
unsigned int time=0;
unsigned long timpause=1000; // 1c

void flash() //обработка прерывания таймера 
{
detachInterrupt(0); //остановить прерывания 2
Serial.print("rmp:");
Serial.println(rmp*60);
rmp=0;
attachInterrupt(0, blink, RISING ); //вкл 2 прерывания
}

void setup() {
Serial.begin(9600);
attachInterrupt(0, blink, RISING ); //прерывания на 2м порту - с датчика холла
MsTimer2::set(1000, flash); // 1 c
MsTimer2::start(); //включаем прерывания по таймеру
}
void loop() { }
void blink()  //прерывания с датчика холла
{
++rmp;  //увеличиваем счетчик на 1
}

Необходимо подогнать его под 2 датчика Холла, по всякому уже пробовал менять код, но ничего не получилось, прошу помощи, очень нужно.
Еще есть пример, который работал на DUE, но на 16 мГц платах этот скетч измеряет частоту вращения только до частоты 545 Гц (32640 тыс.об/мин), потом выдает минусовые значения.

volatile int rpmcount = 0;
int rpm = 0;
unsigned long lastmillis = 0;
float rpm2 = 0;
int rrr = 1;
void setup(){
Serial.begin(9600);
attachInterrupt(0, rpm_fan, FALLING);//interrupt cero (0) is on pin two(2).
}
void loop(){
if (millis() - lastmillis == 1000){ /*Uptade every one second, this will be equal to reading frecuency (Hz).*/
detachInterrupt(0); //Disable interrupt when calculating
rpm = rpmcount * 60;
rpm2 = rpm *(rrr);/* Convert frecuency to RPM, note: this works for one interruption per full rotation. For two interrups per full rotation use rpmcount * 30.*/
Serial.print("RPM =\t"); //print the word "RPM" and tab.
Serial.print(rpm); // print the rpm value.
Serial.print("\t Hz=\t"); //print the word "Hz".
Serial.println(rpmcount); /*print revolutions per second or Hz. And print new line or enter.*/
rpmcount = 0; // Restart the RPM counter
lastmillis = millis(); // Uptade lasmillis
attachInterrupt(0, rpm_fan, FALLING); //enable interrupt
}
}
void rpm_fan(){ /* this code will be executed every time the interrupt 0 (pin2) gets low.*/
rpmcount++;
}

Помогите пожалуйста, буду очень благодарен