bool BootloaderInterface::readPageSimple(unsigned pageNumber, uint8_t * data)
{
BootloaderReadPage message;
message.dest = dest;
message.pageNumber = pageNumber;
message.serialize(stream);
stream->flush();
stream->read(data, 2048);
return true;
}
bool BootloaderInterface::readPage(unsigned pageNumber, uint8* data)
{
if ((pageNumber < pagesStart) || (pageNumber >= pagesStart + pagesCount))
{
throw Error(FormatableString("Error, page index %0 out of page range [%1:%2]").arg(pageNumber).arg(pagesStart).arg(pagesStart+pagesCount));
}
// send command
BootloaderReadPage message;
message.dest = dest;
message.pageNumber = pageNumber;
message.serialize(stream);
stream->flush();
unsigned dataRead = 0;
// get data
while (true)
{
auto_ptr<Message> message(Message::receive(stream));
// handle ack
BootloaderAck *ackMessage = dynamic_cast<BootloaderAck *>(message.get());
if (ackMessage && (ackMessage->source == dest))
{
uint16 errorCode = ackMessage->errorCode;
if (errorCode == BootloaderAck::SUCCESS)
{
if (dataRead < pageSize)
cerr << "Warning, got acknowledgement but page not fully read (" << dataRead << "/" << pageSize << ") bytes.\n";
return true;
}
else
return false;
}
// handle data
BootloaderDataRead *dataMessage = dynamic_cast<BootloaderDataRead *>(message.get());
if (dataMessage && (dataMessage->source == dest))
{
if (dataRead >= pageSize)
cerr << "Warning, reading oversized page (" << dataRead << "/" << pageSize << ") bytes.\n";
copy(dataMessage->data, dataMessage->data + sizeof(dataMessage->data), data);
data += sizeof(dataMessage->data);
dataRead += sizeof(dataMessage->data);
cout << "Page read so far (" << dataRead << "/" << pageSize << ") bytes.\n";
}
}
return true;
}
