初步测试完成

yincheng.zhong

2023-04-24 5c6608fc16627430bcdbaf4917c608e61b7db77c

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
#include "serial_at_cmd_app.h"
#include "global_param.h"
#include <string.h>
#include <stdio.h>
#include "dw_app.h"
 
 
#define CMD_READ    1
#define CMD_WRITE    2
#define CMD_REPLY 3
#define CMD_SMTTEST   0x6
#define EUART_RX_BUF_SIZE 100
typedef enum{    UsartReceiveWaitHead0, 
                UsartReceiveWaitHead1,
                UsartReceiveWaitMsgType,
                UsartReceiveWaitLength, 
                UsartReceiveWaitCMD,
                UsartReceiveWaitIndex,
                UsartReceiveWaitDataLen,
                UsartReceiveWaitData,
                UsartReceiveWaitChecksum
}UsartRecvPackState;
uint8_t mUsartReceivePack[100] = {0};
 
void SendComMap(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_PushFrame(send_frame, data_length+9);    
}
u8 flag_usartrecok = 0;
void UsartParseDataHandler(uint8_t data)
{
    static UsartRecvPackState usart_receive_state = UsartReceiveWaitHead0;
    uint16_t checksum = 0;
    static uint8_t pack_datalen = 0,pack_length = 0,pack_index = 0,pack_msgtype = 0,pack_cmd = CMD_READ;
    static uint8_t index = 0;
 
 
    
    if(usart_receive_state == UsartReceiveWaitChecksum) {            //ÈôÊÕµ½Ð£ÑéºÍ°ü
        checksum = 0;
        for(int i = 0; i<pack_length-5; i++) { 
            checksum += mUsartReceivePack[i];
        }
        checksum += pack_cmd;
        checksum += pack_length;
        checksum += pack_index;
        checksum += pack_datalen;
        checksum += pack_msgtype;
        if((data + checksum)&0xff == 0xFF)                //УÑéͨ¹ý
        {
            switch(pack_cmd)
            {
                case CMD_WRITE:
                    //´ÓmUsartReceivePackÖжÁÈ¡pack_length³¤¶ÈµÄ×Ö½Ú£¬·Åµ½È«¾Ö±äÁ¿ÖÐ
                    memcpy((uint8_t*)&g_com_map + pack_index, mUsartReceivePack, pack_datalen);
                    //·µ»ØÒ»¸öerror״̬
                    //SendComMap(pack_datalen,pack_index);
                    save_com_map_to_flash();
                    delay_ms(100);
                    NVIC_SystemReset();
                    break;
                case CMD_READ:
                    //read°üÖÐdata×Ö½Ú£¬¼´mUsartReceivePack[0]±íʾÊý¾Ý³¤¶È£»
                //´Óg_com_data½á¹¹ÌåÖеĵÚindexλÖöÁÈ¡³¤¶ÈΪmUsartReceivePack[0]µÄ×Ö½Ú£¬·¢ËͳöÀ´
                    SendComMap(pack_datalen,pack_index>>1);        
                    break;
                case CMD_SMTTEST:
                    flag_usartrecok = 1;
                    break;
                default:
                    break;
            }
        }
        usart_receive_state = UsartReceiveWaitHead0;
        pack_index = 0;
        pack_length = 0;
        index=0;
    } else if((usart_receive_state == UsartReceiveWaitData) ) {    //Èô¹ûÊÕµ½µÄÊÇÕý³£Í¨Ñ¶°ü
        mUsartReceivePack[index] = data;
        index++;
        if(index == pack_length-5) {        //Èç¹ûÊÕµ½µÄindexÓ볤¶ÈÏàµÈ
            usart_receive_state = UsartReceiveWaitChecksum;
        }
    } else if(usart_receive_state == UsartReceiveWaitDataLen) {                        //ÊÕµ½Ö¸ÁîÀàÐÍ×Ö½Ú
        pack_datalen = data;
        usart_receive_state = UsartReceiveWaitData;
    }else if(usart_receive_state == UsartReceiveWaitIndex) {                        //ÊÕµ½Ö¸ÁîÀàÐÍ×Ö½Ú
        pack_index = data;
        usart_receive_state = UsartReceiveWaitDataLen;
    } else if(usart_receive_state == UsartReceiveWaitCMD) {                            //ÊÕµ½Ö¸ÁîÀàÐÍ×Ö½Ú
        pack_cmd = data;
        usart_receive_state = UsartReceiveWaitIndex;
    } else if(usart_receive_state == UsartReceiveWaitLength) {                        //ÊÕµ½³¤¶È×Ö½Ú
        
            pack_length = data;
            pack_index = 0;            
            usart_receive_state = UsartReceiveWaitCMD;
        
    } else if((usart_receive_state == UsartReceiveWaitHead0) && (data == 0x55)) {    //ÊÕµ½µÚÒ»¸ö°üÍ·
        usart_receive_state = UsartReceiveWaitHead1;
    } else if((usart_receive_state == UsartReceiveWaitHead1) && (data == 0xAA)) {    //ÊÕµ½µÚ¶þ¸ö°üÍ·
        usart_receive_state = UsartReceiveWaitMsgType;
    }else if ((usart_receive_state == UsartReceiveWaitMsgType) && (data == 0x3)) {
        usart_receive_state = UsartReceiveWaitLength;
        pack_msgtype = data;
    }
    else {
        usart_receive_state = UsartReceiveWaitHead0;
        pack_index = 0;
        pack_length = 0;
    }
 
}