Just some source code style cleanup.

This commit is contained in:
Oliver Schmidt 2018-02-04 20:57:30 +01:00
parent b958c660a9
commit e281c0061b

View File

@ -50,10 +50,10 @@ crc_xmodem(char *ptr, unsigned count)
int main(int argc, char *argv[])
{
// Process the command line arguments
bool bVerbose = false;
bool bLog = true;
char *apFilename[2] = {0, 0};
for (int iArg = 1; iArg < argc; iArg++)
{
if (argv[iArg][0] == '-')
@ -102,6 +102,7 @@ int main(int argc, char *argv[])
return EXIT_FAILURE;
}
// Memory-map the disk image file(s)
char *apFileData[2] = {0, 0};
for (int iDrive = 0; iDrive < 2; iDrive++)
{
@ -131,29 +132,26 @@ int main(int argc, char *argv[])
}
}
enum sp_return eResult;
// Create a configuration for the serial ports
struct sp_port_config *pSerialConfig=0;
{
eResult = sp_new_config(&pSerialConfig);
assert(eResult == SP_OK);
eResult = sp_set_config_baudrate(pSerialConfig, 230400);
assert(eResult == SP_OK);
eResult = sp_set_config_bits(pSerialConfig, 8);
assert(eResult == SP_OK);
eResult = sp_set_config_parity(pSerialConfig, SP_PARITY_NONE );
assert(eResult == SP_OK);
eResult = sp_set_config_stopbits(pSerialConfig, 1);
assert(eResult == SP_OK);
eResult = sp_set_config_flowcontrol(pSerialConfig, SP_FLOWCONTROL_RTSCTS );
assert(eResult == SP_OK);
}
enum sp_return eResult;
struct sp_port_config *pSerialConfig = 0;
eResult = sp_new_config(&pSerialConfig);
assert(eResult == SP_OK);
eResult = sp_set_config_baudrate(pSerialConfig, 230400);
assert(eResult == SP_OK);
eResult = sp_set_config_bits(pSerialConfig, 8);
assert(eResult == SP_OK);
eResult = sp_set_config_parity(pSerialConfig, SP_PARITY_NONE);
assert(eResult == SP_OK);
eResult = sp_set_config_stopbits(pSerialConfig, 1);
assert(eResult == SP_OK);
eResult = sp_set_config_flowcontrol(pSerialConfig, SP_FLOWCONTROL_RTSCTS);
assert(eResult == SP_OK);
// Find and configure valid serial ports
const int MAX_PORTS = 2;
int iValidPortCount = 0;
struct sp_port * apValidPorts[MAX_PORTS];
struct sp_port *apValidPorts[MAX_PORTS];
{
struct sp_port **ports;
@ -164,11 +162,11 @@ int main(int argc, char *argv[])
{
struct sp_port *pPort = ports[i];
if (strstr(sp_get_port_name(pPort), PORT_STR) )
if (strstr(sp_get_port_name(pPort), PORT_STR))
{
if (bVerbose)
{
printf("Valid port %d: %s\n", iValidPortCount, sp_get_port_name(pPort) );
printf("Valid port %d: %s\n", iValidPortCount, sp_get_port_name(pPort));
printf("\tDescr: %s\n", sp_get_port_description(pPort));
int iUsbBus = -1;
int iUsbAddress = -1;
@ -183,7 +181,6 @@ int main(int argc, char *argv[])
printf("\tManufacturer: %s\n", sp_get_port_usb_manufacturer(pPort));
printf("\tProduct: %s\n", sp_get_port_usb_product(pPort));
printf("\tSerial #: %s\n", sp_get_port_usb_serial(pPort));
}
// Retain the port and configure it's settings
@ -208,9 +205,7 @@ int main(int argc, char *argv[])
sp_close(pPort);
sp_free_port(pPort);
if (bVerbose)
{
printf("\n\t--- Could not open this port ---\n\n");
}
}
}
}
@ -250,20 +245,18 @@ int main(int argc, char *argv[])
printf("P%d) Cmd %02X\n", iIndex, auReadBuf[0]);
// Now read 16-bit block number and byte checksum
iBytesRead = 1 + sp_blocking_read(pPort, auReadBuf+1, 3, 1/*ms timeout*/);
if (iBytesRead != 4) continue;
iBytesRead = 1 + sp_blocking_read(pPort, auReadBuf + 1, 3, 1/*ms timeout*/);
if (iBytesRead != 4)
continue;
if (bVerbose)
{
for (int i = 0; i < iBytesRead; i++)
{
printf("\t%02X '%c'\n", auReadBuf[i], auReadBuf[i] & 0x7f);
}
}
int iChksum = auReadBuf[0] ^ auReadBuf[1] ^ auReadBuf[2];
if (iChksum != auReadBuf[3])
{
printf ("--- Chksum failed --- read=%02X,%02X,%02X,%02X, calc=%02X\n",
auReadBuf[0],auReadBuf[1],auReadBuf[2],auReadBuf[3],iChksum);
auReadBuf[0], auReadBuf[1], auReadBuf[2], auReadBuf[3], iChksum);
continue;
}
if (bVerbose)
@ -290,7 +283,8 @@ int main(int argc, char *argv[])
{
// Echo command packet to confirm the request was received
iTxLen = sp_blocking_write(pPort, auReadBuf, 4, 1/*ms timeout*/);
if (iTxLen != 4) continue;
if (iTxLen != 4)
continue;
// Send the requsted block
iTxLen = sp_blocking_write(pPort, pDriveData, 512, 5/*ms timeout*/);
@ -307,7 +301,8 @@ int main(int argc, char *argv[])
// Send checksum
iTxLen = sp_blocking_write(pPort, &iChksum, 1, 30/*ms timeout*/);
if (iTxLen != 1) continue;
if (iTxLen != 1)
continue;
if (bLog)
{
@ -317,9 +312,9 @@ int main(int argc, char *argv[])
}
else // Write block
{
static unsigned char auBlockBuf[513];
int iReadLen = sp_blocking_read(pPort, auBlockBuf, 512+1, 30/*ms timeout*/);
assert(iReadLen == 512+1);
static unsigned char auBlockBuf[512 + 1];
int iReadLen = sp_blocking_read(pPort, auBlockBuf, 512 + 1, 30/*ms timeout*/);
assert(iReadLen == 512 + 1);
iChksum = 0;
for (int i = 0; i < 512; i++)
@ -328,13 +323,11 @@ int main(int argc, char *argv[])
iTxLen = sp_blocking_write(pPort, auReadBuf, 4, 1/*ms timeout*/);
if (0) printf ("Wrt Hdr=%02X,%02X,%02X,%02X, calc=%02X, rcv=%02x\n",
auReadBuf[0],auReadBuf[1],auReadBuf[2],auReadBuf[3],iChksum, auBlockBuf[512]);
auReadBuf[0], auReadBuf[1], auReadBuf[2], auReadBuf[3], iChksum, auBlockBuf[512]);
// Block data checksum matches, write it to disk
if (iChksum == auBlockBuf[512])
{
memcpy(pDriveData, auBlockBuf, 512);
}
if (bLog)
{
@ -343,7 +336,6 @@ int main(int argc, char *argv[])
}
}
}
}
}