| | |
|---|
| | | sum = ~sum; |
|---|
| | | return sum; |
|---|
| | | } |
|---|
| | | void SendComMap0(uint8_t data_length, uint8_t index)//表示成功读取的回应包 |
|---|
| | | { |
|---|
| | | static uint8_t send_frame[EUART_RX_BUF_SIZE]; |
|---|
| | | uint16_t checksum = 0; |
|---|
| | | send_frame[0] = 0x55; |
|---|
| | | send_frame[1] = 0xAA; |
|---|
| | | send_frame[2] = 0x03; |
|---|
| | | send_frame[3] = data_length+5; |
|---|
| | | send_frame[4] = CMD_REPLY; |
|---|
| | | send_frame[5] = index; |
|---|
| | | send_frame[6] = data_length; |
|---|
| | | memcpy(&send_frame[7], &g_com_map[index], data_length); |
|---|
| | | for(int i = 0; i<(data_length+5); i++) |
|---|
| | | { |
|---|
| | | checksum += send_frame[2+i]; |
|---|
| | | } |
|---|
| | | checksum = Checksum_u16(&send_frame[2],5+data_length); |
|---|
| | | memcpy(&send_frame[7+data_length],&checksum,2); |
|---|
| | | |
|---|
| | | uart_send(UART_ID0, send_frame,data_length+9, NULL); |
|---|
| | | } |
|---|
| | | void SendComMap(uint8_t data_length, uint8_t index)//表示成功读取的回应包 |
|---|
| | | { |
|---|
| | | static uint8_t send_frame[EUART_RX_BUF_SIZE]; |
|---|
| | |
|---|
| | | case CMD_READ: |
|---|
| | | //read包中data字节，即mUsartReceivePack[0]表示数据长度； |
|---|
| | | //从g_com_data结构体中的第index位置读取长度为mUsartReceivePack[0]的字节，发送出来 |
|---|
| | | SendComMap(pack_datalen,pack_index>>1); |
|---|
| | | SendComMap0(pack_datalen,pack_index>>1); |
|---|
| | | break; |
|---|
| | | default: |
|---|
| | | break; |
|---|
