Прием данных из последовательного порта, Некая смесь Си для AVR и QT Опции

[x-8973]

Вечер добрый всем здешним обитателям!
Проблема моя затрагивает программирование для микроконтроллеров, но на решение данный факт, я надеюсь, никак не влияет. Итак:
Есть последовательный порт на микроконтроллере. Имеется прерывание, которое генерируется при приеме портом байта данных. Есть возможность получить этот байт. Нужно принять пакет данных, который состоит из нескольких байт (длина пакета может быть разной).
Пакет представляет из себя заголовок (признак начала 0xAEAE, идентификатор пакета, длина пакета) длиной 4 байта, и собственно данные.
Примерный алгоритм я себе представляю так:
-принимать данные, пока длина буфера в массиве char не станет равна 4.
-поискать в буфере признак начала пакета
-если признак найден, выбросить байты, что слева от него, иначе очистить буфер и выйти из прерывания
-если длина пакета принята, то прочитать ее и принимать данные, пока не наберется нужное количество байт, иначе принимать данные, пока не будет принята длина пакета
-если принято нужное количество байт, то передать буфер на обработку.

Для ПК я этот алгоритм реализовал с использованием классов QT, в частности, QByteArray. А вот для МК ничего придумать не могу. Натыкаюсь на то, что массив char есть именно массив. А QByteArray - класс, имеющий методы для поиска, "обрезки" и прочих насущных дел.
Может быть, кто поможет мне в этом деле? Код QT прилагаю.

void Widget::SlotDataRead()
{
    int bytes = port->bytesAvailable();
    dataBuffer.append(port->read(bytes));
    quint16 startSeq = 0xAEAE;
    int startPos = dataBuffer.indexOf(QByteArray((char*)&startSeq));
    if (startPos > -1)
    {
        dataBuffer = dataBuffer.remove(0, startPos);
        if (startPos+3 <= dataBuffer.count())
        {
            dataPacketLength = dataBuffer.at(startPos+3);
            if (dataBuffer.count() >= dataPacketLength)
            {
                receivedDataProc(dataBuffer.left(dataPacketLength));
                dataBuffer = dataBuffer.remove(dataPacketLength);
            }
        }
    }
    else
        dataBuffer.clear();
}