static int copy_body(void)
{
int sawcr = 0; /* Was the last character a CR */
unsigned linepos = 0; /* The number of bytes since the last LF */
int sawperiod = 0; /* True if the first character was a period */
char ch;
data_start();
while (ibuf_getc(&inbuf, &ch)) {
switch (ch) {
case LF:
if (sawperiod && linepos == 0) { message_end(); return 1; }
data_byte(ch);
sawperiod = sawcr = linepos = 0;
break;
case CR:
if (sawcr) { data_byte(CR); ++linepos; }
sawcr = 1;
break;
default:
if (ch == PERIOD && !sawperiod && linepos == 0)
sawperiod = 1;
else {
sawperiod = 0;
if (sawcr) { data_byte(CR); ++linepos; sawcr = 0; }
data_byte(ch); ++linepos;
}
}
}
return 0;
}
void SpiGui::read_spi(void)
{
int ret = 0, i = 0;
unsigned long chipsize = 262144;
QString qmsg_start = QString("Reading SPI Chip...");
QString qmsg_fail = QString("Reading SPI Chip...Failed");
QString qmsg_success = QString("Reading SPI Chip...Success!");
QByteArray data_byte("\x03\x00\x00\x00");
QByteArray read_cmd, read_resp;
QCoreApplication::sendEvent(parent->parent, new BPStatusMsgEvent(qmsg_start));
postMsgEvent("JEDEC READ");
if (!parent->bp->serial->isOpen())
goto err;
ret = parent->bp->enter_mode_spi();
if (ret)
{
postMsgEvent("SPI OK.");
} else {
postMsgEvent("SPI Failed.");
goto err;
}
ret = parent->bp->bbio_peripherial_set(0x0B);
if (ret)
{
postMsgEvent("Peripherial Config Ok.");
} else {
postMsgEvent("Peripherial Config Failed.");
goto err;
}
ret = parent->bp->bbio_speed_set(0x06);
if (ret)
{
postMsgEvent("SPI Speed Config Ok.");
} else {
postMsgEvent("SPI Speed Config Failed.");
goto err;
}
ret = parent->bp->spi_configure_set(0x08);
if (ret)
{
postMsgEvent("SPI Config Ok.");
} else {
postMsgEvent("SPI Config Failed.");
goto err;
}
ret = parent->bp->spi_cs_low();
if (ret)
{
postMsgEvent("CS Low: Ok.");
} else {
postMsgEvent("CS Low: Failed.");
}
//for (i = 0; i <chipsize; i+=16)
//{
read_cmd = parent->bp->bbio_bulk_trans(data_byte, 4);
if (read_cmd.contains("\x01"))
{
postMsgEvent("Reading...");
} else {
postMsgEvent("Reading...Failed!");
}
for (i=0; i<chipsize; i+=16)
{
QByteArray ba;
ba.resize(16);
read_resp = parent->bp->bbio_bulk_trans(ba, 16);
if (read_resp.contains("\x01"))
{
for (i=0; i<16; i++) postMsgEvent(QString("0x%1 ").arg((QString)read_resp.mid(i,1).toHex()).toAscii());
} else {
postMsgEvent("Reading...Failed!");
}
}
ret = parent->bp->spi_cs_high();
if (ret)
{
postMsgEvent("CS High: Ok.");
} else {
postMsgEvent("CS High: Failed.");
}
ret = parent->bp->reset_bbio();
if (ret)
{
postMsgEvent("Reset to BBIO mode: Ok.");
} else {
postMsgEvent("Reset to BBIO mode: Failed.");
}
QCoreApplication::sendEvent(parent->parent, new BPStatusMsgEvent(qmsg_success));
return;
err:
QCoreApplication::sendEvent(parent->parent, new BPStatusMsgEvent(qmsg_fail));
}
void SpiGui::spi_chip_id(void)
{
QString qmsg_start = QString("Getting SPI Chip Id...");
QString qmsg_fail = QString("Getting SPI Chip Id...Failed");
QString qmsg_success = QString("Getting SPI Chip Id...Success!");
QByteArray data_byte("\x9F\x00\x00\x00");
QByteArray chip_id;
int ret = 0, i = 0;
QCoreApplication::sendEvent(parent->parent, new BPStatusMsgEvent(qmsg_start));
postMsgEvent("JEDEC RDID");
if (!parent->bp->serial->isOpen())
goto err;
ret = parent->bp->enter_mode_spi();
if (ret)
{
postMsgEvent("SPI OK.");
} else {
postMsgEvent("SPI Failed.");
goto err;
}
ret = parent->bp->bbio_peripherial_set(0x0B);
if (ret)
{
postMsgEvent("Peripherial Config Ok.");
} else {
postMsgEvent("Peripherial Config Failed.");
goto err;
}
ret = parent->bp->bbio_speed_set(0x06);
if (ret)
{
postMsgEvent("SPI Speed Config Ok.");
} else {
postMsgEvent("SPI Speed Config Failed.");
goto err;
}
ret = parent->bp->spi_configure_set(0x08);
if (ret)
{
postMsgEvent("SPI Config Ok.");
} else {
postMsgEvent("SPI Config Failed.");
goto err;
}
ret = parent->bp->spi_cs_low();
if (ret)
{
postMsgEvent("CS Low: Ok.");
} else {
postMsgEvent("CS Low: Failed.");
}
chip_id = parent->bp->bbio_bulk_trans(data_byte, 4);
if (chip_id.contains("\x01"))
{
postMsgEvent("ChipID:");
for (i = 0; i < chip_id.size(); ++i) postMsgEvent(QString("0x%1 ").arg((QString)chip_id.mid(i,1).toHex()).toAscii());
} else {
postMsgEvent("ChipID: Failed!");
}
ret = parent->bp->spi_cs_high();
if (ret)
{
postMsgEvent("CS High: Ok.");
} else {
postMsgEvent("CS High: Failed.");
}
ret = parent->bp->reset_bbio();
if (ret)
{
postMsgEvent("Reset to BBIO mode: Ok.");
} else {
postMsgEvent("Reset to BBIO mode: Failed.");
}
QCoreApplication::sendEvent(parent->parent, new BPStatusMsgEvent(qmsg_success));
return;
err:
QCoreApplication::sendEvent(parent->parent, new BPStatusMsgEvent(qmsg_fail));
}
