PIC18F4550 based strboscope and Tachometer problem.

#include "Configuration_Header_File.h"
#include "LCD_8bit_file.h"

#pragma config PLLDIV = 1       // PLL Prescaler Selection bits (No prescale (4 MHz oscillator input drives PLL directly))
#pragma config CPUDIV = OSC1_PLL2// System Clock Postscaler Selection bits ([Primary Oscillator Src: /1][96 MHz PLL Src: /2])
#pragma config USBDIV = 1       // USB Clock Selection bit (used in Full-Speed USB mode only; UCFG:FSEN = 1) (USB clock source comes directly from the primary oscillator block with no postscale)

// CONFIG1H
#pragma config FOSC = INTOSC_EC // Oscillator Selection bits (Internal oscillator, CLKO function on RA6, EC used by USB (INTCKO))
#pragma config FCMEN = OFF      // Fail-Safe Clock Monitor Enable bit (Fail-Safe Clock Monitor disabled)
#pragma config IESO = OFF       // Internal/External Oscillator Switchover bit (Oscillator Switchover mode disabled)

void Timer1_start();
void Timer0_config();


#define StrobePulse      LATDbits.LATD2
#define MeasurePin       LATAbits.LATA4

#define _XTAL_FREQ 4000000

char message1[] = "Tachometer";
unsigned long int count = 0;
unsigned long RPM_Value;


void main()
{ 
    OSCCON=0x72;    /* Configure oscillator frequency to 8MHz */
    TRISB = 0;      /* Set as output Port */
    TRISA= 0x10;
    Pulse = 1;   /* send high on PortB */
    LCD_Init();
    Timer0_config();
    Timer1_start();
    LCD_Command(0xC0);
    LCD_String_xy(1,4,message1); 
    while(1)
    {
        TMR0ON = 1;
        TMR0L = 0;
        TMR0H = 0;
        MeasurePin = 1;
        __delay_ms(1000);
        MeasurePin = 0;
        TMR0ON = 0;    // Stop the timer
        RPM_Value = TMR0 * 60;
        Display_RPM(RPM_Value);
    };
    
}
/*********************Interrupt Service Routine for Timer1************************/

void interrupt Timer1_ISR()
{
    if(PIR1bits.TMR1IF)
    {

        TMR1 = RPM_Value / 60;
        StrobePulse= ~StrobePulse;
        PIR1bits.TMR1IF=0; /* Make Timer1 Overflow Flag to '0' */
        
    }
}

void Timer1_start()
{
    GIE=1;              /* Enable Global Interrupt */
    PEIE=1;             /* Enable Peripheral Interrupt */
    TMR1IE=1;           /* Enable Timer1 Overflow Interrupt */
    TMR1IF=0;
    T1CON=0x80;         /* Enable 16-bit TMR1 Register,No pre-scale,use internal clock,Timer OFF */
    //TMR1=0xF830;        /* Load Count for generating delay of 1ms */
    TMR1=0xF97D;        /* Load Count for generating delay of 1us */
    //TMR1=0xFF38;        /* Load Count for generating delay of 1us */
    TMR1ON=1;           /* Turn-On Timer1 */
}

void Timer0_config()
{
    T0CON = 0b00101000;
}


 
void Display_RPM(unsigned int num)
{
    char TempA = 0, TempB = 0, TempC = 0, TempD = 0, TempE = 0, TempF = 0;
    unsigned int Temp = num;
    char MessageFrame[8];
    
    TempA = Temp / 100000;
    Temp = Temp % 100000;
    TempB = Temp / 10000;
    Temp = Temp % 10000;
    TempC = Temp / 1000;
    Temp = Temp % 1000;
    TempD = Temp / 100;
    Temp = Temp % 100;
    TempE = Temp / 10;
    TempF = Temp % 10;

    MessageFrame[0] = TempA + 0x30;
    MessageFrame[1] = TempB + 0x30;
    MessageFrame[2] = TempC + 0x30;
    MessageFrame[3] = TempD + 0x30;
    MessageFrame[4] = TempE + 0x30;
    MessageFrame[5] = TempF + 0x30;
    
    LCD_String_xy(2,4,MessageFrame);
}

#include "osc_config.h"
#include "LCD_8bit_file.h"
#include <string.h>

#define f_timer 2000000
void Display_RPM(unsigned long num);
void main()
{
    unsigned long pulse,data1,data2;
    float period;
    float frequency;
    unsigned long RPM;
    
    TRISCbits.TRISC2=1;
    OSCCON=0x72;        /* set internal clock to 8MHz */
    LCD_Init();
    PIE1bits.CCP1IE=1;
    PIR1bits.CCP1IF=0;     
    CCP1CON=0x05;       /* Capture mode is selected for detecting Rising edge */
    CCPR1=0x00;         /*CCPR1 is capture count Register which is cleared initially*/
    TMR1IF=0;           
    T1CON=0xB0;         /* Enable 16-bit TMR1 Register,1:8 pre-scale,use internal clock,Timer OFF */
    TMR1=0;
    T1CONbits.TMR1ON=1; /* Turn-On Timer1 */        
    while(1)        
    {               
        while(!(PIR1bits.CCP1IF));  /*Wait for Interrupt flag which is generated when edge is detected*/
            data1=CCPR1;            /*Copy count of 1st edge detected*/        
            PIR1bits.CCP1IF=0;
        while(!(PIR1bits.CCP1IF));  /*Wait for Interrupt flag which is generated when edge is detected*/
            data2=CCPR1;            /*Copy count of 2nd edge detected*/
            PIR1bits.CCP1IF=0;
          
        if(data1<data2)
            {    
            /*Calculation for Pulse width Measurement*/
            pulse = data2 - data1;
            period= ((float)pulse/(float)f_timer);    /*Count for 1 cycle*0.5us gives period */
            frequency = 1/ (period * 8);         /*  Prescale of timer 1 is 8*/
            RPM = frequency * 60;               /* for RPM */
            Display_RPM(RPM);
        }
        TMR1=0;
    }                              
}


void Display_RPM(unsigned long num)
{
    char MessageFrame[8];

    MessageFrame[0] =  num/10000 + 0x30;
    MessageFrame[1] = (num/1000)%10 + 0x30;
    MessageFrame[2] = (num/100)%10 + 0x30;
    MessageFrame[3] = (num/10)%10  + 0x30;
    MessageFrame[4] =  num%10 + 0x30;
    
    LCD_String_xy(2,4,MessageFrame);
}