void main(void) {

InitApp(); /* Initialize I/O and Peripherals for application */

while (1) {
GIE = 0;
GPIO1 = (RPM > 500);
GPIO2 = (RPM > 950);
GPIO4 = (RPM > 3500);
GIE = 1;
}

}

int CntImpl = 0; //Количество импульсов на 1 оборот
unsigned int MsRotate = 0; //Длительность одного оборота в мс
unsigned char Rotation = 0; //Флаг вращения, если в течении секунды не было импульсов, считать, что вращения нет

void CalcPeriodMS(void) {
MsRotate++; //подсчитываем миллисекунды
if (MsRotate == 1000) { //если насчитали секунду
RPM1 = 0; //все обнулить
RPM2 = 0;
RPM3 = 0;
RPM4 = 0;
RPM = 0;
MsRotate = 0;
Rotation = 0; //сбросить флаг вращения
}
}

void CalcRPM(void) {

if (GPIO0) { //считать только "положительные прерывания"
CntImpl++; //прибавить счетчик импульсов
if (CntImpl == 2) { //2 импульса на один оборот
RPM4 = RPM3; //сдвинуть предыдущие вычисления
RPM3 = RPM2;
RPM2 = RPM1;
TMR1ON = 0; //остановить TMR1
RPM1 = (1000 / MsRotate) * 60; //Высчитать RPM из 1 оборота
RPM = (RPM1 + RPM2 + RPM3 + RPM4) / 4; //высчитать среднее из 4 предыдущих значений
MsRotate = 0; //Сбросить мс для следующего оборота
Rotation = 1; //Установить флаг вращения
TMR1ON = 1; //запустить таймер
CntImpl = 0; //сбросить кол-во импульсов на оборот
}
}

}

void interrupt isr(void) {

if (TMR1IF) {

TMR1 += 64537; // 1000 тиков - 1 мс
if (Rotation) CalcPeriodMS(); //Считать только когда крутится вал
TMR1IF = 0; //Обработали прерывание TMR1
}

if (GPIF) {
CalcRPM(); //расчет RPM
GPIF = 0;
}

}