sbit LCD_RS at LATD2_bit;
sbit LCD_EN at LATD3_bit;
sbit LCD_D4 at LATD4_bit;
sbit LCD_D5 at LATD5_bit;
sbit LCD_D6 at LATD6_bit;
sbit LCD_D7 at LATD7_bit;
sbit LCD_RS_Direction at TRISD2_bit;
sbit LCD_EN_Direction at TRISD3_bit;
sbit LCD_D4_Direction at TRISD4_bit;
sbit LCD_D5_Direction at TRISD5_bit;
sbit LCD_D6_Direction at TRISD6_bit;
sbit LCD_D7_Direction at TRISD7_bit;

void strip_blanks(char *in, char *out)
{
  int i,j;
  int len=0;
  len = strlen(in);

  for(j=0,i=0; i<len; i++) if(in[i] != ' ') out[j++] = in[i];

  out[j] = '\0';
}

float f = 0.0;

void Timer1Int() org 0x001A
{
  char bigbuf[50] = "";
  char buf[7] = "";
  char line1[16];
  IFS0bits.T1IF = 0;
  f = (float)TMR3*65536.0+(float)TMR2; //2^16*TMR3+TMR2
  f = PR1*19531.25/f; //19531.25 = 10MHz/(2*256)
  FloatToStr(f,buf);
  strcat(bigbuf,"f=");
  strcat(bigbuf,buf);
  strcat(bigbuf," Hz");
  strip_blanks(bigbuf,line1);
  //sprintf(s,"f=%.2f [Hz]",f);
  Lcd_Cmd(_Lcd_Clear);
  Lcd_Out(1,1,line1);
  TMR2 = 0;
  TMR3 = 0;
}

void main()
{
  Lcd_Init();
  Lcd_Cmd(_Lcd_Cursor_Off);
  AD1PCFG = 0xFFFF;
  TRISCbits.TRISC3 = 0;

  T2CONbits.T32 = 1;
  T2CONbits.TCKPS0 = 1;
  T2CONbits.TCKPS1 = 1;
  T2CONbits.TCS = 0;
  PR3 = 0xFFFF;
  PR2 = 0xFFFF;

  T1CONbits.TCS = 1;
  T1CONbits.TSYNC = 1;
  PR1 = 1000;

  IFS0bits.T1IF = 0;
  IEC0bits.T1IE = 1;

  T1CONbits.TON = 1;
  T2CONbits.TON = 1;

  while(1)
  {
   PORTCbits.RC3 = ~PORTCbits.RC3;
   delay_us(1000);
  }
}