Как писать парсер строки под дуино?

  //с 12 по 17 байт - номер входящий, 19й - кодировка, 27й - размер текста в байтах, с 28го и до конца - текст сообщения
  //  1й   2й              9й  10й  11й 12й       17й  18й  19й                   27й   28й
  //  07   91 9732520180F1 24  0B   91  9731128885F3   00   00   61303281232242   04    D4F29C0E
  
  inputSms.incomingNumberPdu = lineFullStr.substring(22 + shiftInd, 34 + shiftInd); //Выдернули номер в режиме PDU - его надо еще перевести в нормальный формат

struct TLVHEADER
{
    uint8_t dataType;
    uint8_t dataSize;
    char *data;
};
 
// setup() { ...
TLVHEADER tlvHeader = { 1, 14, F("Hello, world!") };    // 14й символ в строке = NULL (Невидим в коде)

#define DATA_FCITMP 0x6f
#define DATA_DFNAME 0x84
#define DATA_FCIPTMP    0xa5

enum DATA_VALUES {
    TMP_FCI = 0x00,
    TMP_FCIP    = 0x01,
    DF_NAME = 0x02,
    FIRST   = 0xAA,
    SECOND  = 0xBB,
    THIRD   = 0xCC,
};

uint8_t PROGMEM valuesArray[sizeof(DATA_VALUES )];
 
for (uint8_t i = 0; i < sizeof(DATA_VALUES ); i++)
{
    valuesArray[i] = static_cast<DATA_VALUES >(i);
}

int main(void)
{
    enum DATA
    {
        FIRST =     0x6F,   // == 0x006F
        SECOND =    0xBFCD,
        THIRD =     0xE     // == 0x000E
    };
 
    // Размер массива писать не нужно, если переменные в нем задаются явно
    int array[] = { FIRST, SECOND, THIRD }; // Имена заменятся на значения компилятором.
 
    // sizeof(array / sizeof(int) == 3, поскольку:
    // sizeof(array) = 6 (3 значения по 2 байта)
    // sizeof(int) = 2 (байта). Это если Ардуина. Редко, но бывает и 4 (32 бит). Зависит от компилятора.
    // т.к. считаем от нуля - то [i < array_size] правильно. при array_size = 3
    // А вот если от 1 считать, то надо заменить на [i <= array_size]
 
    for (uint8_t i = 0; i < sizeof(array) / sizeof(int); i++)
    {
        switch (array[i])
        {
            case FIRST:  puts("0xAA First"); break;
            case SECOND: puts("0xBFCD Second"); break;
            case THIRD:  puts("0xCC Third"); break;
        }
    }
}