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
|
#include <code_pattern.h>
#define RESERVE_MAC 8
#define PER_MAC_LEN 18 // contain '\0'
#define RESERVE_EOU_KEY 5
#define PER_EOU_KEY_LEN 522 // 8+256+258
#define RESERVE_SN 8
#define PER_SN_LEN 20
#define PMON_MAC_START_ADDRESS 0x2000
#define PMON_VER_START_ADDRESS 0x2100
#define CFE_MAC_START_ADDRESS 0x1E00
#define CFE_VER_START_ADDRESS 0x1F00
#define CFE_EOU_KEY_START_ADDRESS 0x3F400 // 256K-3K
#define CFE_SN_START_ADDRESS 0x3FE32 // 256K-3K+(522*8)
#define CFI_FLASH_OP //Lili add to write mac with CFI method
#define NOT_NULL(var,m,c) ( \
var[m] != c && var[m+1] != c && var[m+2] != c && var[m+3] != c && var[m+4] != c && var[m+5] != c \
)
#define IS_NULL(var,m,c) ( \
var[m] == c && var[m+1] == c && var[m+2] == c && var[m+3] == c && var[m+4] == c && var[m+5] == c \
)
static INLINE int
IS_CNULL(unsigned char *var, int m, unsigned char c, int len) {
int i;
for(i=0 ; i<len ; i++) {
if( var[m+i] != c )
return 0;
}
return 1;
}
static INLINE int
NOT_CNULL(unsigned char *var, int m, unsigned char c, int len) {
int i;
for(i=0 ; i<len ; i++) {
if( var[m+i] != c )
return 1;
}
return 0;
}
#define MAC_ADD(mac) ({\
int i,j; \
unsigned char m[6]; \
/* sscanf(mac,"%x:%x:%x:%x:%x:%x",&m[0],&m[1],&m[2],&m[3],&m[4],&m[5]); will error */ \
for(j=0,i=0 ; i<PER_MAC_LEN ; i+=3,j++) { \
if(mac[i] >= 'A' && mac[i] <= 'F') mac[i] = mac[i] - 55;\
if(mac[i+1] >= 'A' && mac[i+1] <= 'F') mac[i+1] = mac[i+1] - 55;\
if(mac[i] >= 'a' && mac[i] <= 'f') mac[i] = mac[i] - 87;\
if(mac[i+1] >= 'a' && mac[i+1] <= 'f') mac[i+1] = mac[i+1] - 87;\
if(mac[i] >= '0' && mac[i] <= '9') mac[i] = mac[i] - 48;\
if(mac[i+1] >= '0' && mac[i+1] <= '9') mac[i+1] = mac[i+1] - 48;\
m[j] = mac[i]*16 + mac[i+1]; \
} \
for(i=5 ; i>=3 ; i--){ \
if( m[i] == 0xFF) { m[i] = 0x0; continue; } \
else { m[i] = m[i] + 1; break; } \
} \
sprintf(mac,"%02X:%02X:%02X:%02X:%02X:%02X",m[0],m[1],m[2],m[3],m[4],m[5]); \
})
|
