program fgen;
uses ad9832_driver;

const
  //FCONST : real = 0.0018647; //@8 MHz Clock
  FCONST : real = 0.00232831;  //@10 MHz
  HZ1 : word = 536;   //1 Hz
  //MHZ1 : DWORD = 536334577;//280;//577;    //@8 MHz Clock
  MHZ1 : real = 429496729.6;  //@10 MHz
  //FADS : array[0..5] of DWORD = (HZ1,        HZ1 * 10,    HZ1 * 100,
  //                               HZ1 * 1000, HZ1 * 10000, HZ1 * 100000);
                                 
  FADS : array[0..5] of DWORD = ({(MHZ1 + 500000) div 1000000}{537}430, MHZ1 div 100000,
                                 MHZ1 div 10000, MHZ1 div 1000,
                                 MHZ1 div 100, MHZ1 div 10);
  STEP : array[0..5] of string[8] = ('   1 Hz', '  10 Hz', ' 100 Hz',
                                     '  1 kHz', ' 10 kHz', '100 kHz');

var
  d0, d1, d2, d3, i : byte;
  b1old, b2old, b3old, b4old : byte;
  freg : real;//dword; volatile;
  fsum : byte; volatile;
  freq_out : real;
  keypress : boolean;
 
  text: array[20] of char;
  f_text : string[17];
  line2 : string[16];
 



procedure setup_intosc;
begin
  OSCCON := %11110000; //8 MHz INTOSC
  OSCTUNE := %11000000;  //PLL Enabled For INTOSC
end;

procedure setup_AD9832;
begin
  TRISC.6 := 0;  //FSYNC bit
  PORTC.6 := 1;
end;

procedure Init_CPU;
begin
  ADCON1 := %00001111;
  CMCON := 7;
  TRISA := 255;
  TRISB := 0;
  //PORTB := 0;
  fsum :=4;
  freg := fads[fsum];
  //PORTB.fsum := 1;
  b1old := 0; b2old := 0;
  b3old := 0; b4old := 0;
  keypress := False;
end;

procedure Get_SWG_Data;
begin
  d3 := highest(freg);
  d2 := higher(freg);
  d1 := hi(freg);
  d0 := lo(freg);
end;

procedure Some_Delay;
begin
  Delay_ms(100);
end;

procedure LCD_Write;
begin
  //ByteToStr(fsum, text);
  line2 := STEP[fsum];
  freq_out := freg * FCONST;
  FloatToStr(freq_out, f_text);
  Lcd_Cmd(Lcd_Clear);
  //LCD_Out(1, 1, 'Fout= ');
  //LCD_Out_CP(f_text);
  //LCD_Out(1, 14, ' Hz');
  //LCD_Out(2, 1, 'Step: ');
  //LCD_Out_CP(line2);
 
  LCD_Out(1, 1, f_text);
  LCD_Out(2, 1, line2);
end;

procedure Set_Freq;
begin
  Get_SWG_Data;
  SWG_Set_Freq(d3, d2, d1, d0);
end;

begin

  //real test
    //freg := 5370;//00000;
    //freq_out := freg * FCONST;
  //end real test
  setup_intosc;
  setup_ad9832;
  Init_CPU;
 
  LCD_Config(PORTB, 3, 2, 1, 0, PORTB, 5, 6, 4);
  //LCD_Init(PORTB);
  //LCD_Config(PORTB, 7, 6, 5, 4, PORTB, 2, 1, 3);
  Some_Delay;
  LCD_CMD(LCD_CURSOR_OFF);
  LCD_Out(1, 1, 'FreqGen 1Hz-1MHz');
  LCD_Out(2, 1, ' radonen - 2009');
  Delay_ms(2000);
  LCD_Write;

  SPI_init;
  Some_Delay;
  SWG_Reset;
  Some_Delay;
  SWG_Select_Source(SWG_CTRL_SS_EXT);
  Some_Delay;

  Get_SWG_Data;
  SWG_Set_Freq(d3, d2, d1, d0);
 
  while True do
    begin

      if Button(PORTA, 0, 1, 1) then b1old := 255;
      if b1old and Button(PORTA, 0, 1, 0) then
        begin
          //PORTB.fsum := 0;
          fsum := fsum - 1;
          if fsum >= 6 then
            fsum := 0;
          //PORTB.fsum := 1;
         
          LCD_Write;
         
          b1old := 0;
        end;
       
      if Button(PORTA, 1, 1, 1) then b2old := 255;
      if b2old and Button(PORTA, 1, 1, 0) then
        begin
          //PORTB.fsum := 0;
          fsum := fsum + 1;
          if fsum > 5 then
            fsum := 5;
          //PORTB.fsum := 1;
         
          LCD_Write;
         
          b2old := 0;
        end;
       
      if Button(PORTA, 2, 1, 1) then b3old := 255;
      if b3old and Button(PORTA, 2, 1, 0) then
        begin
          freg := freg - fads[fsum];
          if (freg < fads[0]) or (freg > fads[5] * 10) then
            freg := fads[0];

          LCD_Write;
         
          b3old := 0;
          keypress := True;
        end;
       
      if Button(PORTA, 3, 1, 1) then b4old := 255;
      if b4old and Button(PORTA, 3, 1, 0) then
        begin
          freg := freg + fads[fsum];
          if freg > fads[5] * 10 then
            freg := fads[5] * 10;
           
          LCD_Write;
         
          b4old := 0;
          keypress := True;
        end;

      //LCD_Write;
      if keypress then
        begin
          Set_Freq;
          //keypress := False;
        end;
    end;
end.