Замена микросхемы 1827ВЕ1-0000000 в Г4-164 на AVR -МК

#define INTERUPT3_BYTEMASK 0x04
#define INTERUPT2_BYTEMASK 0x02
#define INTERUPT1_BYTEMASK 0x01
 
 
#define FLAG_PARSECODE_FM  0x01
#define FLAG_PARSECODE_AM  0x02
#define FLAG_PARSECODE_OUT 0x03
#define FLAG_PARSECODE_FREQ 0x04
#define FLAG_INC_STEP 0x05
#define FLAG_DEC_STEP 0x06
#define FLAG_TURN_OFF_MODES 0x07
#define FLAG_DISP_ERROR 0x08
#define FLAG_DISP_FM 0x09
#define FLAG_DISP_AM 0x0a
#define FLAG_DISP_OUT 0x0b
#define FLAG_DISP_FREQ 0x0c
#define FLAG_BLINK_OFF 0x0d
#define FLAG_BLINK_CODE 0x0e
#define FLAG___MODE 0x0f
#define FLAG___LFO 0x10
#define  FLAG__FM_CODE 0x11
#define FLAG__AM_CODE 0x12
#define FLAG__ATT_CODE 0x13
#define FLAG__HFO_CODE 0x14
#define  FLAG__DVDC_CODE 0x15
 
#define FREQ_BYTEMASK 0x01
#define FM_BYTEMASK     0x02
#define AM_BYTEMASK    0x04
 
//reg_data0
#define MASK_FLAG_PARSECODE_FM 0x01
#define MASK_FLAG_PARSECODE_AM 0x02
#define MASK_FLAG_PARSECODE_OUT 0x04
#define  MASK_FLAG_PARSECODE_FREQ 0x08
 
 
//reg_data1
#define  MASK_FLAG_INC_STEP  0x01
#define  MASK_FLAG_DEC_STEP 0x02
 
//reg_data2
#define MASK_FLAG_TURN_OFF (uint8_t) 0x01
#define MASK_FLAG_DISP_ERROR (uint8_t) 0x02
#define MASK_FLAG_DISP_FM (uint8_t) 0x04
#define MASK_FLAG_DISP_AM (uint8_t) 0x08
#define MASK_FLAG_DISP_OUT (uint8_t) 0x10
#define MASK_FLAG_DISP_FREQ (uint8_t) 0x20
#define MASK_BLINK_OFF (uint8_t)   0x40
#define MASK_FLAG_BLINK_CODE (uint8_t) 0x80
 
 
//reg_data3 
#define  MASK_FLAG_MODE (uint8_t) 0x01
#define  MASK_FLAG_LFO (uint8_t) 0x02
#define  MASK_FLAG_FM_CODE (uint8_t) 0x04
#define  MASK_FLAG_AM_CODE (uint8_t) 0x08
#define  MASK_FLAG_ATT_CODE (uint8_t) 0x10
#define  MASK_FLAG_HFO_CODE (uint8_t) 0x20
#define  MASK_FLAG_DVDC_CODE  (uint8_t) 0x40

 
 
 #include <avr/io.h>
 #include <avr/pgmspace.h>
 #include  "defines.h"
 #include  "intparser.h"
 #include  "gpibio.h"
 #include   "subroutines.h"
 
 
 
 
 
uint8_t CheckButtonsNumericKeypad(uint8_t byte )
{
 
if(byte==BUTTON_0){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_1){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_2){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_3){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_4){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_5){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_6){  goto CaseBUTTON_NUMKEYPAD ;      } 
if(byte==BUTTON_7){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_8){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte==BUTTON_9){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte== BUTTON_COMMA){  goto CaseBUTTON_NUMKEYPAD ;      }
if(byte== BUTTON_SHARP){  goto CaseBUTTON_NUMKEYPAD ;      }
return  0;
 
 
CaseBUTTON_NUMKEYPAD:
 
 if ( (CheckMemoryWriteModeOn()!=0))    {  WriteStatement() ; }   
 if ((CheckMemoryRecallModeOn()!=0))    {   GetStatementFromMemory(); }   
 
 InputParamValue();
return 1;
}
 
 
  //LabelPoint8:
void ParseKeyb()
{
//;        8_1  
 
uint8_t byte=GetScanCodeValue() ;
byte&=BITMASK_KEYBOARD;
if(CheckButtonsNumericKeypad( byte )==0x01) { return; } 
 
 
if((byte& BUTTON_F)!=0) {  SetDutyReg(TOKEN_F);  return ;}  
if((byte& BUTTON_FM)!=0) { TurnOnFM (); SetDutyReg(TOKEN_FM);  return ;      }
if((byte& BUTTON_AM)!=0) { TurnOnAM(); SetDutyReg(TOKEN_AM);  return ;     }
if((byte&BUTTON_PM)!=0) { TurnOnPM(); SetDutyReg(TOKEN_PM);  return ;  }
if((byte& BUTTON_MOD_OFF)!=0) { TurnOffModulation(); SetDutyReg(TOKEN_MOD_OFF);  return ; }
if((byte&BUTTON_EXT)!=0)  { PrepareExtModulation () ; return; } /* 9*/
if((byte& BUTTON_STEP)!=0) { StepModeOn(); return; }
 
if((byte& BUTTON_OUT)!=0) { OutputOn(); SetDutyReg(TOKEN_OUT); return; }
if((byte& BUTTON_OUT_OFF)!=0) { OutputOnOff();  return; }
if((byte& BUTTON_LFO)!=0) { ChangeLFONum(); return; }
if((byte& BUTTON_SHARP)!=0) { SetMemWrMode(); return;  }
if((byte&BUTTON_RECALL)!=0) { SetMemRecallMode(); return; }
if((byte& BUTTON_MHz)!=0) { NormalizeFreq(); return; }//;  10   
if((byte& BUTTON_kHz)!=0) { if (CheckStepModeOn()){ NormalizeStep();  return; } else { NormalizeFM();  return;}  }//;  macro,  13_2 or to 1 
if((byte& BUTTON_PERCENT)!=0) { NormalizeAMCoef(); return; }  //;   14_2   
if((byte& BUTTON_mV)!=0) { SetOutInputMode(TOKEN_Out_mV);  return;} //;   15_2  
if((byte& BUTTON_mkV)!=0) {SetOutInputMode( TOKEN_Out_mkV );  return;}//;   15_2 
if((byte& BUTTON_dBV)!=0) { SetOutInputMode(TOKEN_Out_dB);  return;} //;   15_2  
if((byte& BUTTON_6dB)!=0) { if (CheckModeAM==0)    { TurnOn6dB(); }  return; }//;   11  
//CaseDefault: 
if(StepMode==1) { ChangeFreqOneStep() ;   NormalizeFreq(); return; }   ;//  12_3,   
ChangeStepParam(); 
  return ; //to point1             
}
 
/* ******************** */
 
 
 
void ParseInterrupts(  )
{
LabelPoint2:
 
//;   2     
// AnalyseInterrupt_InputData() ;
 
 
if((IntFlags&INTERUPT3_BYTEMASK)!=0) { ParseGPIBByte();  return;  } //;  add decoder subroutines for GPIB , goto LabelPoint7 
if((IntFlags&INTERUPT2_BYTEMASK)!=0) { ParseKeyb();  return; } //;  add decoder subroutines ,    ParseKeyboard();
 
 
if((DutyReg&FREQ_BYTEMASK)!=0) {     NormalizeFreq()  ;  return;    /* 12_1 */      }
if((DutyReg&FM_BYTEMASK)!=0) {    NormalizeFM()  ;  return; /*  13_1 */      } 
if((DutyReg&AM_BYTEMASK)!=0) {    NormalizeAMCoef()  ;  return; /*  14_1 */      }  
NormalizeOutput1()   ; /* 15_1 */
return;
}
 
 
 
 
 
 
/* *********************** */
 
 
 
uint8_t selectedflag=0;
void SetSelectedFlag ( uint8_t flag)
{
selectedflag=flag;
}
 
 
void SetSelectedFlagZero ( )
{
 
 
if(selectedflag==FLAG_PARSECODE_FM ) { Flag[0]&=(uint8_t) ~( MASK_FLAG_PARSECODE_FM);      } 
if(selectedflag==FLAG_PARSECODE_AM ) { Flag[0]&=(uint8_t) ~( MASK_FLAG_PARSECODE_AM);      } 
if(selectedflag==FLAG_PARSECODE_OUT ) { Flag[0]&=(uint8_t) ~( MASK_FLAG_PARSECODE_OUT);      } 
if(selectedflag==FLAG_PARSECODE_FREQ ) { Flag[0]&=(uint8_t) ~( MASK_FLAG_PARSECODE_FREQ);      } 
 
if(selectedflag==FLAG_INC_STEP ) { Flag[1]&=(uint8_t) ~( MASK_FLAG_INC_STEP);      } 
if(selectedflag==FLAG_DEC_STEP) { Flag[0]&=(uint8_t) ~( MASK_FLAG_DEC_STEP);      } 
 
if(selectedflag==FLAG_TURN_OFF_MODES) { Flag[2]&=(uint8_t) ~(  MASK_FLAG_TURN_OFF);      } 
if(selectedflag==FLAG_DISP_ERROR) { Flag[2]&=(uint8_t) ~( MASK_FLAG_DISP_ERROR);      } 
if(selectedflag==FLAG_DISP_FM) { Flag[2]&=(uint8_t) ~(  MASK_FLAG_DISP_FM);      } 
if(selectedflag==FLAG_DISP_AM) { Flag[2]&=(uint8_t) ~(  MASK_FLAG_DISP_AM);      } 
if(selectedflag==FLAG_DISP_OUT) { Flag[2]&=(uint8_t) ~(  MASK_FLAG_DISP_OUT);      } 
if(selectedflag== FLAG_DISP_FREQ) { Flag[2]&=(uint8_t) ~( MASK_FLAG_DISP_FREQ);      } 
if(selectedflag==FLAG_BLINK_OFF) { Flag[2]&=(uint8_t) ~(  MASK_BLINK_OFF);      } 
if(selectedflag== FLAG_BLINK_CODE) { Flag[2]&=(uint8_t) ~(  MASK_FLAG_BLINK_CODE);      } 
 
if(selectedflag== FLAG___MODE) { Flag[3]&=(uint8_t) ~( MASK_FLAG_MODE);      } 
if(selectedflag== FLAG___LFO) { Flag[3]&=(uint8_t) ~( MASK_FLAG_LFO);      } 
if(selectedflag== FLAG__FM_CODE) { Flag[3]&=(uint8_t) ~( MASK_FLAG_FM_CODE);      } 
if(selectedflag== FLAG__AM_CODE) { Flag[3]&=(uint8_t) ~( MASK_FLAG_AM_CODE);      } 
if(selectedflag== FLAG__ATT_CODE) { Flag[3]&=(uint8_t) ~( MASK_FLAG_ATT_CODE);      } 
if(selectedflag== FLAG__HFO_CODE) { Flag[3]&=(uint8_t) ~( MASK_FLAG_HFO_CODE);      } 
if(selectedflag== FLAG__DVDC_CODE) { Flag[3]&=(uint8_t) ~( MASK_FLAG_DVDC_CODE);      } 
selectedflag=0;
return;
}
 
 
 
 
 
 
volatile void CheckFlags1(){
 
 
 
 
if( (Flag[0]&MASK_FLAG_PARSECODE_FM)!=0){   ParseCodesFM() ;  ParseCodesHFO() ;  SetSelectedFlag (FLAG_PARSECODE_FM);  return; }
if((Flag[0]&MASK_FLAG_PARSECODE_AM)!=0) {   ParseCodesAM();   SetSelectedFlag (FLAG_PARSECODE_AM);   return; }
if((Flag[0]&MASK_FLAG_PARSECODE_OUT)!=0){  ParseCodesAtt() ; ParseStaticCommands() ; ParseCodesOut() ; 
              SetSelectedFlag (FLAG_PARSECODE_OUT);  return; }
if((Flag[0]&MASK_FLAG_PARSECODE_FREQ)!=0){ ParseCodesDVDC() ; ParseCodesBand() ; ParseStaticCommands();  
              CheckFMMax() ; SetSelectedFlag (FLAG_PARSECODE_FREQ);  return;  }
 
if((Flag[1]&MASK_FLAG_INC_STEP)!=0) { IncStep(); SetSelectedFlag (FLAG_INC_STEP); return; } //3 
if((Flag[1]&MASK_FLAG_DEC_STEP)!=0)  {DecStep(); SetSelectedFlag (FLAG_DEC_STEP); return; } 
 
if((Flag[2]&MASK_FLAG_TURN_OFF)!=0) { TurnOffUnusedModes(); SetSelectedFlag (FLAG_TURN_OFF_MODES);  return ; } 
if((Flag[2]&MASK_FLAG_DISP_ERROR)!=0) { DisplayErrorFM(); SetSelectedFlag (FLAG_DISP_ERROR);  return ; }
if((Flag[2]&MASK_FLAG_DISP_FM)!=0)  { DisplayFMValue(); SetSelectedFlag (FLAG_DISP_FM); return;  }
if((Flag[2]&MASK_FLAG_DISP_AM)!=0) { DisplayAMValue(); SetSelectedFlag ( FLAG_DISP_AM); return;  }
if((Flag[2]&MASK_FLAG_DISP_OUT)!=0) { DisplayOutValue(); SetSelectedFlag ( FLAG_DISP_OUT); return; }
if((Flag[2]&MASK_FLAG_DISP_FREQ)!=0) { DisplayFreqValue(); SetSelectedFlag ( FLAG_DISP_FREQ); return; }
 
if((Flag[2]&MASK_BLINK_OFF)!=0)  { SendBlinkOff(); SetSelectedFlag ( FLAG_BLINK_OFF); return; } //4
if((Flag[2]&MASK_FLAG_BLINK_CODE)!=0)  { SendBlinkCode();  SetSelectedFlag ( FLAG_BLINK_CODE); return; }
 
 
if((Flag[3]&MASK_FLAG_MODE)!=0)  { SendStaticCommands(); SetSelectedFlag ( FLAG___MODE); return; }
if((Flag[3]&MASK_FLAG_LFO)!=0)  { SendLFOCodes(); SetSelectedFlag ( FLAG___LFO); return; }
if((Flag[3]&MASK_FLAG_FM_CODE)!=0) { SendFMCodes(); SetSelectedFlag ( FLAG__FM_CODE); return; }
if((Flag[3]&MASK_FLAG_AM_CODE)!=0)  { SendAMCodes(); SetSelectedFlag ( FLAG__AM_CODE); return;}
 
if((Flag[3]&MASK_FLAG_ATT_CODE)!=0) {SendAttCodes();   SetSelectedFlag( FLAG__ATT_CODE); return ; } //5
if((Flag[3]&MASK_FLAG_HFO_CODE)!=0) { SendHFOCodes(); SetSelectedFlag( FLAG__HFO_CODE);   return ; }
if((Flag[3]&MASK_FLAG_DVDC_CODE)!=0)  { SendDVDCCodes(); SetSelectedFlag( FLAG__DVDC_CODE);   return ; }
return; // goto  LabelPoint1 
} 
 
 
 
//; jump to this subroutine in the main() after  init subroutines   
 
void  main_sub ()
{
LabelPoint1:
cli();
if(  DutyReg !=0) { goto LabelOnDutyRegNotZero;}
/* if duty reg=0 */
SendMemWrPulse();
SetAddrWait();
sei();
LabelNoInterrupts:
 
//fix
if (IntFlags==0) {  /*sleep(); */  goto      LabelNoInterrupts;          }  // ;  loop while no interrupts
cli();
ParseInterrupts( ); //goto  LabelPoint2;
 
goto  LabelPoint1; 
 
LabelOnDutyRegNotZero:
SetSelectedFlagZero();
CheckFlags1();
goto LabelPoint1;
return  ;
}

#include <stdio.h>
#include <stdint.h>
 
 
 
 
#define MODE_NOCMD 0
#define MODE_TURN_OFF_OUT 1
#define MODE_TURN_OFF_6dB   2
#define MODE_TURN_ON_6dB     3
 
#define MODE_INT_AM  4  
#define MODE_EXT_AM 5
#define MODE_INT_FM 6
#define MODE_EXT_FM 7
#define MODE_TURN_ON_EXT_PM 8
#define MODE_TURN_ON_INT_PM 9
 
 
#define MODE_TURN_OFF_EXT_AM 10
#define MODE_TURN_OFF_INT_AM 11
#define MODE_TURN_OFF_EXT_FM 12
#define MODE_TURN_OFF_INT_FM 13 
#define MODE_TURN_OFF_PM  14
//#define MODE_TURN_OFF_EXT_PM  15
 
#define MODE_FREQ   16
#define MODE_PREP_EXT_MOD 17
#define MODE_TURN_ON_OUT 18
#define MODE_TURN_ON_OUT_dB 19
#define MODE_TURN_ON_OUT_mV 20
#define MODE_TURN_ON_OUT_mkV 21
#define MODE_PREPSETFREQLFO  22
 
#define MODE_SETFREQLFO0 30
#define MODE_SETFREQLFO1 31
#define MODE_SETFREQLFO2 32
#define MODE_SETFREQLFO3 33
#define MODE_SETFREQLFO4 34
#define MODE_SETFREQLFO5 35
#define MODE_SETFREQLFO6 36
#define MODE_SETFREQLFO7 37
 
 
#define  NUM_DIGITS_FREQ 7
#define  NUM_DIGITS_FM 3 
#define  NUM_DIGITS_AM 2
#define  NUM_DIGITS_OUT 4
 
 
uint8_t  GetGPIBByte()
{
uint8_t byte; 
printf("\n Input byte  char  :   ");
scanf("%s",&byte);
//printf("\n      Send active signal  on Interrupt 3  ");
return byte; 
}
 
 
void ExecCMD(uint8_t mode)
{
 
switch (mode){
case MODE_NOCMD: 
 
              printf("\n\t\t\t\t  No CMD  or error  ");
 
 
                             break;
case MODE_TURN_OFF_OUT: 
                printf("\n\t\t\t\t  turn Off Out  "); 
                             break;
case MODE_TURN_OFF_6dB: 
                 printf("\n\t\t\t\t  TURN OFF 6dB  "); 
                             break;
 
case MODE_TURN_ON_6dB: 
                 printf("\n\t\t\t\t  TURN ON 6dB  "); 
                             break;
                             
case MODE_INT_AM: 
                 printf("\n\t\t\t\t  TURN ON INT AM  "); 
                             break;
case MODE_EXT_AM: 
                 printf("\n\t\t\t\t  TURN ON EXT AM  ");    
                             break;    
case MODE_INT_FM: 
                  printf("\n\t\t\t\t  TURN INT FM  "); 
                             break;
case MODE_EXT_FM:  
                  printf("\n\t\t\t\t  TURN EXT FM  "); 
                             break;                                                                               
 
case MODE_TURN_ON_EXT_PM:  
                  printf("\n\t\t\t\t  TURN ON EXT PM  "); 
                             break; 
case MODE_TURN_ON_INT_PM:  
                  printf("\n\t\t\t\t  TURN ON INT PM  "); 
                             break;
 case MODE_TURN_OFF_EXT_AM:  
                  printf("\n\t\t\t\t  TURN ON EXT AM  "); 
                             break;
 case MODE_TURN_OFF_INT_AM:  
                  printf("\n\t\t\t\t  TURN ON INT AM  "); 
                             break;
 case MODE_TURN_OFF_EXT_FM:  
                  printf("\n\t\t\t\t  TURN ON EXT FM  "); 
                             break;
 case MODE_TURN_OFF_INT_FM:  
                  printf("\n\t\t\t\t  TURN ON INT FM  "); 
                             break;                            
                             
 case MODE_TURN_OFF_PM:  
                  printf("\n\t\t\t\t  MODE TURN OFF PM  "); 
                             break;                                    
 case MODE_FREQ:  
                  printf("\n\t\t\t\t  MODE FREQ  "); 
                             break;  
                             
 case MODE_TURN_ON_OUT: 
                  printf("\n\t\t\t\t  TURN ON OUT  ");                   
                 break; 
                     
                             
 case MODE_TURN_ON_OUT_dB:  
                  printf("\n\t\t\t\t  TURN ON OUT dB  ");                    
                 break; 
 case MODE_TURN_ON_OUT_mV:  
                  printf("\n\t\t\t\t  TURN ON OUT mV  ");                    
                 break; 
 case MODE_TURN_ON_OUT_mkV: 
                  printf("\n\t\t\t\t  TURN ON OUT mkV  ");                   
                 break;                          
 case MODE_SETFREQLFO0: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO0  ");                      
                 break;              
                 
 case MODE_SETFREQLFO1: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO1  ");                      
                 break;              
                 
 case MODE_SETFREQLFO2: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO2  ");                      
                 break;
 case MODE_SETFREQLFO3: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO3 ");                   
                 break;              
 case MODE_SETFREQLFO4: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO4  ");                      
                 break;              
 case MODE_SETFREQLFO5: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO5  ");                      
                 break; 
 case MODE_SETFREQLFO6: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO6  ");                      
                 break; 
 case MODE_SETFREQLFO7: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO7  ");                      
                 break;                                                                  
                 
                                                                                                  
default :
 break;
 
}
 
 
return;
}
 
 
 
 
 
 
 
/*
 
    0  digits[0] = 5
    1  digits[1] = 2
    2  digits[2] = 0    CommaPos=2
           
    3  digits[3] =1  
    4  digits[4]=0     auto 0 
    5  digits[5]=0     auto 0
    6  digits[6]=0     auto 0
    7  end
 
    0  digits[0]  
    1  digits[1]   
    2  digits[2]  
    3  end
 
 2  0 digits[0]=8
 1  1 digits[1]=0
 0  2  end
 
 
 4  0 digits[0]=1
 3  1 digits[0]=0 CommaPos=1
 2  2 digits[0]=0
 1  3 digits[0]=0
 0  4  end
 
 
*/
 
 uint8_t  count=0;   
 uint8_t FlagMsg=0;
 uint8_t flagLFO=0; 
 uint8_t FlagGetComma=0;
 uint8_t FlagMode=0;
 uint8_t tmpdigits[7] ;
 uint8_t CommaPos=0;
 
 
 
uint8_t GetNumDigitsMode( uint8_t FlagMode)
{
if(FlagMode==MODE_FREQ) {return 7; }
if(FlagMode==MODE_INT_AM) {return 2; } 
if(FlagMode==MODE_EXT_AM) {return 2; }  
if(FlagMode==MODE_INT_FM) {return 3; }  
if(FlagMode==MODE_EXT_FM) { return 3; }  
if(FlagMode==MODE_TURN_ON_OUT_dB) { return 4; } 
if(FlagMode==MODE_TURN_ON_OUT_mV) { return 4; }      
if(FlagMode==MODE_TURN_ON_OUT_mkV) { return 4; }    
return 0;
}
 
 
 
void ParseCommaPos(uint8_t   counter, uint8_t FlagMode)
{
CommaPos=counter;
 /* for evaluation only */ 
printf ( "\n\t\t\t\t comma posistion in %d digit     ",   counter  );   
    
return; 
}
 
void PutDigitToGPIBStackIfByte(uint8_t count, uint8_t  byte,   uint8_t FlagMode  )
{
tmpdigits[count]=byte-0x30;  
/* for evaluation only */ 
printf ( "\n\t\t\t\t %d digit is %d   ",   count , tmpdigits[count ]  );
}
 
 
void SetLastDigitsZero(uint8_t FlagMode, uint8_t count ,uint8_t NumDigMode )
{ 
if(NumDigMode !=0) { for (uint8_t i=count;i<=6; i++)    {  tmpdigits[i]=0; } }  
 
/* for evaluation only */ 
for (uint8_t i=0;i<NumDigMode; i++) { printf("\n%d", tmpdigits[i] );   if(i==CommaPos) { printf(" <comma>");}
}    
return ;    
}
 
 
 
 
uint8_t GetModeLFOIfDigit(uint8_t Flag_Mode   )
{
 
if (Flag_Mode==0x30) {    return MODE_SETFREQLFO0;   }
if (Flag_Mode==0x31) {    return MODE_SETFREQLFO1;    }
if (Flag_Mode==0x32) {    return MODE_SETFREQLFO2;    }
if (Flag_Mode==0x33) {    return MODE_SETFREQLFO3;    }
if (Flag_Mode==0x34) {    return MODE_SETFREQLFO4;    }
if (Flag_Mode==0x35) {    return MODE_SETFREQLFO5;    }
if (Flag_Mode==0x36) {    return MODE_SETFREQLFO6;    }
if (Flag_Mode==0x37) {    return MODE_SETFREQLFO7;    }
if (Flag_Mode==0x38) {    return MODE_NOCMD;   }
if (Flag_Mode==0x39) {    return MODE_NOCMD;   } 
return MODE_NOCMD;
}
 
//for sorting command chars (emulation of the mode switch )
void ParseCommand()
{
uint8_t byte=GetGPIBByte ();  //gets  TTL code from inverse code for LD bus  bits 
 
/* 'space' */
 if (byte==0x20)  { return; }
 
/*  ','  */
                 
 if (byte==0x2c){                        
 SetLastDigitsZero(FlagMode, count, GetNumDigitsMode(FlagMode));
 ExecCMD(FlagMode);                
 count=0;   FlagMsg= 0; FlagMode=MODE_NOCMD;  
 return;              
} 
 
 
/*  '.'  */
if (byte==0x2e)  {   
           
if ((FlagMsg==1)&&(FlagGetComma==1) )  { 
if(count==0) { PutDigitToGPIBStackIfByte( 0, 0x30, FlagMode  ); ParseCommaPos( 0, FlagMode);  count=1;   }
else { ParseCommaPos( ( count-1), FlagMode); }
FlagGetComma=0; return;  } 
FlagGetComma=0;
return;              
}
                
 
  /* '0'...'9' */
if ((byte>=0x30)&&(byte<=0x39)) {
 
 if (FlagMode==MODE_PREPSETFREQLFO)  {  FlagMode=  GetModeLFOIfDigit(byte); FlagMsg=0; return; } 
 
 
if (FlagMode==MODE_TURN_ON_OUT) { FlagMode= MODE_TURN_ON_OUT_dB;   } 
if ((count)>=GetNumDigitsMode(FlagMode)  )  { FlagMsg=0;   return; } //fix
if (FlagMsg==1){  PutDigitToGPIBStackIfByte( count , byte, FlagMode  ); count+=1; return;   }
 
return; 
}
 
 /* I   turn off output */
if(byte==0x49) { FlagMsg=0 ; FlagMode=MODE_TURN_OFF_OUT;  return;}                  
 
/* H  6 dB off        */     
if(byte==0x48){ FlagMsg=0 ; FlagMode=MODE_TURN_OFF_6dB;  return; }
/* O   turn on 6 dB  */
if(byte==0x4F){ FlagMsg=0 ; FlagMode=MODE_TURN_ON_6dB;  return; }   
/* D   PM on ; off for ND  */
if(byte==0x44){   FlagMsg=0 ;
if( FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_TURN_ON_EXT_PM; } else { FlagMode=MODE_TURN_ON_INT_PM; }
 return; }
 
/* E  PM off, end for BE,CE */
if(byte==0x45){   FlagMsg=0 ;  
 if(FlagMode==MODE_EXT_AM) {   FlagMode=MODE_TURN_OFF_EXT_AM; }
 if(FlagMode==MODE_EXT_FM) {   FlagMode=MODE_TURN_OFF_EXT_FM; }
 if(FlagMode==MODE_INT_AM) {   FlagMode=MODE_TURN_OFF_INT_AM; }
 if(FlagMode==MODE_INT_FM) {   FlagMode=MODE_TURN_OFF_INT_FM; } 
 else  {   FlagMode=MODE_TURN_OFF_PM; }             
 return;  }
/* A      freq  , for example "A520.100,B80." or "A520.100," <=7 digits + comma */
if(byte==0x41) { FlagGetComma=1; FlagMsg=1 ;  count=0;  FlagMode=MODE_FREQ;   return; }
/* N , for example "NB,","NB20,",  "NС,","ND" ,"NC100,"  */
if(byte==0x4e){ FlagGetComma=1; FlagMsg=1 ; FlagMode=MODE_PREP_EXT_MOD; return;  }              
 
/* B    end of  NB, NC,    begin of BE        AM,% for example  "B80." or "B80," , <=2 digits */
if(byte==0x42){ FlagMsg=1 ; FlagGetComma=1; count =0;
if (FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_EXT_AM ; }  else  {  FlagMode=MODE_INT_AM ;  } 
return;  }
/* C    end of  NB, NC,    begin of CE         , FM, kHz , <=3  digits  */  
if(byte==0x43){ count=0; FlagGetComma=1;  FlagMsg=1 ;    
if ( FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_EXT_FM; } else {FlagMode=MODE_INT_FM ;} 
return;  }
 
/*  K   turn on output , if  only K , turn on output */ 
if(byte==0x4B){ FlagGetComma=1; FlagMsg=1 ;   count=0; FlagMode=MODE_TURN_ON_OUT ; return; }
 /* L           output, mV, <=3.5 digits + comma */
if((byte==0x4C)||(byte==0x22)){  FlagGetComma=1;  FlagMsg=1 ; count=0; FlagMode=MODE_TURN_ON_OUT_mV; return; }
/* M  , for example,"M10.00,"  */               
if(byte==0x4D){ FlagGetComma=1; FlagMsg=1 ; count=0;   FlagMode=MODE_TURN_ON_OUT_mkV;     return; }
 /* F   Finternal ,for example "F1,"  */
if(byte==0x46){  FlagGetComma=0; FlagMsg=1; count=0;    FlagMode=MODE_PREPSETFREQLFO;     return; }
 
FlagGetComma=0; FlagMsg=0 ;   count=0;  FlagMode=MODE_NOCMD; ExecCMD(FlagMode);    //fix
 
return; 
}
 
void ParseCommand1()
{
ParseCommand();
//SendDataAcceptedStrobe(); 
}
/* *********************************** */
int main()
{
 
label1:
printf("\n Input command  bytes (  A520.1, B80, F1, M10.2 ,  ) ");  //fix 0x2e problem for end of message 
//printf("\n Input command  bytes \n(  0x41 0x35 0x32 0x30  0x2e 0x31 0x2c"); 
ParseCommand1();     //A 0x41
ParseCommand1(); //5 0x35
ParseCommand1(); //2 0x32
ParseCommand1(); //0 0x30
ParseCommand1(); //.0x2e
ParseCommand1(); //1 0x31
ParseCommand1(); //, 0x2c
//printf("\n Input command   0x20 0x42 0x38 0x30 0x2c 0x20 0x46 0x31 0x2c 0x20 0x4D 0x31 0x35 0x2e 0x20 0x2c ) ");  //fix 0x2e problem for end of message 
ParseCommand1(); //  0x20
ParseCommand1(); //B 0x42
ParseCommand1(); //8 0x38
ParseCommand1(); //0 0x30
ParseCommand1(); //, 0x2c
 
 
ParseCommand1(); //  0x20
ParseCommand1(); //F 0x46
ParseCommand1(); //1 0x31
ParseCommand1(); //, 0x2c
ParseCommand1(); //  0x20
ParseCommand1(); //M 0x4D
ParseCommand1(); //1 0x31
ParseCommand1(); //5 0x35
ParseCommand1(); //. 0x2e    
ParseCommand1(); // 0x20  
ParseCommand1(); // 0x2c
    
printf ("\n Inpuit 1 for exit or 0 for next command ");
int key;
scanf("%d",&key);
if (key==0) {goto label1; }
 
 
 
}

#include <stdio.h>
#include <stdint.h>
 
 
 
 
#define MODE_NOCMD 0
#define MODE_TURN_OFF_OUT 1
#define MODE_TURN_OFF_6dB   2
#define MODE_TURN_ON_6dB     3
 
#define MODE_INT_AM  4  
#define MODE_EXT_AM 5
#define MODE_INT_FM 6
#define MODE_EXT_FM 7
#define MODE_TURN_ON_EXT_PM 8
#define MODE_TURN_ON_INT_PM 9
 
 
#define MODE_TURN_OFF_EXT_AM 10
#define MODE_TURN_OFF_INT_AM 11
#define MODE_TURN_OFF_EXT_FM 12
#define MODE_TURN_OFF_INT_FM 13 
#define MODE_TURN_OFF_PM  14
//#define MODE_TURN_OFF_EXT_PM  15
 
#define MODE_FREQ   16
#define MODE_PREP_EXT_MOD 17
#define MODE_TURN_ON_OUT 18
#define MODE_TURN_ON_OUT_dB 19
#define MODE_TURN_ON_OUT_mV 20
#define MODE_TURN_ON_OUT_mkV 21
#define MODE_PREPSETFREQLFO  22
 
#define MODE_SETFREQLFO0 30
#define MODE_SETFREQLFO1 31
#define MODE_SETFREQLFO2 32
#define MODE_SETFREQLFO3 33
#define MODE_SETFREQLFO4 34
#define MODE_SETFREQLFO5 35
#define MODE_SETFREQLFO6 36
#define MODE_SETFREQLFO7 37
 
 
#define  NUM_DIGITS_FREQ 7
#define  NUM_DIGITS_FM 3 
#define  NUM_DIGITS_AM 2
#define  NUM_DIGITS_OUT 4
 
 
uint8_t  GetGPIBByte()
{
uint8_t byte; 
printf("\n Input byte  char  :   ");
scanf("%s",&byte);
//printf("\n      Send active signal  on Interrupt 3  ");
return byte; 
}
 
 
void ExecCMD(uint8_t mode)
{
 
switch (mode){
case MODE_NOCMD: 
 
              printf("\n\t\t\t\t  No CMD  or error  ");
 
 
                             break;
case MODE_TURN_OFF_OUT: 
                printf("\n\t\t\t\t  turn Off Out  "); 
                             break;
case MODE_TURN_OFF_6dB: 
                 printf("\n\t\t\t\t  TURN OFF 6dB  "); 
                             break;
 
case MODE_TURN_ON_6dB: 
                 printf("\n\t\t\t\t  TURN ON 6dB  "); 
                             break;
                             
case MODE_INT_AM: 
                 printf("\n\t\t\t\t  TURN ON INT AM  "); 
                             break;
case MODE_EXT_AM: 
                 printf("\n\t\t\t\t  TURN ON EXT AM  ");    
                             break;    
case MODE_INT_FM: 
                  printf("\n\t\t\t\t  TURN INT FM  "); 
                             break;
case MODE_EXT_FM:  
                  printf("\n\t\t\t\t  TURN EXT FM  "); 
                             break;                                                                               
 
case MODE_TURN_ON_EXT_PM:  
                  printf("\n\t\t\t\t  TURN ON EXT PM  "); 
                             break; 
case MODE_TURN_ON_INT_PM:  
                  printf("\n\t\t\t\t  TURN ON INT PM  "); 
                             break;
 case MODE_TURN_OFF_EXT_AM:  
                  printf("\n\t\t\t\t  TURN ON EXT AM  "); 
                             break;
 case MODE_TURN_OFF_INT_AM:  
                  printf("\n\t\t\t\t  TURN ON INT AM  "); 
                             break;
 case MODE_TURN_OFF_EXT_FM:  
                  printf("\n\t\t\t\t  TURN ON EXT FM  "); 
                             break;
 case MODE_TURN_OFF_INT_FM:  
                  printf("\n\t\t\t\t  TURN ON INT FM  "); 
                             break;                            
                             
 case MODE_TURN_OFF_PM:  
                  printf("\n\t\t\t\t  MODE TURN OFF PM  "); 
                             break;                                    
 case MODE_FREQ:  
                  printf("\n\t\t\t\t  MODE FREQ  "); 
                             break;  
                             
 case MODE_TURN_ON_OUT: 
                  printf("\n\t\t\t\t  TURN ON OUT  ");                   
                 break; 
                     
                             
 case MODE_TURN_ON_OUT_dB:  
                  printf("\n\t\t\t\t  TURN ON OUT dB  ");                    
                 break; 
 case MODE_TURN_ON_OUT_mV:  
                  printf("\n\t\t\t\t  TURN ON OUT mV  ");                    
                 break; 
 case MODE_TURN_ON_OUT_mkV: 
                  printf("\n\t\t\t\t  TURN ON OUT mkV  ");                   
                 break;                          
 case MODE_SETFREQLFO0: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO0  ");                      
                 break;              
                 
 case MODE_SETFREQLFO1: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO1  ");                      
                 break;              
                 
 case MODE_SETFREQLFO2: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO2  ");                      
                 break;
 case MODE_SETFREQLFO3: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO3 ");                   
                 break;              
 case MODE_SETFREQLFO4: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO4  ");                      
                 break;              
 case MODE_SETFREQLFO5: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO5  ");                      
                 break; 
 case MODE_SETFREQLFO6: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO6  ");                      
                 break; 
 case MODE_SETFREQLFO7: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO7  ");                      
                 break;                                                                  
                 
                                                                                                  
default :
 break;
 
}
 
 
return;
}
 
 
 
 
 
 
 
/*
 
    0  digits[0] = 5
    1  digits[1] = 2
    2  digits[2] = 0    CommaPos=2
           
    3  digits[3] =1  
    4  digits[4]=0     auto 0 
    5  digits[5]=0     auto 0
    6  digits[6]=0     auto 0
    7  end
 
    0  digits[0]  
    1  digits[1]   
    2  digits[2]  
    3  end
 
 2  0 digits[0]=8
 1  1 digits[1]=0
 0  2  end
 
 
 4  0 digits[0]=1
 3  1 digits[0]=0 CommaPos=1
 2  2 digits[0]=0
 1  3 digits[0]=0
 0  4  end
 
 
*/
 
 uint8_t  count=0;   
 uint8_t FlagMsg=0;
 uint8_t flagLFO=0; 
 uint8_t FlagGetComma=0;
 uint8_t FlagMode=0;
 uint8_t tmpdigits[7] ;
 uint8_t CommaPos=0;
 
 
 
uint8_t GetNumDigitsMode( uint8_t FlagMode)
{
if(FlagMode==MODE_FREQ) {return 7; }
if(FlagMode==MODE_INT_AM) {return 2; } 
if(FlagMode==MODE_EXT_AM) {return 2; }  
if(FlagMode==MODE_INT_FM) {return 3; }  
if(FlagMode==MODE_EXT_FM) { return 3; }  
if(FlagMode==MODE_TURN_ON_OUT_dB) { return 4; } 
if(FlagMode==MODE_TURN_ON_OUT_mV) { return 4; }      
if(FlagMode==MODE_TURN_ON_OUT_mkV) { return 4; }    
return 0;
}
 
 
 
void ParseCommaPos(uint8_t   counter, uint8_t FlagMode)
{
CommaPos=counter;
 /* for evaluation only */ 
printf ( "\n\t\t\t\t comma posistion in %d digit     ",   counter  );   
    
return; 
}
 
void PutDigitToGPIBStackIfByte(uint8_t count, uint8_t  byte,   uint8_t FlagMode  )
{
tmpdigits[count]=byte-0x30;  
/* for evaluation only */ 
printf ( "\n\t\t\t\t %d digit is %d   ",   count , tmpdigits[count ]  );
}
 
 
void SetLastDigitsZero(uint8_t FlagMode, uint8_t count ,uint8_t NumDigMode )
{ 
if(NumDigMode !=0) { for (uint8_t i=count;i<=6; i++)    {  tmpdigits[i]=0; } }  
 
/* for evaluation only */ 
for (uint8_t i=0;i<NumDigMode; i++) { printf("\n%d", tmpdigits[i] );   if(i==CommaPos) { printf(" <comma>");}
}    
return ;    
}
 
 
 
 
uint8_t GetModeLFOIfDigit(uint8_t Flag_Mode   )
{
 
if (Flag_Mode==0x30) {    return MODE_SETFREQLFO0;   }
if (Flag_Mode==0x31) {    return MODE_SETFREQLFO1;    }
if (Flag_Mode==0x32) {    return MODE_SETFREQLFO2;    }
if (Flag_Mode==0x33) {    return MODE_SETFREQLFO3;    }
if (Flag_Mode==0x34) {    return MODE_SETFREQLFO4;    }
if (Flag_Mode==0x35) {    return MODE_SETFREQLFO5;    }
if (Flag_Mode==0x36) {    return MODE_SETFREQLFO6;    }
if (Flag_Mode==0x37) {    return MODE_SETFREQLFO7;    }
if (Flag_Mode==0x38) {    return MODE_NOCMD;   }
if (Flag_Mode==0x39) {    return MODE_NOCMD;   } 
return MODE_NOCMD;
}
 
//for sorting command chars (emulation of the mode switch )
void ParseCommand()
{
uint8_t byte=GetGPIBByte ();  //gets  TTL code from inverse code for LD bus  bits 
 
/* 'space' */
 if (byte==0x20)  { return; }
 
/*  ','  */
                 
 if (byte==0x2c){                        
 SetLastDigitsZero(FlagMode, count, GetNumDigitsMode(FlagMode));
 ExecCMD(FlagMode);                
 count=0;   FlagMsg= 0; FlagMode=MODE_NOCMD;  
 return;              
} 
 
 
/*  '.'  */
if (byte==0x2e)  {   
           
if ((FlagMsg==1)&&(FlagGetComma==1) )  { 
if(count==0) { PutDigitToGPIBStackIfByte( 0, 0x30, FlagMode  ); ParseCommaPos( 0, FlagMode);  count=1;   }
else { ParseCommaPos( ( count-1), FlagMode); }
FlagGetComma=0; return;  } 
FlagGetComma=0;
return;              
}
                
 
  /* '0'...'9' */
if ((byte>=0x30)&&(byte<=0x39)) {
 
 if (FlagMode==MODE_PREPSETFREQLFO)  {  FlagMode=  GetModeLFOIfDigit(byte); FlagMsg=0; return; } 
 
 
if (FlagMode==MODE_TURN_ON_OUT) { FlagMode= MODE_TURN_ON_OUT_dB;   } 
if ((count)>=GetNumDigitsMode(FlagMode)  )  { FlagMsg=0;   return; } //fix
if (FlagMsg==1){  PutDigitToGPIBStackIfByte( count , byte, FlagMode  ); count+=1; return;   }
 
return; 
}
 
 /* I   turn off output */
if(byte==0x49) { FlagMsg=0 ; FlagMode=MODE_TURN_OFF_OUT;  return;}                  
 
/* H  6 dB off        */     
if(byte==0x48){ FlagMsg=0 ; FlagMode=MODE_TURN_OFF_6dB;  return; }
/* O   turn on 6 dB  */
if(byte==0x4F){ FlagMsg=0 ; FlagMode=MODE_TURN_ON_6dB;  return; }   
/* D   PM on ; off for ND  */
if(byte==0x44){   FlagMsg=0 ;
if( FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_TURN_ON_EXT_PM; } else { FlagMode=MODE_TURN_ON_INT_PM; }
 return; }
 
/* E  PM off, end for BE,CE */
if(byte==0x45){   FlagMsg=0 ;  
 if(FlagMode==MODE_EXT_AM) {   FlagMode=MODE_TURN_OFF_EXT_AM; }
 if(FlagMode==MODE_EXT_FM) {   FlagMode=MODE_TURN_OFF_EXT_FM; }
 if(FlagMode==MODE_INT_AM) {   FlagMode=MODE_TURN_OFF_INT_AM; }
 if(FlagMode==MODE_INT_FM) {   FlagMode=MODE_TURN_OFF_INT_FM; } 
 else  {   FlagMode=MODE_TURN_OFF_PM; }             
 return;  }
/* A      freq  , for example "A520.100,B80." or "A520.100," <=7 digits + comma */
if(byte==0x41) { FlagGetComma=1; FlagMsg=1 ;  count=0;  FlagMode=MODE_FREQ;   return; }
/* N , for example "NB,","NB20,",  "NС,","ND" ,"NC100,"  */
if(byte==0x4e){ FlagGetComma=1; FlagMsg=1 ; FlagMode=MODE_PREP_EXT_MOD; return;  }              
 
/* B    end of  NB, NC,    begin of BE        AM,% for example  "B80." or "B80," , <=2 digits */
if(byte==0x42){ FlagMsg=1 ; FlagGetComma=1; count =0;
if (FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_EXT_AM ; }  else  {  FlagMode=MODE_INT_AM ;  } 
return;  }
/* C    end of  NB, NC,    begin of CE         , FM, kHz , <=3  digits  */  
if(byte==0x43){ count=0; FlagGetComma=1;  FlagMsg=1 ;    
if ( FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_EXT_FM; } else {FlagMode=MODE_INT_FM ;} 
return;  }
 
/*  K   turn on output , if  only K , turn on output */ 
if(byte==0x4B){ FlagGetComma=1; FlagMsg=1 ;   count=0; FlagMode=MODE_TURN_ON_OUT ; return; }
 /* L           output, mV, <=3.5 digits + comma */
if((byte==0x4C)||(byte==0x22)){  FlagGetComma=1;  FlagMsg=1 ; count=0; FlagMode=MODE_TURN_ON_OUT_mV; return; }
/* M  , for example,"M10.00,"  */               
if(byte==0x4D){ FlagGetComma=1; FlagMsg=1 ; count=0;   FlagMode=MODE_TURN_ON_OUT_mkV;     return; }
 /* F   Finternal ,for example "F1,"  */
if(byte==0x46){  FlagGetComma=0; FlagMsg=1; count=0;    FlagMode=MODE_PREPSETFREQLFO;     return; }
 
FlagGetComma=0; FlagMsg=0 ;   count=0;  FlagMode=MODE_NOCMD; ExecCMD(FlagMode);    //fix
 
return; 
}
 
void ParseCommand1()
{
ParseCommand();
//SendDataAcceptedStrobe(); 
}
/* *********************************** */
int main()
{
 
label1:
printf("\n Input command  bytes (  A520.1, B80, F1, M10.2 ,  ) ");  //fix 0x2e problem for end of message 
//printf("\n Input command  bytes \n(  0x41 0x35 0x32 0x30  0x2e 0x31 0x2c"); 
ParseCommand1();     //A 0x41
ParseCommand1(); //5 0x35
ParseCommand1(); //2 0x32
ParseCommand1(); //0 0x30
ParseCommand1(); //.0x2e
ParseCommand1(); //1 0x31
ParseCommand1(); //, 0x2c
//printf("\n Input command   0x20 0x42 0x38 0x30 0x2c 0x20 0x46 0x31 0x2c 0x20 0x4D 0x31 0x35 0x2e 0x20 0x2c ) ");  //fix 0x2e problem for end of message 
ParseCommand1(); //  0x20
ParseCommand1(); //B 0x42
ParseCommand1(); //8 0x38
ParseCommand1(); //0 0x30
ParseCommand1(); //, 0x2c
 
 
ParseCommand1(); //  0x20
ParseCommand1(); //F 0x46
ParseCommand1(); //1 0x31
ParseCommand1(); //, 0x2c
ParseCommand1(); //  0x20
ParseCommand1(); //M 0x4D
ParseCommand1(); //1 0x31
ParseCommand1(); //5 0x35
ParseCommand1(); //. 0x2e    
ParseCommand1(); // 0x20  
ParseCommand1(); // 0x2c
    
printf ("\n Inpuit 1 for exit or 0 for next command ");
int key;
scanf("%d",&key);
if (key==0) {goto label1; }
 
 
 
}

#include <stdio.h>
#include <stdint.h>
 
 
 
 
#define MODE_NOCMD 0
#define MODE_TURN_OFF_OUT 1
#define MODE_TURN_OFF_6dB   2
#define MODE_TURN_ON_6dB     3
 
#define MODE_INT_AM  4  
#define MODE_EXT_AM 5
#define MODE_INT_FM 6
#define MODE_EXT_FM 7
#define MODE_TURN_ON_EXT_PM 8
#define MODE_TURN_ON_INT_PM 9
 
 
#define MODE_TURN_OFF_EXT_AM 10
#define MODE_TURN_OFF_INT_AM 11
#define MODE_TURN_OFF_EXT_FM 12
#define MODE_TURN_OFF_INT_FM 13 
#define MODE_TURN_OFF_PM  14
//#define MODE_TURN_OFF_EXT_PM  15
 
#define MODE_FREQ   16
#define MODE_PREP_EXT_MOD 17
#define MODE_TURN_ON_OUT 18
#define MODE_TURN_ON_OUT_dB 19
#define MODE_TURN_ON_OUT_mV 20
#define MODE_TURN_ON_OUT_mkV 21
#define MODE_PREPSETFREQLFO  22
 
#define MODE_SETFREQLFO0 30
#define MODE_SETFREQLFO1 31
#define MODE_SETFREQLFO2 32
#define MODE_SETFREQLFO3 33
#define MODE_SETFREQLFO4 34
#define MODE_SETFREQLFO5 35
#define MODE_SETFREQLFO6 36
#define MODE_SETFREQLFO7 37
 
 
#define  NUM_DIGITS_FREQ 7
#define  NUM_DIGITS_FM 3 
#define  NUM_DIGITS_AM 2
#define  NUM_DIGITS_OUT 4
 
 
uint8_t  GetGPIBByte()
{
uint8_t byte; 
printf("\n Input byte  char  :   ");
scanf("%s",&byte);
//printf("\n      Send active signal  on Interrupt 3  ");
return byte; 
}
 
 
void ExecCMD(uint8_t mode)
{
 
switch (mode){
case MODE_NOCMD: 
 
              printf("\n\t\t\t\t  No CMD  or error  ");
 
 
                             break;
case MODE_TURN_OFF_OUT: 
                printf("\n\t\t\t\t  turn Off Out  "); 
                             break;
case MODE_TURN_OFF_6dB: 
                 printf("\n\t\t\t\t  TURN OFF 6dB  "); 
                             break;
 
case MODE_TURN_ON_6dB: 
                 printf("\n\t\t\t\t  TURN ON 6dB  "); 
                             break;
                             
case MODE_INT_AM: 
                 printf("\n\t\t\t\t  TURN ON INT AM  "); 
                             break;
case MODE_EXT_AM: 
                 printf("\n\t\t\t\t  TURN ON EXT AM  ");    
                             break;    
case MODE_INT_FM: 
                  printf("\n\t\t\t\t  TURN INT FM  "); 
                             break;
case MODE_EXT_FM:  
                  printf("\n\t\t\t\t  TURN EXT FM  "); 
                             break;                                                                               
 
case MODE_TURN_ON_EXT_PM:  
                  printf("\n\t\t\t\t  TURN ON EXT PM  "); 
                             break; 
case MODE_TURN_ON_INT_PM:  
                  printf("\n\t\t\t\t  TURN ON INT PM  "); 
                             break;
 case MODE_TURN_OFF_EXT_AM:  
                  printf("\n\t\t\t\t  TURN ON EXT AM  "); 
                             break;
 case MODE_TURN_OFF_INT_AM:  
                  printf("\n\t\t\t\t  TURN ON INT AM  "); 
                             break;
 case MODE_TURN_OFF_EXT_FM:  
                  printf("\n\t\t\t\t  TURN ON EXT FM  "); 
                             break;
 case MODE_TURN_OFF_INT_FM:  
                  printf("\n\t\t\t\t  TURN ON INT FM  "); 
                             break;                            
                             
 case MODE_TURN_OFF_PM:  
                  printf("\n\t\t\t\t  MODE TURN OFF PM  "); 
                             break;                                    
 case MODE_FREQ:  
                  printf("\n\t\t\t\t  MODE FREQ  "); 
                             break;  
                             
 case MODE_TURN_ON_OUT: 
                  printf("\n\t\t\t\t  TURN ON OUT  ");                   
                 break; 
                     
                             
 case MODE_TURN_ON_OUT_dB:  
                  printf("\n\t\t\t\t  TURN ON OUT dB  ");                    
                 break; 
 case MODE_TURN_ON_OUT_mV:  
                  printf("\n\t\t\t\t  TURN ON OUT mV  ");                    
                 break; 
 case MODE_TURN_ON_OUT_mkV: 
                  printf("\n\t\t\t\t  TURN ON OUT mkV  ");                   
                 break;                          
 case MODE_SETFREQLFO0: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO0  ");                      
                 break;              
                 
 case MODE_SETFREQLFO1: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO1  ");                      
                 break;              
                 
 case MODE_SETFREQLFO2: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO2  ");                      
                 break;
 case MODE_SETFREQLFO3: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO3 ");                   
                 break;              
 case MODE_SETFREQLFO4: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO4  ");                      
                 break;              
 case MODE_SETFREQLFO5: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO5  ");                      
                 break; 
 case MODE_SETFREQLFO6: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO6  ");                      
                 break; 
 case MODE_SETFREQLFO7: 
                  printf("\n\t\t\t\t  MODE_SETFREQLFO7  ");                      
                 break;                                                                  
                 
                                                                                                  
default :
 break;
 
}
 
 
return;
}
 
 
 
 
 
 
 
/*
 
    0  digits[0] = 5
    1  digits[1] = 2
    2  digits[2] = 0    CommaPos=2
           
    3  digits[3] =1  
    4  digits[4]=0     auto 0 
    5  digits[5]=0     auto 0
    6  digits[6]=0     auto 0
    7  end
 
    0  digits[0]  
    1  digits[1]   
    2  digits[2]  
    3  end
 
 2  0 digits[0]=8
 1  1 digits[1]=0
 0  2  end
 
 
 4  0 digits[0]=1
 3  1 digits[0]=0 CommaPos=1
 2  2 digits[0]=0
 1  3 digits[0]=0
 0  4  end
 
 
*/
#define  MAXCMDCHARS_GPIB 9
 uint8_t  count=0;   
 uint8_t FlagMsg=0;
 uint8_t flagLFO=0; 
 uint8_t FlagGetComma=0;
 uint8_t FlagMode=0;
 uint8_t tmpdigits[7] ;
 uint8_t tmpCommaPos=0;
 uint8_t tmpGPIBstack[MAXCMDCHARS_GPIB];  //A123.4567  
 uint8_t StackBytesCount=0;
 
 
uint8_t GetNumDigitsMode( uint8_t FlagMode)
{
if(FlagMode==MODE_FREQ) {return 7; }
if(FlagMode==MODE_INT_AM) {return 2; } 
if(FlagMode==MODE_EXT_AM) {return 2; }  
if(FlagMode==MODE_INT_FM) {return 3; }  
if(FlagMode==MODE_EXT_FM) { return 3; }  
if(FlagMode==MODE_TURN_ON_OUT_dB) { return 4; } 
if(FlagMode==MODE_TURN_ON_OUT_mV) { return 4; }      
if(FlagMode==MODE_TURN_ON_OUT_mkV) { return 4; }    
return 0;
}
 
 
 
void ParseCommaPos(uint8_t   counter, uint8_t FlagMode)
{
tmpCommaPos=counter;
 /* for evaluation only */ 
printf ( "\n\t\t\t\t comma posistion in %d digit     ",   counter  );   
    
return; 
}
 
void PutDigitToGPIBStackIfByte(uint8_t count, uint8_t  byte,   uint8_t FlagMode  )
{
tmpdigits[count]=byte-0x30;  
/* for evaluation only */ 
printf ( "\n\t\t\t\t %d digit is %d   ",   count , tmpdigits[count ]  );
}
 
 
void SetLastDigitsZero(uint8_t FlagMode, uint8_t count ,uint8_t NumDigMode )
{ 
if(NumDigMode !=0) { for (uint8_t i=count;i<=6; i++)    {  tmpdigits[i]=0; } }  
 
/* for evaluation only */ 
for (uint8_t i=0;i<NumDigMode; i++) { printf("\n%d", tmpdigits[i] );   if(i==tmpCommaPos) { printf(" <comma>");}
}    
return ;    
}
 
 
 
 
 
 
 
uint8_t  CheckEndCmdGPIB ()
{
 
 
uint8_t byte=GetGPIBByte ();  //gets  TTL code from inverse code for LD bus  bits 
 
 
/* 'space' */
 if (byte==0x20)  {   return 0;   }
 
/*  ','  end of command */                 
 if (byte==0x2c) {  return 1;    } 
/*  '.'  */ 
 if (byte==0x2e) { goto  LabelPushToStackGPIB; }
/*  '0'...'9' , 0x22, A,B,C,D,E,F, H,I,K,L,M,N,O   */ 
 if ((byte>=0x30)&&(byte<=0x39)) { goto  LabelPushToStackGPIB;    }
 
 if ( (byte==0x22)||(byte==0x49) || (byte==0x48) || ((byte>=0x41)&&(byte<=0x46)) ||((byte>=0x4B) &&(byte<=0x4F)))   
{  goto  LabelPushToStackGPIB; }
 
 
 return 0; 
 
LabelPushToStackGPIB:
 
if (StackBytesCount>=(uint8_t) MAXCMDCHARS_GPIB )  {   return 0; }  /*  if  "stack"   overflow    */
tmpGPIBstack[StackBytesCount]=byte;
//printf("\n Push byte into  stack  %c, %d  ",tmpGPIBstack[StackBytesCount], StackBytesCount  );
 
StackBytesCount+=1; 
 return 0; 
}
 
 
uint8_t OnNewByteIfAtnHigh()
{
uint8_t byte1= CheckEndCmdGPIB ();
//SendDataAcceptedStrobe();  //fix
return byte1;
}
 
/* ***************************** */
 
void CheckGPIBStackChars( uint8_t byte )
{
 
 
/*  '.'  */
if (byte==0x2e) { if((FlagMsg==1)&&(FlagGetComma==1) ) { 
FlagGetComma=0;
printf("count= %d ",count );
if(count==0) { tmpdigits[0]=0; tmpCommaPos=0;  count=1;  } else { tmpCommaPos=( count-1);  }
return  ;  
} 
FlagGetComma=0;
return;              
}
                
 
  /* '0'...'9' */
if ((byte>=0x30)&&(byte<=0x39)) 
{
 
 if (FlagMode==MODE_PREPSETFREQLFO)  
  {
  FlagMsg=0;
  if (FlagMode==0x30) {    FlagMode= MODE_SETFREQLFO0;  return; }
  if (FlagMode==0x31) {    FlagMode= MODE_SETFREQLFO1;  return;  }
  if (FlagMode==0x32) {    FlagMode= MODE_SETFREQLFO2;  return;  }
  if (FlagMode==0x33) {    FlagMode= MODE_SETFREQLFO3;  return;  }
  if (FlagMode==0x34) {    FlagMode= MODE_SETFREQLFO4;  return;  }
  if (FlagMode==0x35) {    FlagMode= MODE_SETFREQLFO5;  return;  }
  if (FlagMode==0x36) {    FlagMode= MODE_SETFREQLFO6;  return;  }
  if (FlagMode==0x37) {    FlagMode= MODE_SETFREQLFO7;  return;  }
  FlagMode= MODE_NOCMD;   
  return;
}
 
 
if (FlagMode==MODE_TURN_ON_OUT) { FlagMode= MODE_TURN_ON_OUT_dB;   } 
if ((count+1)>GetNumDigitsMode(FlagMode)  )  { FlagMsg=0;   return; } //fix
if (FlagMsg==1){ if (FlagGetComma==1) { tmpCommaPos=count;}  tmpdigits[(count)]=(uint8_t)( byte-0x30) ;  count+=1;  return;   }
 
return; 
}
 
 /* I   turn off output */
if(byte==0x49) { FlagMsg=0 ;      FlagMode=MODE_TURN_OFF_OUT;  return;}                 
 
/* H  6 dB off        */     
if(byte==0x48){ FlagMsg=0 ;     FlagMode=MODE_TURN_OFF_6dB;  return; }
/* O   turn on 6 dB  */
if(byte==0x4F){ FlagMsg=0 ;    FlagMode=MODE_TURN_ON_6dB;  return; }    
/* D   PM on ; off for ND  */
if(byte==0x44){   FlagMsg=0 ;   
if( FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_TURN_ON_EXT_PM; } else { FlagMode=MODE_TURN_ON_INT_PM; }
 return; }
 
/* E  PM off, end for BE,CE */
if(byte==0x45){   FlagMsg=0 ;   tmpCommaPos=0;
 if(FlagMode==MODE_EXT_AM) {   FlagMode=MODE_TURN_OFF_EXT_AM; }
 if(FlagMode==MODE_EXT_FM) {   FlagMode=MODE_TURN_OFF_EXT_FM; }
 if(FlagMode==MODE_INT_AM) {   FlagMode=MODE_TURN_OFF_INT_AM; }
 if(FlagMode==MODE_INT_FM) {   FlagMode=MODE_TURN_OFF_INT_FM; } 
 else  {   FlagMode=MODE_TURN_OFF_PM; }             
 return;  }
/* A      freq  , for example "A520.100,B80." or "A520.100," <=7 digits + comma */
if(byte==0x41) { FlagGetComma=1; FlagMsg=1 ;  count=0;  FlagMode=MODE_FREQ;   return; }
/* N , for example "NB,","NB20,",  "NС,","ND" ,"NC100,"  */
if(byte==0x4e){ FlagGetComma=1; FlagMsg=1 ; FlagMode=MODE_PREP_EXT_MOD; return;  }              
 
/* B    end of  NB, NC,    begin of BE        AM,% for example  "B80." or "B80," , <=2 digits */
if(byte==0x42){ FlagMsg=1 ; FlagGetComma=1; count =0;
if (FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_EXT_AM ; }  else  {  FlagMode=MODE_INT_AM ;  } 
return;  }
/* C    end of  NB, NC,    begin of CE         , FM, kHz , <=3  digits  */  
if(byte==0x43){ count=0; FlagGetComma=1;  FlagMsg=1 ;    
if ( FlagMode==MODE_PREP_EXT_MOD) { FlagMode=MODE_EXT_FM; } else {FlagMode=MODE_INT_FM ;} 
return;  }
 
/*  K   turn on output , if  only K , turn on output */ 
if(byte==0x4B){ FlagGetComma=1; FlagMsg=1 ;   count=0; FlagMode=MODE_TURN_ON_OUT ; return; }
 /* L           output, mV, <=3.5 digits + comma */
if((byte==0x4C)||(byte==0x22)){  FlagGetComma=1;  FlagMsg=1 ; count=0; FlagMode=MODE_TURN_ON_OUT_mV; return; }
/* M  , for example,"M10.00,"  */               
if(byte==0x4D){ FlagGetComma=1; FlagMsg=1 ; count=0;   FlagMode=MODE_TURN_ON_OUT_mkV;     return; }
 /* F   Finternal ,for example "F1,"  */
if(byte==0x46){  FlagGetComma=0; FlagMsg=1; count=0;    FlagMode=MODE_PREPSETFREQLFO;     return; }
 
//FlagGetComma=0; FlagMsg=0 ;   count=0;  FlagMode=MODE_NOCMD; ExecCMD(FlagMode);    //fix
 
return ;    
}
 
void ParseCommand1()
{
    //for (uint8_t i=0;i<9; i++) { printf("\n char= =%c", tmpGPIBstack[i] );        } 
    
    
 /* after  ','  end of command */
  count=0;   FlagMsg= 0; FlagMode=MODE_NOCMD; tmpCommaPos=0;
 for(uint8_t i=0; i< StackBytesCount; i++) { printf("\nstack char= %c", tmpGPIBstack[i] );  CheckGPIBStackChars( tmpGPIBstack[i]) ; } 
 
 
 SetLastDigitsZero(FlagMode, count, GetNumDigitsMode(FlagMode));
 
 ExecCMD(FlagMode  );
  for (uint8_t i=0;i<7; i++) { printf("\n%d", tmpdigits[i] );   if(i==tmpCommaPos) { printf(" <comma>");} }      
 
 count=0;   FlagMsg= 0; FlagMode=MODE_NOCMD;  
 
 
 return;              
} 
 
 
/* *********************************** */
int main()
{
 
label1:
printf("\n Input command  bytes (  A520.1, B80, F1, M10.2 ,  ) ");  //fix 0x2e problem for end of message 
//printf("\n Input command  bytes \n(  0x41 0x35 0x32 0x30  0x2e 0x31 0x2c"); 
 
while (!OnNewByteIfAtnHigh()) { ; }     //A 0x41 //5 0x35 //2 0x32  //0 0x30 //.0x2e //1 0x31 //, 0x2c
 
ParseCommand1();
 
//printf("\n Input command   0x20 0x42 0x38 0x30 0x2c 0x20 0x46 0x31 0x2c 0x20 0x4D 0x31 0x35 0x2e 0x20 0x2c ) ");  //fix 0x2e problem for end of message 
 
printf ("\n Inpuit 1 for exit or 0 for next command ");
int key;
scanf("%d",&key);
if (key==0) {goto label1; }
 
 
 
}

uint32_t GetFreqFromDigits( uint8_t freq1)
{
uint32_t result  =(uint32_t )freq1[6];
for(uint8_t i=0; i<freq1[5]; i++) {   result +=10;  }
for(uint8_t i=0; i<freq1[4]; i++) {   result +=100;  }
for(uint8_t i=0; i<freq1[3]; i++) {   result +=1000;  }
for(uint8_t i=0; i<freq1[2]; i++) {   result +=10000;  }
for(uint8_t i=0; i<freq1[1]; i++) {   result +=100000;  }
for(uint8_t i=0; i<freq1[0]; i++) {   result +=1000000;  }
 
}
 
 
void NormalizeFreqkHz( )
{
 for (uint8_t i=count; i<=6; i++)   {  tmpdigits[i]=0; }  
uint32_t ftmp=GetFreqFromDigits( tmpdigits);
if((ftmp>=6400000) &&if(ftmp<=1000)){ return ; }
if  (ftmp>=1600000) { tmpdigits[6]=0; }
tmpcommapos-=3;
 
 
 
}

if((Flag[3]&MASK_FLAG_MODE)!=0)  { SendMode(); SelectFlag( FLAG___MODE); return; }
if((Flag[3]&MASK_FLAG_STATICCMD)!=0)  { SendStaticCommands(); SelectFlag( FLAG____STATICCMD); return; }

#define TOKEN_F 0
#define TOKEN_FM 1
#define TOKEN_AM 2
#define TOKEN_PM 3
#define TOKEN_MOD_OFF 4
#define TOKEN_OUT 5
 
  //LabelPoint8:
void ParseKeyb()
{
//;        8_1  
 printf("\ncall ParseKeyb ");
uint8_t scancode;
GetScanCodeValue() ;
 
 
uint8_t byte1;
scanf("%x",&byte1);
printf("\n ********* ");
printf ("\n0x%.02x\n", (int)byte1);
 
 scancode=(uint8_t)byte1;
 
 
 scancode =( scancode&BITMASK_KEYBOARD);
 printf ("\nKeyb Byte    = 0x%.02x  **\n",scancode);
 
//if(CheckButtonsNumericKeypad( scancode )==0x01) {    return; } 
 
if( scancode == (uint8_t)BUTTON_F ) {  printf(" freq  ");  SetDutyReg(TOKEN_F);  return ;}   //  turn on blink in f , wait digits or  encoder  int or GPIB events 
if( scancode == (uint8_t)BUTTON_FM ) {  printf(" fm  "); TurnOnFM (); SetDutyReg(TOKEN_FM);  return ; }  //  turn on blink in FM , wait digits or  encoder  int or GPIB events
if( scancode == (uint8_t)BUTTON_AM ) { TurnOnAM(); SetDutyReg(TOKEN_AM);  return ;     } //  turn on blink in AM , wait digits or  encoder  int or GPIB events
if( scancode == (uint8_t)BUTTON_PM  ) { TurnOnPM(); SetDutyReg(TOKEN_PM);  return ;  } //  turn on int or exf PM, wait off 
if( scancode == (uint8_t)BUTTON_MOD_OFF ) { TurnOffModulation(); SetDutyReg(TOKEN_MOD_OFF);  return ; }
if( scancode == (uint8_t)BUTTON_EXT  )  { PrepareExtModulation () ; return; }    /* 9*/  
if( scancode == (uint8_t)BUTTON_STEP) ) { StepModeOn(); return; }
 
if( scancode ==(uint8_t) BUTTON_OUT  ) { printf(" out ");    OutputOn(); SetDutyReg(TOKEN_OUT); return; } //  turn on blink in Out , wait digits or  encoder  int or GPIB events 
if( scancode==(uint8_t) BUTTON_OUT_OFF ) { OutputOnOff();  return; }
if( scancode==(uint8_t)BUTTON_LFO ) { ChangeLFONum(); return; }
if( scancode==(uint8_t)BUTTON_SHARP ) { SetMemWrMode(); return;  }
if( scancode==(uint8_t)BUTTON_RECALL ) { SetMemRecallMode(); return; }
if( scancode==(uint8_t)BUTTON_MHz ) { NormalizeFreq(); return; }//;  10   
if( scancode==(uint8_t)BUTTON_kHz ) { if (CheckStepModeOn()!=0){ NormalizeStep();  return; } else { NormalizeFM();  return;}  }//;  macro,  13_2 or to 1 
if( scancode==(uint8_t)BUTTON_PERCENT ) { NormalizeAMCoef(); return; }  //;   14_2   
if( scancode==(uint8_t)BUTTON_mV ) { SetOutInputMode(TOKEN_Out_mV);  return;} //;   15_2  
if( scancode==(uint8_t)BUTTON_mkV ) {SetOutInputMode( TOKEN_Out_mkV );  return;}//;   15_2 
if( scancode==(uint8_t)BUTTON_dBV ) { SetOutInputMode(TOKEN_Out_dB);  return;} //;   15_2  
if( scancode==(uint8_t) BUTTON_6dB ) { if (CheckModeAM==0)    { TurnOn6dB(); }  return; }//;   11  
//CaseDefault: 
if(StepMode==1) { ChangeFreqOneStep() ;   NormalizeFreq(); return; }   ;//  12_3,   
ChangeStepParam();  
 
 
 
 
  return ; //to point1             
}

//#include < avr/io.h >
//#include <util/delay.h>
//#include <avr/interrupt.h>
//#include <avr/pgmspace.h>
 
#include <stdio.h>
#include <stdint.h>
#include <math.h>
 
void  SendStaticCommands(){ 
printf("\nSend static commands : %.02x " , (int)CurrentState.StaticCMDbits   ) ;  
 
}
void  SendLFOCodes(){ 
printf("\nSend LFO codes : LFO_num=%d ",   (int)CurrentState.LFO_num  ) ;
/*      */
}
 
 
void  SendFMCodes(){
 printf("\nSend FM codes : DAC =%x  FM_DAC_LFO =%x " ,  (int)DACFM,  FM_DAC_LFO) ;
 
}  
 
void  SendAMCodes(){
 printf("\nSend AM codes : DACVref=%d, DACAM=%d ", (int)DACVref ,  (int)  DACAM   ) ;
 
} 
 
 
void  SendAttCodes(){
 printf("\nSend Att codes : %.02x ",  (int)Attcode ) ;
 
} 
 
 
void  SendHFOCodes(){
 printf("\nSend HFO codes : OscCode=%.02x   AttCorFM=%02x " ,  (int)Osc_Code, (int)AttCorFM) ;
 
 } 
 
 
void  SendDVDCCodes(){
 printf("\nSend DVDC codes : %d %d %d  %d %d %d " ,(int) DVDCdigits[0],(int)DVDCdigits[1],(int)DVDCdigits[2],(int)DVDCdigits[3] ,(int)DVDCdigits[4],(int)DVDCdigits[5] ) ;
 
}