tooth_deg[0] = 10;
tooth_deg[1] = 10
tooth_deg[2] = 10
tooth_deg[3] = 10
.....
tooth_deg[14] = 10
tooth_deg[15] = 30
tooth_deg[16] = 30
tooth_deg[17] = 10
tooth_deg[18] = 10
.....
tooth_deg[28] = 10
tooth_deg[29] = 30

SetPin 1, INTH, tach

tach:
tooth0_time = Timer
tooth0_duty = tooth0_time - tooth1_time
If tooth0_duty > (tooth1_duty + 1) Then
Pin(2) = 1
Pin(2) = 0
End If

tooth_num = tooth_num + 1

tooth1_duty = tooth0_duty
tooth1_time = tooth0_time

IReturn

Option DEFAULT NONE
Option AUTORUN ON
Option EXPLICIT

Dim INTEGER x
DIM FLOAT tooth_time, tooth1_time, tooth_pul

SetPin 1, INTH, Tach
SetTick 1000, RPM, 4


loopything:
' If tooth_time > 0 Then
' tooth_pul = tooth_time - tooth1_time
' tooth1_time = tooth_time
' tooth_time = 0
' End If
goto loopything


Tach:
x = x + 1
''tooth_time = Timer
IReturn


RPM:
Print "Counts: " x " = " ((x/30) * 60) "rpm"
x = 0
IReturn

long long stopclock(void){
mT4IntEnable(0);
}

#define tmr1con *(volatile unsigned int *)0xbf800600 //timer 1 configuration register
#define tmr1 *(volatile unsigned int *)0xbf800610 //timer 1 counter
tmr1con=0x8010; //turn on with scale 8
tmr1=0; //reset the timer
//wait for whatever you are timing
return tmr1;

long long startclock(void){
mT4IntEnable(1);
}

//RB1
#define pgdout *(volatile unsigned int *)0xbf886114 = (1 << 1) // Trisb<1>=0 - Output
#define pgdin *(volatile unsigned int *)0xbf886118 = (1 << 1) // Trisb<1>=1 - Input
#define pgd LATBbits.LATB1
#define readpgd() ((*(volatile unsigned int *)0xbf886120 >> 1) & 1)

//RB2
#define clklo *(volatile unsigned int *)0xbf886134 = (1 << 2) // pin 6 Low
#define clkhi *(volatile unsigned int *)0xbf886138 = (1 << 2) // pin 6 High

#define _SUPPRESS_PLIB_WARNING
#include <plib.h>

#define IC2con *(volatile unsigned int *)0xbf802200 //Input capture 2 configuration register
//#define IC2buf *(volatile unsigned int *)0xbf802210 //Input capture 2
//#define IC2r *(volatile unsigned int *)0xbf80fa2C // Input capture 2 peripheral pin select to input register map (tbl 4-22)
#define RB9con *(volatile unsigned int *)0xbf886118 = (1 << 9) //TrisB<9> = Input (set 1)

static volatile int count;

long long main(void) {

//Register values can only be changed if the Configuration bit, IOLOCK (CFGCON<13>), = 0.
IC2R=0x0100; //Map IC2 to RPB9 (tbl 11-1)

// configuring IC2
IC2CON=0x8306; //turn on rising edge 32bit timers2&3

// enable multi-vector interrupts - done in source code

// enable capture interrupt
mIC2ClearIntFlag();
mIC2IntEnable(1);


return(count);
}


//IRQ 11, Vector 9, Persistent interrupt
void __ISR( _INPUT_CAPTURE_2_VECTOR, ipl2) IC2_Handler(void)
{
// unsigned char test = IFS0bits.IC2IF;
count++;

// long long temp = IC2BUF; //"To clear an interrupt source, read the buffer result (ICxBUF) register...."
mIC2ClearIntFlag();
}