调试C程序、C数据结构语言程序讲解、辅导留学生C编程、C统计讲解

#include
#include
#include
#include
#include
#include
#include
#include
#include

extern int g_msg_fd;
extern int g_msg_test_fd;
extern int g_sins_gps_fd;
#if 1
#define MAX_PAYLOAD_LEN 210 //(1680/8)

#define INSTRUCTION_SIZE 5
#define PACKET_LEN_SIZE 2
#define USER_ADDR_SIZE 3
#define CHECKSUM_SIZE 1

#define IPUC (INSTRUCTION_SIZE + PACKET_LEN_SIZE + USER_ADDR_SIZE + CHECKSUM_SIZE)

#define TXSQ_INFO_FIRM_SIZE 7 //(1 + 3 + 2 + 1)
#define TXSQ_FIRM_SIZE (IPUC + TXSQ_INFO_FIRM_SIZE)

#define ICJC_INFO_FIRM_SIZE 1 //，
#define ICJC_FIRM_SIZE (IPUC + ICJC_INFO_FIRM_SIZE)

#define XTZJ_INFO_FIRM_SIZE 2 //，
#define XTZJ_FIRM_SIZE (IPUC + XTZJ_INFO_FIRM_SIZE)

#define ICXX_INFO_FIRM_SIZE 11 //(1+3ID+1+2+1+1+2)
#define ICXX_FIRM_SIZE (IPUC + ICXX_INFO_FIRM_SIZE)

#define TXXX_INFO_FIRM_SIZE 9 //(1+3+2+2+1CRC
#define TXXX_FIRM_SIZE (IPUC + TXXX_INFO_FIRM_SIZE)
#define TXXX_MAX_SIZE (TXXX_FIRM_SIZE + MAX_PAYLOAD_LEN)//TXXX

#define FKXX_INFO_FIRM_SIZE 5//(1+4)
#define FKXX_FIRM_SIZE (IPUC + FKXX_INFO_FIRM_SIZE)

#define ZJXX_INFO_FRIM_SIZE 10 //(1IC+1+1+1+6)
#define ZJXX_FIRM_SIZE (IPUC + ZJXX_INFO_FRIM_SIZE)

#define RX_BD_MAX_DATA_SIZE TXXX_MAX_SIZE

#define TXSQ_PAYLOAD_CHINESE 0x44
#define TXSQ_PAYLOAD_BCD 0x46

enum {
DWXX_BUF = (1 << 0),
TXXX_BUF = (1 << 1),
ICXX_BUF = (1 << 2),
ZJXX_BUF = (1 << 3),
SJXX_BUF = (1 << 4),
BBXX_BUF = (1 << 5),
FKXX_BUF = (1 << 6),
};
unsigned char bd_buf_bitmap = 0;
//unsigned char dwxx_buf[todo];
unsigned char txxx_buf[TXXX_MAX_SIZE];
unsigned char icxx_buf[ICXX_FIRM_SIZE];
unsigned char zjxx_buf[ZJXX_FIRM_SIZE];
//unsigned char sjxx_buf[todo];
//unsigned char bbxx_buf[todo];
unsigned char fkxx_buf[FKXX_FIRM_SIZE];

unsigned int rx_packet_len = 0;
unsigned char bd_rx_char;
unsigned int bd_buf_pointer = 0;
unsigned char bd_shared_rx_buf[RX_BD_MAX_DATA_SIZE];

unsigned char g_src_user_addr[3];
unsigned char g_dst_user_addr[3];
unsigned char g_transfer_format;
/* */
struct dwxx_struct
{
unsigned int todo;
};

/* */
struct txxx_info_type_struct
{
unsigned char packet_comm:2;//
unsigned char transfer_format:1; //
unsigned char ack:1; //
unsigned char comm_way:1; //
unsigned char has_key:1; //
unsigned char rest:2;
};

struct send_time_struct
{
unsigned char hour;
unsigned char minute;
};

struct txxx_info_struct
{
struct txxx_info_type_struct txxx_info_type;
unsigned char src_user_addr[3];
struct send_time_struct send_time;
unsigned int payload_len;
unsigned char payload[MAX_PAYLOAD_LEN];
unsigned char crc;
};

struct txxx_struct
{
unsigned char instruction[5];
unsigned int packet_len; //
unsigned char user_addr[3];
struct txxx_info_struct txxx_info;
unsigned char checksum;
};

struct icxx_info_struct
{
unsigned char frame_id; //
unsigned char broadcast_id[3]; //
unsigned char user_feature; //
unsigned int service_frequency; //
unsigned char comm_level; //
unsigned char encryption_flag; //
unsigned int user_num; //
};

/* IC */
struct icxx_struct
{
unsigned char instruction[5]; //
unsigned int packet_len; //
unsigned char user_addr[3]; //
struct icxx_info_struct icxx_info;
unsigned char checksum; //
};

struct zjxx_info_struct
{
unsigned char ic_status; //
unsigned char hw_status;
unsigned char battery_quantity;//
unsigned char in_station_status; //
unsigned char power_status[6]; //
};

struct zjxx_struct
{
unsigned char instruction[5];
unsigned int packet_len;
unsigned char user_addr[3];
struct zjxx_info_struct zjxx_info;
unsigned char checksum;
};

struct sjxx_struct
{
unsigned int todo;
};

struct bbxx_struct
{
unsigned int todo;
};

struct fkxx_info_struct
{
unsigned char fk_flag;
unsigned char extra_info[4];
};

struct fkxx_struct
{
unsigned char instruction[5];
unsigned int packet_len;
unsigned char user_addr[3];
struct fkxx_info_struct fkxx_info;
unsigned char checksum;
};
/*

*/
static unsigned char xor_checksum (unsigned char *buf, unsigned int len)
{
unsigned int i;
unsigned char checksum = 0;

for (i = 0; i < len; ++i)
{
checksum ^= *(buf++);
}

return checksum;
}
void create_txsq(unsigned char *src_user_addr, unsigned char *dst_user_addr,
unsigned char transfer_format, unsigned char *payload,
unsigned int payload_len, unsigned char *send_txsq_data)
{
/* 1、，memcpy，, */
send_txsq_data[0] = '$';
send_txsq_data[1] = 'T';
send_txsq_data[2] = 'X';
send_txsq_data[3] = 'S';
send_txsq_data[4] = 'Q';

/* 2、，， */
send_txsq_data[5] = (TXSQ_FIRM_SIZE + payload_len) / 256;
send_txsq_data[6] = (TXSQ_FIRM_SIZE + payload_len) % 256;

/* 3、 */
send_txsq_data[7] = *src_user_addr;
send_txsq_data[8] = *(src_user_addr + 1);
send_txsq_data[9] = *(src_user_addr + 2);

/* 4.1、- */
if (transfer_format == 0) //
{
send_txsq_data[10] = TXSQ_PAYLOAD_CHINESE;//0b01000100;
}
else ///
{
send_txsq_data[10] = TXSQ_PAYLOAD_BCD;//0b01000110;
}

/* 4.2、- */
send_txsq_data[11] = *dst_user_addr;
send_txsq_data[12] = *(dst_user_addr + 1);
send_txsq_data[13] = *(dst_user_addr + 2);

/* 4.3、--bit */
send_txsq_data[14] = (payload_len * 8) / 256;
send_txsq_data[15] = (payload_len * 8) % 256;

/* 4.4、- */
send_txsq_data[16] = 0;

/* 4.5、- */
memcpy(send_txsq_data[17] , payload, payload_len);

/* 5、 */
send_txsq_data[TXSQ_FIRM_SIZE + payload_len -1] = xor_checksum(send_txsq_data, (TXSQ_FIRM_SIZE + payload_len -1));
printf("\r\n xor_checksum = 0x%x\r\n", xor_checksum(send_txsq_data, (TXSQ_FIRM_SIZE + payload_len -1)));
}
/*
1、,
2、6("")，，:
txsq:24 54 58 53 51 00 18 02 ad f7 44 02 ad f7 00 30 00 ce d2 b0 ae c4 e3 63
txxx:24 54 58 58 58 00 1a 02 ad f7 40 02 ad f7 00 00 00 30 ce d2 b0 ae c4 e3 00 67

*/
void send_txsq(unsigned char cmd, unsigned char *src_user_addr, unsigned char *dst_user_addr,
unsigned char transfer_format, unsigned char *send_txsq_payload, unsigned int send_txsq_payload_len)
{
unsigned int i;
unsigned char l_transfer_format;
unsigned int payload_len;
unsigned long src_user_addr_long;
unsigned long dst_user_addr_long;
unsigned char l_src_user_addr[3];
unsigned char l_dst_user_addr[3];
unsigned char payload[MAX_PAYLOAD_LEN];
unsigned char send_txsq_data[TXSQ_FIRM_SIZE + MAX_PAYLOAD_LEN];

if (cmd == 1)
{

printf("\r\n (0:,1):");
scanf("%d",l_transfer_format);


printf("\r\n :");
scanf("%s", payload);
payload_len = strlen((char const *)payload);
// payload_len = payload_len -1;
//ユ″?
l_src_user_addr[0] = 0x05;
l_src_user_addr[1] =0x95;
l_src_user_addr[2] =0x79;
//ユ″
l_dst_user_addr[0] =0x02;
l_dst_user_addr[1] =0x7b;
l_dst_user_addr[2] = 0x14;

// l_dst_user_addr[0] =0x05;
// l_dst_user_addr[1] =0x95;
// l_dst_user_addr[2] = 0x79;
for (i = 0; i < 3; ++i)
{
g_src_user_addr[i] = l_src_user_addr[i];
g_dst_user_addr[i] = l_src_user_addr[i];
}

g_transfer_format = l_transfer_format;

// send_txsq_data，
create_txsq(l_src_user_addr, l_dst_user_addr, l_transfer_format, payload, payload_len, send_txsq_data);
write(g_msg_fd,send_txsq_data,(TXSQ_FIRM_SIZE + payload_len));
// tx_uart3_string(send_txsq_data, (TXSQ_FIRM_SIZE + payload_len));
}
else
{
create_txsq(src_user_addr, dst_user_addr, transfer_format, send_txsq_payload, send_txsq_payload_len, send_txsq_data);
// tx_uart3_string(send_txsq_data, (TXSQ_FIRM_SIZE + send_txsq_payload_len));
write(g_msg_fd,send_txsq_data,(TXSQ_FIRM_SIZE + send_txsq_payload_len));
}

}
void parse_txxx(struct txxx_struct *txxx)
{
unsigned int i;
unsigned int payload_len;
unsigned char send_data[104];//2

/* 1、 */
for (i = 0; i < 5; ++i)
{
(*txxx).instruction[i] = txxx_buf[i];
}

/* 2、 */
(*txxx).packet_len = txxx_buf[5] * 256 + txxx_buf[6];

/* 3、 */
for (i = 0; i < 3; ++i)
{
(*txxx).user_addr[i] = txxx_buf[i + 7];
}

/* 4.1、- */
memcpy(((*txxx).txxx_info.txxx_info_type), (txxx_buf + 10), 1);

/* 4.2、- */
for (i = 0; i < 3; ++i)
{
(*txxx).txxx_info.src_user_addr[i] = txxx_buf[i + 11];
}

/* 4.3、- */
(*txxx).txxx_info.send_time.hour = txxx_buf[14];
(*txxx).txxx_info.send_time.minute = txxx_buf[15];

/* 4.4、- */
(*txxx).txxx_info.payload_len = txxx_buf[16] * 256 + txxx_buf[17];
payload_len = (*txxx).txxx_info.payload_len / 8;

/* 4.5、- */
memcpy((*txxx).txxx_info.payload, (txxx_buf + 18), payload_len);

/* 4.6、-CRC */
(*txxx).txxx_info.crc = txxx_buf[18 + payload_len];

/* 5、 */
(*txxx).checksum = txxx_buf[18 + payload_len + 1];
#if 0
if ((txxx_buf[18] == 'z') (txxx_buf[19] == 't')/* (txxx_buf[18] == 'z') (txxx_buf[19] == 't') (txxx_buf[20] == 'c') (txxx_buf[20] == 'x') */)
{
#if 1
create_send_data_1(send_data);
send_txsq(0, (*txxx).user_addr[0], (*txxx).txxx_info.src_user_addr[0], g_transfer_format, send_data, (104-37));
#else
for (i = 0; i < (104-37); ++i)
{
send_data[i] = 0x5a;
}

send_data[0] = 'M';
send_data[1] = (104-37);
send_txsq(0, (*txxx).user_addr[0], (*txxx).txxx_info.src_user_addr[0], g_transfer_format, send_data, (104-37));
#endif

}else if ( (txxx_buf[18] == 'M') (txxx_buf[19] == (104-37)) )
{
create_send_data_2(send_data, txxx_buf[18], payload_len);
SendData(104, 1, GSMNEW_ENUM_measureCurSend, send_data);
}
#endif
}
void read_bd_rx_info(void)
{
struct txxx_struct txxx;
struct icxx_struct icxx;
struct zjxx_struct zjxx;
struct fkxx_struct fkxx;
#if 0
if (bd_buf_bitmap FKXX_BUF)
{
parse_fkxx(fkxx);
print_fkxx(fkxx);
bd_buf_bitmap = ~FKXX_BUF;
}

if (bd_buf_bitmap ICXX_BUF)
{
parse_icxx(icxx);
print_icxx(icxx);
bd_buf_bitmap = ~ICXX_BUF;
}

if (bd_buf_bitmap ZJXX_BUF)
{
parse_zjxx(zjxx);
print_zjxx(zjxx);
bd_buf_bitmap = ~ZJXX_BUF;
}
#endif
if (bd_buf_bitmap TXXX_BUF)
{
parse_txxx(txxx);
//print_txxx(txxx);
bd_buf_bitmap = ~TXXX_BUF;
}
}
int copy_packet_from_shared_buf() //1、2
{
if ((bd_shared_rx_buf[1] == 'D') (bd_shared_rx_buf[2] == 'W')) //$DWXX
{
bd_buf_bitmap |= DWXX_BUF;
//memcpy(dwxx_buf, bd_shared_rx_buf, sizeof(dwxx_buf));
return 0;
}
else if ((bd_shared_rx_buf[1] == 'T') (bd_shared_rx_buf[2] == 'X')) //$TXXX
{
bd_buf_bitmap |= TXXX_BUF;
memcpy(txxx_buf, bd_shared_rx_buf, sizeof(txxx_buf));
return 1;
}
else if ((bd_shared_rx_buf[1] == 'I') (bd_shared_rx_buf[2] == 'C')) //IC$ICXX
{
bd_buf_bitmap |= ICXX_BUF;
memcpy(icxx_buf, bd_shared_rx_buf, sizeof(icxx_buf));
return 2;
}
else if ((bd_shared_rx_buf[1] == 'Z') (bd_shared_rx_buf[2] == 'J')) //$ZJXX
{
bd_buf_bitmap |= ZJXX_BUF;
memcpy(zjxx_buf, bd_shared_rx_buf, sizeof(zjxx_buf));
return 3;
}
else if ((bd_shared_rx_buf[1] == 'S') (bd_shared_rx_buf[2] == 'J')) //$SJXX
{
bd_buf_bitmap |= SJXX_BUF;
//memcpy(sjxx_buf, bd_shared_rx_buf, sizeof(sjxx_buf));
return 4;
}
else if ((bd_shared_rx_buf[1] == 'B') (bd_shared_rx_buf[2] == 'B')) //$BBXX
{
bd_buf_bitmap |= BBXX_BUF;
//memcpy(bbxx_buf, bd_shared_rx_buf, sizeof(bbxx_buf));
return 5;
}
else if ((bd_shared_rx_buf[1] == 'F') (bd_shared_rx_buf[2] == 'K')) //$FKXX
{
bd_buf_bitmap |= FKXX_BUF;
memcpy(fkxx_buf, bd_shared_rx_buf, sizeof(fkxx_buf));
return 6;
}
return -1;
}
void parse_zjxx(struct zjxx_struct *zjxx)
{
int i;
for (i = 0; i < 5; ++i)
{
(*zjxx).instruction[i] = zjxx_buf[i];
}
(*zjxx).packet_len = zjxx_buf[5] * 256 + zjxx_buf[6];
for (i = 0; i < 3; ++i)
{
(*zjxx).user_addr[i] = zjxx_buf[i + 7];
}
}
void parse_icxx(struct icxx_struct *icxx)
{
int i;
for (i = 0; i < 5; ++i)
{
(*icxx).instruction[i] = icxx_buf[i];
}
(*icxx).packet_len = icxx_buf[5] * 256 + icxx_buf[6];
for (i = 0; i < 3; ++i)
{
(*icxx).user_addr[i] = icxx_buf[i + 7];
}
}
void parse_fkxx(struct fkxx_struct *fkxx)
{
unsigned int i;

for (i = 0; i < 5; ++i)
{
(*fkxx).instruction[i] = fkxx_buf[i];
}

(*fkxx).packet_len = fkxx_buf[5] * 256 + fkxx_buf[6];

for (i = 0; i < 3; ++i)
{
(*fkxx).user_addr[i] = fkxx_buf[i + 7];
}

(*fkxx).fkxx_info.fk_flag = fkxx_buf[10];

for (i = 0; i < 4; ++i)
{
(*fkxx).fkxx_info.extra_info[i] = fkxx_buf[11 + i];
}

(*fkxx).checksum = fkxx_buf[15];
}
#endif
int open_msgport()
{
int fd;
fd = open( "/dev/ttyUSB2", O_RDWR);
if (-1 == fd)
{
perror("Can't Open ttyUSB0 Serial Port");
return(-1);
}
else
{
printf("open ttyUSB1 .....\n");
}
#if 1
if(fcntl(fd, F_SETFL, 0)<0)
{
printf("fcntl failed!\n");
}
else
{
printf("fcntl=%d\n",fcntl(fd, F_SETFL,0));
}
#endif
return fd;
}
int open_msgport_test()
{
int fd;
fd = open( "/dev/ttyUSB2", O_RDWR);
if (-1 == fd)
{
perror("Can't Open ttyUSB2 Serial Port");
return(-1);
}
else
{
printf("open ttyUSB2 .....\n");
}
#if 1
if(fcntl(fd, F_SETFL, 0)<0)
{
printf("fcntl failed!\n");
}
else
{
printf("fcntl=%d\n",fcntl(fd, F_SETFL,0));
}
#endif
return fd;
}
void send_icjc() //
{
int ret;
unsigned char send_iczj_data[ICJC_FIRM_SIZE];
send_iczj_data[0] = '$';
send_iczj_data[1] = 'I';
send_iczj_data[2] = 'C';
send_iczj_data[3] = 'J';
send_iczj_data[4] = 'C';
send_iczj_data[5] = 0;
send_iczj_data[6] = 12;
send_iczj_data[7] = 0;
send_iczj_data[8] = 0 ;
send_iczj_data[9] = 0;
send_iczj_data[10] = 0;
send_iczj_data[11] = xor_checksum(send_iczj_data,11);
printf("%s\n",send_iczj_data);
ret = write(g_msg_fd,send_iczj_data,12);
printf("ret = %d\n",ret);
}
void bd_msg_send()
{
if (g_msg_fd < 0) {
printf("msg port error,return\n");
}
send_txsq(1,NULL,NULL,0,NULL,0);
// send_icjc();
return;
}
void thread_msg_recv()
{
struct txxx_struct mytxxx;
struct fkxx_struct myfkxx;
struct zjxx_struct myzjxx;
struct icxx_struct myicxx;

int ret,i;
if (g_msg_fd < 0) {
printf("msg port error,return\n");
}
while(1) {
ret = read(g_msg_fd,bd_shared_rx_buf,RX_BD_MAX_DATA_SIZE);//，bd_shared_rx_buf
printf("msg read ret = %d\n",ret);
bd_shared_rx_buf[ret] = '\0';
#if 1
printf("data:");
for(i = 0;i printf("%c ",bd_shared_rx_buf[i]);
}
printf("\r\n");
printf("111111111\n");
#endif
// printf("data: %s\n",bd_shared_rx_buf);
tcflush(g_msg_fd, TCIOFLUSH ); //buffer
ret = copy_packet_from_shared_buf();//bd_shared_rx_buf
if (ret < 0) {
printf("recv msg error\n");
}
switch(ret) {
case 0:
break;
case 1://1，
parse_txxx(mytxxx);//mytxxx
mytxxx.txxx_info.payload[mytxxx.txxx_info.payload_len] = '\0';
printf("recv msg: %s\n",mytxxx.txxx_info.payload);
printf("user addr: ");
for (i = 0;i<3;i++) {
printf("0x%x ",mytxxx.user_addr[i]);
}
printf("\r\n");
printf("src user addr:");
for (i=0;i<3;i++) {
printf("0x%x ",mytxxx.txxx_info.src_user_addr[i]);
}
printf("\r\n");
//***************************************************

break;
case 2:
parse_icxx(myicxx);
printf(" user addr:");
for (i=0;i<3;i++) {
printf("0x%x ",myicxx.user_addr[i]);
}
printf("\r\n");
break;
case 3:
parse_zjxx(myzjxx);
printf(" user addr:");
for (i=0;i<3;i++) {
printf("0x%x ",myzjxx.user_addr[i]);
}
printf("\r\n");
break;
case 4:
break;
case 5:
break;
case 6: //
parse_fkxx(myfkxx);
printf(" user addr:");
for (i=0;i<3;i++) {
printf("0x%x ",myfkxx.user_addr[i]);
}
printf("\r\n");
printf("fsxx flag is %x\n",myfkxx.fkxx_info.fk_flag );
if (myfkxx.fkxx_info.extra_info[0] == 'T'myfkxx.fkxx_info.extra_info[1] == 'X'myfkxx.fkxx_info.extra_info[2] == 'S'myfkxx.fkxx_info.extra_info[3] == 'Q') {
if (myfkxx.fkxx_info.fk_flag == 0x0) {
printf("TXSQ CMD send ok\n");
} else {
printf("TXSQ CMD send error\n");
}
}
break;
default :
printf("msg resolve error\n");
break;
}
sleep(1);
}
}
#if 0
void thread_msg_recv_test()
{
struct txxx_struct mytxxx;
struct fkxx_struct myfkxx;

int ret,i;
if (g_sins_gps_fd < 0) {
printf("msg port error,return\n");
}
while(1) {
read(g_sins_gps_fd,bd_shared_rx_buf,RX_BD_MAX_DATA_SIZE);
tcflush(g_sins_gps_fd, TCIOFLUSH );
ret = copy_packet_from_shared_buf();
if (ret < 0) {
printf("recv msg error\n");
}
switch(ret) {
case 0:
parse_txxx(mytxxx);
mytxxx.txxx_info.payload[mytxxx.txxx_info.payload_len] = '\0';
printf("recv msg: %s\n",mytxxx.txxx_info.payload);
printf("user addr: ");
for (i = 0;i<3;i++) {
printf("0x%x ",mytxxx.user_addr[i]);
}
printf("\r\n");
printf("src user addr:");
for (i=0;i<3;i++) {
printf("0x%x ",mytxxx.txxx_info.src_user_addr[i]);
}
printf("\r\n");
break;
case 1:
parse_fkxx(myfkxx);
if (myfkxx.fkxx_info.extra_info[0] == 'T'myfkxx.fkxx_info.extra_info[1] == 'X'myfkxx.fkxx_info.extra_info[2] == 'S'myfkxx.fkxx_info.extra_info[3] == 'Q') {
if (myfkxx.fkxx_info.fk_flag == 0x0) {
printf("TXSQ CMD send ok\n");
} else {
printf("TXSQ CMD send error\n");
}
}
break;

}
sleep(1);
}
}
#endif