WhyCan Forum(哇酷开发者社区)

int handle_data(int fd) 
{
    do 
    {
        memset(cmd, 0, 32);

        if (sread(fd, cmd, 2) != 1)
            return 1;

        if (memcmp(cmd, "ge", 2) == 0) 
        {
            if (sread(fd, cmd, 6) != 1)
                return 1;
            memcpy(TDO, xvcInfo, strlen(xvcInfo));
            if (send(fd, (const char*)TDO, strlen(xvcInfo),0) != strlen(xvcInfo))
            {
                perror("write");
                return 1;
            }
            if (verbose) 
            {
                printf("%u : Received command: 'getinfo'\n", (int)time(NULL));
                printf("\t Replied with %s\n", xvcInfo);
            }
            break;
        }
        else if (memcmp(cmd, "se", 2) == 0) 
        {
            if (sread(fd, cmd, 9) != 1)
                return 1;
            memcpy(TDO, cmd + 5, 4);
            if (send(fd, (const char*)TDO, 4,0) != 4)
            {
                perror("write");
                return 1;
            }
            if (verbose) 
            {
                printf("%u : Received command: 'settck'\n", (int)time(NULL));
                printf("\t Replied with '%.*s'\n\n", 4, cmd + 5);
            }
            break;
        }
        else if (memcmp(cmd, "sh", 2) == 0) 
        {
            if (sread(fd, cmd, 4) != 1)
                return 1;
            if (verbose) 
            {
                printf("%u : Received command: 'shift'\n", (int)time(NULL));
            }
        }
        else 
        {

            fprintf(stderr, "invalid cmd '%s'\n", cmd);
            return 1;
        }

        int len;                            //<num bits> 
        if (sread(fd, &len, 4) != 1) 
        {
            fprintf(stderr, "reading length failed\n");
            return 1;
        }

        int nr_bytes = (len + 7) / 8;       //向上取整数字节
        if (nr_bytes > sizeof(TDI))
        {
            fprintf(stderr, "buffer size exceeded\n");
            return 1;
        }
 
        if (verbose) 
        {
            printf("\tNumber of Bits  : %d\n", len);
            printf("\tNumber of Bytes : %d \n", nr_bytes);
            printf("\n");
        }
    
        memset(&TDO, 0, nr_bytes);

        if (sread(fd, TMS, nr_bytes ) != 1) //读取tms 
        {
            fprintf(stderr, "reading tms data failed\n");
            return 1;
        }
        if (sread(fd, TDI, nr_bytes) != 1) //读取tdi 
        {
            fprintf(stderr, "reading tdi data failed\n");
            return 1;
        }

        JLINKARM_JTAG_StoreGetRaw((const U8*)&TDI, (U8*)&TDO, (const U8*)&TMS, len);

        if (send(fd, (const char*)TDO, nr_bytes,0) != nr_bytes)
        {
            perror("write");
            return 1;
        }
        break;

    } while (1);

    return 0;
}