void USART1_IRQHandler(void)
{
  /* RXNE handler */
  if ((USART1->SR & USART_IT_RXNE) != RESET) // Received character?
  {
    /* Copy data into RX Buffer */
    uint8_t chr = (USART1->DR & (uint16_t)0x01FF);
    if (chr=='\r')  //0xD,0xA
    {
      usart1_rx_buf[usart1_rx_idx] = '\0';
      usart1_rx_idx = 0;
      usart1_rx_ready = 1;
    }
    else
    {
        if(chr=='\b')
        {
            if (usart1_rx_idx > 0)
                usart1_rx_idx--;
            return;
        }
        if(usart1_rx_idx < RX1_BUFFERSIZE)  //no overflow
        {
                usart1_rx_buf[usart1_rx_idx] = chr;
                usart1_rx_idx++;
        }
        else
            usart1_rx_overflow = 1;
    }
        /* Clear RXDATAV interrupt */
        //USART_IntClear(UART0, UART_IF_RXDATAV);
        USART1->SR = (uint16_t)~USART_FLAG_RXNE;
  }
}

uint32_t PARSER_ParseInputString(char* str, char** args)
{
    uint32_t argc=0;

    args[argc] = strtok(str, ARGS_DELIM);

    while (args[argc] != NULL)
    {
        if(argc >= ARGS_MAX)
           return (ARGS_MAX+1);
        args[++argc] = strtok (NULL, ARGS_DELIM);
    }

    return argc;
}

uint32_t PARSER_ParseCommand(char *str)
{
     uint32_t len = strlen(str);
     char temp_str[len];
     strcpy (temp_str, str);
     uint32_t argc = PARSER_ParseInputString(temp_str, args);
    
    if (!argc)
      return ST_PARSE_NO_ARGS;
    
    uint32_t arg_count = (argc - 1);
    uint32_t i;
    uint32_t result;
    
    char *com = ToLower(args[0]);
    
    for (i = 0; i < sizeof(commands); i++)
    {
        //command found
        if (com_found)
            break;
        
        if (strcmp(commands[i].name,com)==0)
        {
            com_found = 1;
            
            if (arg_count < commands[i].minargs)
                return ST_PARSE_WRONG_ARGS;
            if (arg_count > commands[i].maxargs)
                return ST_PARSE_WRONG_ARGS;
            
            result = commands[i].fp(arg_count, args);
            
            switch (result)
            {
                case MSG_OK:
                    Parser_SendString(USART2, msg_ok, print_out);
                break;
                case MSG_INV_INP:
                    Parser_SendString(USART2, msg_invinp, print_out);
                break;
                case MSG_INV_ARG:
                    Parser_SendString(USART2, msg_invarg, print_out);
                break;
                case MSG_MIS_ARG:
                    Parser_SendString(USART2, msg_misarg, print_out);
                break;
            }
        }
    }
    
    if (com_found)
        com_found = 0;
    else
    {
        Parser_SendString(USART2, msg_wrncom, print_out);
        return ST_PARSE_WRONG_COM;
    }
    
    return ST_PARSE_OK;    
}

package parser_pkg is
    --! maximum length of data packet
    constant MAX_DATA_LEN       : integer := 54;
    -- Serial communication constants
    --! message is from command interface
    constant SER_COM_CMD_INTF_TYPE : std_logic_vector(7 downto 0) := X"55";
    -- ... куча других констант

    --! command data structure
    type cmd_t is record
        --! message command
        cmd         : std_logic_vector(15 downto 0);
        --! message type
        msg_type    : bc_msg_type_t;
        --! interface
        intf_type    : bc_intf_type_t;        
        --! message length
        msg_len     : integer range 0 to MAX_DATA_LEN;
        --! answer code
        answer      : std_logic_vector(15 downto 0);
        --! answer length
        answer_len : integer range 0 to MAX_DATA_LEN;
        --! target host FPGA (Master / Slave)
        target_host: target_host_t;
    end record cmd_t;

    constant CMD_MIO_DUMMY : std_logic_vector(15 downto 0)          := X"0000"; --! dummy command to reset interface

    type cmd_arr is array(integer range <>) of cmd_t;

    -- List of all supported commands with length (in bytes) and category
    constant BC_CMD_CMD_LIST : bc_cmd_arr := (
        (CMD_MIO_DUMMY, MIO, CMD_INTF,0,EC_OK,0,BOTH),
        (CMD_MIO_GETNBTIMMEAS, MIO, CMD_INTF,0,EC_OK,2,SINGLE),
        (CMD_MIO_GETSTATUS, MIO, CMD_INTF,0,EC_OK,2,SINGLE),
        (CMD_MIO_GETLKDMODINF, MIO, CMD_INTF,4,EC_OK,12,SINGLE),    
        (CMD_MIO_GETNBLKDMOD, MIO, CMD_INTF,0,EC_OK,2,SINGLE),
        (CMD_MIO_STOREUID, MIO, CMD_INTF,6,EC_OK,0,BOTH),
        (CMD_MIO_GETUID,MIO, CMD_INTF,0,EC_OK,6,SINGLE),
        (CMD_MIO_GETVERSION,MIO, CMD_INTF,0,EC_OK,8,SINGLE),
        (CMD_MIO_GETERRORCODE,MIO, CMD_INTF,0,EC_OK,4,SINGLE),
        (CMD_MIO_GETHWINF,MIO, CMD_INTF,0,EC_OK,52,BOTH),
        (CMD_MIO_DECLAREMASTER,SCO,CMD_INTF,16,EC_OK,12,BOTH),
        (CMD_MIO_STARTSAFECOM,SCO,CMD_INTF,0,EC_OK,0,BOTH),
        (CMD_MIO_TAKECFGDATA,SCO,CMD_INTF,24,EC_OK,0,BOTH),
        (CMD_MIO_STORECFGDATA,SCO,CMD_INTF,0,EC_OK,0,BOTH)
    );

    -- Function declaration
    --! @details    Get command message properties
    --!
    --! InP:        Command  
    --! OutP:       message properties
    function get_bc_cmd_cmd (cmd : std_logic_vector(15 downto 0)) return cmd_t;
end package parser_pkg;