LGT8F328 在 Arduino 下使TEA加密解密

eddiewwm

在網上看到一篇很好的 TEA 加密文章，把它移植到Arduino上跟大家分享。

1. /*******************
   
2.   TEA加密解密演算法
   
3.   Refeerence: http://www.51hei.com/bbs/dpj-137887-1.html
   
4. *******************/
   
5. #define DATA_LEN 32
   
6. 
   
7. #define MX (z>>5^y<<2)+(y>>3^z<<4)^(sum^y)+(k[p&3^e]^z)
   
8. #define DELTA 0x9e3779b9
   
9. #define S_LOOPTIME   1           //5
   
10. #define BLOCK_SIZE   DATA_LEN    //PAGE_SIZE,根據你所要加密的資料包長度修改此參數(單位:位元組)
    
11. 
    
12. unsigned char TEA_key[16] =
    
13. {
    
14.   0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08,
    
15.   0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, 0x10
    
16. };
    
17. 
    
18. //數據緩衝區
    
19. unsigned char TX_buffer[DATA_LEN];
    
20. unsigned char RX_buffer[DATA_LEN];
    
21. 
    
22. 
    
23. /*加密時使用函數, buf裡面的內容就是加密後的資料，key是加密金鑰*/
    
24. void btea_encrypt( unsigned char* buf, unsigned char* key )
    
25. {
    
26.   unsigned char  n = BLOCK_SIZE / 4;
    
27.   unsigned long *v = (unsigned long *)buf;
    
28.   unsigned long *k = (unsigned long *)key;
    
29.   unsigned long z = v[n - 1], y = v[0], sum = 0, e ;
    
30.   unsigned char p, q ;
    
31.   // Coding Part
    
32. 
    
33.   q = S_LOOPTIME + 52 / n ;
    
34.   while ( q-- > 0 )
    
35.   {
    
36.     sum += DELTA ;
    
37.     e = sum >> 2 & 3 ;
    
38.     for ( p = 0 ; p < n - 1 ; p++ )
    
39.     {
    
40.       y = v[p + 1];
    
41.       z = v[p] += MX;
    
42.     }
    
43.     y = v[0] ;
    
44.     z = v[n - 1] += MX;
    
45.   }
    
46. }
    
47. 
    
48. /*解密時使用函數, buf裡面的內容就是解密後的資料，key是解密金鑰*/
    
49. void btea_decrpyt( unsigned char* buf, unsigned char* key )
    
50. {
    
51.   unsigned char n = BLOCK_SIZE / 4;
    
52.   unsigned long *v = (unsigned long *)buf;
    
53.   unsigned long *k = (unsigned long *)key;
    
54.   unsigned long z = v[n - 1], y = v[0], sum = 0, e ;
    
55.   unsigned char  p, q ;
    
56. 
    
57.   //Decoding Part...
    
58.   q = S_LOOPTIME + 52 / n ;
    
59.   sum = q * DELTA ;
    
60.   while ( sum != 0 )
    
61.   {
    
62.     e = sum >> 2 & 3 ;
    
63.     for ( p = n - 1 ; p > 0 ; p-- )
    
64.     {
    
65.       z = v[p - 1];
    
66.       y = v[p] -= MX;
    
67.     }
    
68.     z = v[n - 1] ;
    
69.     y = v[0] -= MX;
    
70.     sum -= DELTA ;
    
71.   }
    
72. }
    
73. /************************************************************************************************************/
    
74. void CreateBUF(unsigned char *buf)
    
75. {
    
76.   int i = 0;
    
77. 
    
78.   for (i = 0; i < DATA_LEN; i++)
    
79.   {
    
80.     buf[i] = rand() % 255;
    
81.   }
    
82. }
    
83. 
    
84. void Trans(unsigned char *buf1, unsigned char *buf2)
    
85. {
    
86.   int i = 0;
    
87. 
    
88.   for (i = 0; i < DATA_LEN; i++)
    
89.   {
    
90.     buf2[i] = buf1[i];
    
91.   }
    
92. }
    
93. 
    
94. void DIS(unsigned char sts, unsigned char*buf)
    
95. {
    
96.   int i = 0;
    
97. 
    
98.   Serial.print("\n");
    
99.   switch (sts)
    
100.   {
     
101.     case 0:        Serial.print("實際發送陣列:");        break;
     
102.     case 1:        Serial.print("加密資料陣列:");        break;
     
103.     case 2:        Serial.print("實際接收陣列:");        break;
     
104.     default:        break;
     
105.   }
     
106.   for (i = 0; i < DATA_LEN; i++)
     
107.   {
     
108.     Serial.print(buf[i]);
     
109.   }
     
110.   Serial.print("\n");
     
111. }
     
112. 
     
113. 
     
114. 
     
115. void setup() {
     
116.   // put your setup code here, to run once:
     
117.   Serial.begin(57600);
     
118. 
     
119. }
     
120. 
     
121. void loop() {
     
122.   // put your main code here, to run repeatedly:
     
123.   //srand((time(NULL)));
     
124.   CreateBUF(TX_buffer);                    //生成一組亂數
     
125.   DIS(0, TX_buffer);                       //顯示實際資料
     
126. 
     
127.   btea_encrypt(TX_buffer, TEA_key);        //發送陣列加密
     
128.   DIS(1, TX_buffer);                       //顯示加密後的資料
     
129. 
     
130.   Trans(TX_buffer, RX_buffer);             //類比通道
     
131.   btea_decrpyt(RX_buffer, TEA_key);        //接收陣列解密
     
132.   DIS(2, RX_buffer);                       //顯示接收資料
     
133.   //  return 0;
     
134. 
     
135. while(1){};
     
136. }
     

复制代码

輸出的結果