int sendCommandAndWaitForResponse(int fd, uint8 *command)
{
    uint8  response[4] = {0};
    int    res = 0;

    res = write(fd, command, HEADER_LENGTH + command[LENGTH_OFFSET]);

    if( res <= 0 )
    {
        puts("ERROR");
        return -1;
    }

    res = readWithTimeout(fd, response, 1, 5);
    if( res != 1 )
    {
        puts("ERROR");
        return -1;
    }
    else if (response[0]== BOOTLOADER_PROT)
    {
        printf("(SKIPPED by bootloader)...");
        return 0;

    }
    else if ( response[0] != BOOTLOADER_OK )
    {
        printf("ERROR [%02x]\n", response[0]);
        return -1;
    }
    else
    {
        return 0;
    }
}
//low lever send command, get reply function
int writetopirate(uint8* val){
	int res = -1;
	uint8	buffer[2] = {0};
	
	sendString(cmdLineArgs.dev_fd, 1, val);
	res = readWithTimeout(cmdLineArgs.dev_fd, buffer, 1, 1);
	if( memcmp(buffer, "\x01", 1) ) {
		puts("ERROR");
		return -1;
	} 
	return 0;
}
uint8 PIC416Read(uint8 cmd){
	uint16 PICread;
	uint8 buffer[2]={0};
	int res = -1;
	
	
	buffer[0]='\xA5';
	buffer[1]=cmd;

	sendString(cmdLineArgs.dev_fd, 2, buffer);
	res = readWithTimeout(cmdLineArgs.dev_fd, buffer, 1, 1);
	PICread=buffer[0];
	
	return PICread;
}
예제 #4
0
int MJPEGServer::readLineWithTimeout(int fd, iobuffer *iobuf, char *buffer, size_t len, int timeout)
{
    char c = '\0', *out = buffer;
    int i;

    memset(buffer, 0, len);

    for(i = 0; i < len && c != '\n'; i++) {
        if(readWithTimeout(fd, iobuf, &c, 1, timeout) <= 0) {
            /* timeout or error occured */
            return -1;
        }
        *out++ = c;
    }

    return i;
}
int PIC416Write(uint8 cmd, uint16 data){
	uint8 buffer[4]={0};
	int res = -1;
	
	buffer[0]='\xA4';
	buffer[1]=cmd;
	buffer[2]=(uint8)(data);
	buffer[3]=(data>>8);

	
	sendString(cmdLineArgs.dev_fd, 4, buffer);
	res = readWithTimeout(cmdLineArgs.dev_fd, buffer, 1, 1);
	if( memcmp(buffer, "\x01", 1) ) {
		puts("ERROR");
		return -1;
	} 
	return 0;
}
int main (int argc, const char** argv)
{
    int		dev_fd = -1, res = -1;
    uint8	buffer[256] = {0};
    uint8	pages_used[PIC_NUM_PAGES] = {0};
    uint8*	bin_buff = NULL;


    puts("+++++++++++++++++++++++++++++++++++++++++++");
    puts("  Pirate-Loader for BP with Bootloader v4+  ");
    puts("  Loader version: " PIRATE_LOADER_VERSION "  OS: " OS_NAME(OS));
    puts("+++++++++++++++++++++++++++++++++++++++++++\n");

    if( (res = parseCommandLine(argc, argv)) < 0 )
    {
        return -1;
    }
    else if( res == 0 )
    {
        return 0;
    }

    if( !g_hello_only )
    {

        if( !g_hexfile_path )
        {
            fprintf(stderr, "Please specify hexfile path --hex=/path/to/hexfile.hex\n");
            return -1;
        }

        bin_buff = (uint8*)malloc(0xFFFFFF * sizeof(uint8)); //256kB
        if( !bin_buff )
        {
            fprintf(stderr, "Could not allocate 256kB buffer\n");
            goto Error;
        }

        //fill the buffer with 0xFF
        memset(bin_buff, 0xFFFFFFFF, (0xFFFFFF * sizeof(uint8)));

        printf("Parsing HEX file [%s]\n", g_hexfile_path);

        res = readHEX(g_hexfile_path, bin_buff, (0xFFFFFF * sizeof(uint8)), pages_used);
        if( res <= 0 || res > flashsize )
        {
            fprintf(stderr, "Could not load HEX file, result=%d\n", res);
            goto Error;
        }

        printf("Found %d words (%d bytes)\n", res, res * 3);

        //printf("Fixing bootloader/userprogram jumps\n");
        //fixJumps(bin_buff, pages_used);
    }

    if( g_simulate )
    {
        sendFirmware(dev_fd, bin_buff, pages_used);
        goto Finished;
    }

    if( !g_device_path )
    {
        fprintf(stderr, "Please specify serial device path --dev=/dev/...\n");
        return -1;
    }

    printf("Opening serial device %s...", g_device_path);

    dev_fd = openPort(g_device_path, 0);

    if( dev_fd < 0 )
    {
        puts("ERROR");
        fprintf(stderr, "Could not open %s\n", g_device_path);
        goto Error;
    }
    puts("OK");

    printf("Configuring serial port settings...");

    if( configurePort(dev_fd, B115200) < 0 )
    {
        puts("ERROR");
        fprintf(stderr, "Could not configure device, errno=%d\n", errno);
        goto Error;
    }
    puts("OK");

    printf("Sending Hello to the Bootloader...");

    //send HELLO
    res = write(dev_fd, BOOTLOADER_HELLO_STR, 1);

    res = readWithTimeout(dev_fd, buffer, 4, 3);

    if( res != 4 || buffer[3] != BOOTLOADER_OK )
    {
        puts("ERROR");
        fprintf(stderr, "No reply from the bootloader, or invalid reply received: %d\n", res);
        fprintf(stderr, "Please make sure that PGND and PGC are connected, replug the devide and try again\n");
        goto Error;
    }
    puts("OK\n"); //extra LF for spacing

    printf("Bootloader version: %d,%02d\n", buffer[1], buffer[2]);

    printf("Device ID [%02x]:",buffer[0]);
    switch(buffer[0])
    {
//    case 0xd4:
//        printf("PIC24FJ64GA002\n");
//        break;
    case  9:
        printf("PIC24FJ128GB206\n");
        //    __PIC24FJ128GB206__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 17:
        printf("PIC24FJ128GB210\n");
//    __PIC24FJ128GB210__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;

        break;
    case 18:
        printf("PIC24FJ256GB206\n");
        //    __PIC24FJ256GB206__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 19:
        printf("PIC24FJ256GB210\n");
        //    __PIC24FJ256GB210__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 191:
        printf("PIC24FJ256DA206\n");
        //    __PIC24FJ256DA206__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 192:
        printf("PIC24FJ256DA210\n");
        //    __PIC24FJ256DA210__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 217:
        printf("PIC24FJ64GB106\n");
        //    __PIC24FJ64GB106__
        family = IS_24FJ;
        flashsize = 0xAC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 218:
        printf("PIC24FJ64GB108\n");
        //    __PIC24FJ64GB108__
        family = IS_24FJ;
        flashsize = 0xAC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 219:
        printf("PIC24FJ64GB110\n");
        //    __PIC24FJ64GB110__
        family = IS_24FJ;
        flashsize = 0xAC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 229:
        printf("PIC24FJ128GB106\n");
        //    __PIC24FJ128GB106__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 230:
        printf("PIC24FJ128GB108\n");
        //    __PIC24FJ128GB108__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 231:
        printf("PIC24FJ128GB110\n");
        //    __PIC24FJ128GB110__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 235:
        printf("PIC24FJ192GB106\n");
        //    __PIC24FJ192GB106__
        family = IS_24FJ;
        flashsize = 0x20C00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 236:
        printf("PIC24FJ192GB108\n");
        //    __PIC24FJ192GB108__
        family = IS_24FJ;
        flashsize = 0x20C00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 237:
        printf("PIC24FJ192GB110\n");
        //    __PIC24FJ192GB110__
        family = IS_24FJ;
        flashsize = 0x20C00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 241:
        printf("PIC24FJ256GB106\n");
        //    __PIC24FJ256GB106__
#define IS_24FJ                 1
        flashsize = 0x2AC00;
        eesizeb  =         0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 242:
        printf("PIC24FJ256GB108\n");
        //    __PIC24FJ256GB108__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 243:
        printf("PIC24FJ256GB110\n");
        //    __PIC24FJ256GB110__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 244:
        printf("PIC24FJ32GB002\n");
        //    __PIC24FJ32GB002__
        family = IS_24FJ;
        flashsize = 0x5800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 245:
        printf("PIC24FJ32GB004\n");
        //    __PIC24FJ32GB004__
        family = IS_24FJ;
        flashsize = 0x5800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 246:
        printf("PIC24FJ64GB002\n");
        //    __PIC24FJ64GB002__
        family = IS_24FJ;
        flashsize = 0xAC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 247:
        printf("PIC24FJ64GB004\n");
        //    __PIC24FJ64GB004__
        family = IS_24FJ;
        flashsize = 0xAC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 250:
        printf("PIC24FJ128DA106\n");//    __PIC24FJ128DA106__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 251:
        printf("PIC24FJ128DA110\n");
        //    __PIC24FJ128DA110__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 252:
        printf("PIC24FJ128DA206\n");
        //    __PIC24FJ128DA206__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 253:
        printf("PIC24FJ128DA210\n");
        //    __PIC24FJ128DA210__
        family = IS_24FJ;
        flashsize = 0x15800;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 254:
        printf("PIC24FJ256DA106\n");
        //    __PIC24FJ256DA106__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case 255:
        printf("PIC24FJ256DA110\n");
        //    __PIC24FJ256DA110__
        family = IS_24FJ;
        flashsize = 0x2AC00;
        eesizeb  = 0;
        blstartaddr = 0x400L;
        blendaddr = 0x23FFL;
        break;
    case	206:
        printf("PIC24FJ16GA002\n");
        flashsize = 	0x2C00;

        break;

    case	207:
        printf("PIC24FJ16GA004\n");
        flashsize = 	0x2C00;

        break;


    case	208:
        printf("PIC24FJ32GA002\n");
        flashsize = 	0x5800;

        break;

    case	209:
        printf("PIC24FJ32GA004\n");
        flashsize = 	0x5800;

        break;

    case	210:
        printf("PIC24FJ48GA002\n");
        flashsize = 	0x8400;

        break;

    case	211:
        printf("PIC24FJ48GA004\n");
        flashsize = 	0x8400;

        break;


    case	212:
        printf("PIC24FJ64GA002\n");
        flashsize = 	0xAC00;

        break;

    case	213:
        printf("PIC24FJ64GA004\n");
        flashsize = 	0xAC00;

        break;

    case	214:
        printf("PIC24FJ64GA006\n");
        flashsize = 	0xAC00;

        break;

        printf("PIC24FJ64GA008\n");
        flashsize = 	0xAC00;
    case	215:
        break;

    case	216:
        printf("PIC24FJ64GA010\n");
        flashsize = 	0xAC00;

        break;

    case	220:
            printf("PIC24FJ96GA006\n");
        flashsize = 	0x10000;

        break;

    case	221:
        printf("PIC24FJ96GA008\n");
        flashsize = 	0x10000;

        break;

    case	222:
        printf("PIC24FJ96GA010\n");
        flashsize = 	0x10000;

        break;


    case	223:
        printf("PIC24FJ128GA006\n");
        flashsize = 	0x15800;

        break;

    case	224:
        printf("PIC24FJ128GA008\n");
        flashsize = 	0x15800;

        break;

    case	225:
            printf("PIC24FJ128GA010\n");
        flashsize = 	0x15800;

        break;

    case	226:
        printf("PIC24FJ128GA106\n");
        flashsize = 	0x15800;

        break;

    case	227:
        printf("PIC24FJ128GA108\n");
        flashsize = 	0x15800;
        break;

    case	228:
        printf("PIC24FJ128GA110\n");
        flashsize = 	0x15800;
        break;

    case	232:
        printf("PIC24FJ192GA106\n");
        flashsize = 	0x20C00;
        break;

    case	233:
        printf("PIC24FJ192GA108\n");
        flashsize = 	0x20C00;
        break;

    case	234:
        printf("PIC24FJ192GA110\n");
        flashsize = 	0x20C00;
        break;

    case	238:
        printf("PIC24FJ256GA106\n");
        flashsize = 	0x2AC00;

        break;

    case	239:
        printf("PIC24FJ256GA108\n");
        flashsize = 	0x2AC00;
        break;

    case	240:
        printf("PIC24FJ256GA110\n");
        flashsize = 	0x2AC00;
        break;


    default:
        printf("UNKNOWN");
        fprintf(stderr, "Unsupported device (%02x:UNKNOWN)\n", buffer[0]);
        goto Error;
        break;
    }

    if( !g_hello_only )
    {

        res = sendFirmware(dev_fd, bin_buff, pages_used);

        if( res > 0 )
        {
            puts("\nFirmware updated successfully :)!");
            //printf("Use screen %s 115200 to verify\n", g_device_path);
        }
        else
        {
            puts("\nError updating firmware :(");
            goto Error;
        }

    }

Finished:
    if( bin_buff )
    {
        free( bin_buff );
    }
    if( dev_fd >= 0 )
    {
        close(dev_fd);
    }
    return 0;

Error:
    if( bin_buff )
    {
        free( bin_buff );
    }
    if( dev_fd >= 0 )
    {
        close(dev_fd);
    }
    return -1;
}
예제 #7
0
파일: WdtSocket.cpp 프로젝트: hjybdrs/wdt
int WdtSocket::read(char *buf, int nbyte, bool tryFull) {
  return readWithTimeout(buf, nbyte,
                         threadCtx_.getOptions().read_timeout_millis, tryFull);
}
예제 #8
0
파일: WdtSocket.cpp 프로젝트: Maascamp/wdt
int WdtSocket::read(char *buf, int nbyte, bool tryFull) {
  return readWithTimeout(buf, nbyte, options_.read_timeout_millis, tryFull);
}