|
|
@ -37,7 +37,7 @@ void parsePacket(const packet_t& newPacket)
|
|
|
|
packetParts packetIndex = Head;
|
|
|
|
packetParts packetIndex = Head;
|
|
|
|
ui8_t i = 0;
|
|
|
|
ui8_t i = 0;
|
|
|
|
|
|
|
|
|
|
|
|
do {
|
|
|
|
//do {
|
|
|
|
switch(packetIndex) {
|
|
|
|
switch(packetIndex) {
|
|
|
|
case Head:
|
|
|
|
case Head:
|
|
|
|
std::cout << "checking packet head..." << std::endl;
|
|
|
|
std::cout << "checking packet head..." << std::endl;
|
|
|
@ -49,8 +49,8 @@ void parsePacket(const packet_t& newPacket)
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
std::cout << "...head valid!" << std::endl;
|
|
|
|
std::cout << "...head valid!" << std::endl;
|
|
|
|
packetIndex = Payload;
|
|
|
|
//packetIndex = Payload;
|
|
|
|
break;
|
|
|
|
//break;
|
|
|
|
case Payload:
|
|
|
|
case Payload:
|
|
|
|
// copy payload
|
|
|
|
// copy payload
|
|
|
|
std::cout << "copy payload..." << std::endl;
|
|
|
|
std::cout << "copy payload..." << std::endl;
|
|
|
@ -58,8 +58,8 @@ void parsePacket(const packet_t& newPacket)
|
|
|
|
payload[i - 2] = newPacket[i];
|
|
|
|
payload[i - 2] = newPacket[i];
|
|
|
|
}
|
|
|
|
}
|
|
|
|
std::cout << "...done!" << std::endl;
|
|
|
|
std::cout << "...done!" << std::endl;
|
|
|
|
packetIndex = Tail;
|
|
|
|
//packetIndex = Tail;
|
|
|
|
break;
|
|
|
|
//break;
|
|
|
|
case Tail:
|
|
|
|
case Tail:
|
|
|
|
// check tail
|
|
|
|
// check tail
|
|
|
|
std::cout << "checking packet tail..." << std::endl;
|
|
|
|
std::cout << "checking packet tail..." << std::endl;
|
|
|
@ -77,7 +77,7 @@ void parsePacket(const packet_t& newPacket)
|
|
|
|
default:
|
|
|
|
default:
|
|
|
|
return;
|
|
|
|
return;
|
|
|
|
};
|
|
|
|
};
|
|
|
|
} while(!done);
|
|
|
|
//} while(!done);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|