加密函數:
btea_encrypt(T_buffer, TEA_key );
TX_buffer是需要發送的數據，經過該函數后，TX_buffer便是加密后的數據。
解密函數:
btea_decrpyt(RX_buffer, TEA_key);
RX_buffer是接收到的加密數據，經過該函數，RX_buffer便是解密后的數據(即實際傳輸數據)
BLOCK_SIZE 要和數據長度相等
單片機源程序如下:
- #include <stdio.h>
- #include <stdlib.h>
- #include <time.h>
- /*******************
- TEA加密解密算法
- *******************/
- #define DATA_LEN 32
- #define MX (z>>5^y<<2)+(y>>3^z<<4)^(sum^y)+(k[p&3^e]^z)
- #define DELTA 0x9e3779b9
- #define S_LOOPTIME 1 //5
- #define BLOCK_SIZE DATA_LEN //PAGE_SIZE,根據你所要加密的數據包長度修改此參數(單位:字節)
- unsigned char TEA_key[16]=
- {
- 0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,
- 0x09,0x0A,0x0B,0x0C,0x0D,0x0E,0x0F,0x10
- };
- //數據緩沖區
- unsigned char TX_buffer[DATA_LEN];
- unsigned char RX_buffer[DATA_LEN];
- /*加密時使用函數, buf里面的內容就是加密后的數據，key是加密密鑰*/
- void btea_encrypt( unsigned char* buf, unsigned char* key )
- {
- unsigned char n=BLOCK_SIZE/4;
- unsigned long *v=(unsigned long *)buf;
- unsigned long *k=(unsigned long *)key;
- unsigned long z = v[n - 1],y = v[0],sum = 0,e ;
- unsigned char p,q ;
- // Coding Part
- q = S_LOOPTIME + 52 / n ;
- while ( q-- > 0 )
- {
- sum += DELTA ;
- e = sum >> 2 & 3 ;
- for ( p = 0 ; p < n - 1 ; p++ )
- y = v[p + 1],
- z = v[p] += MX;
- y = v[0] ;
- z = v[n - 1] += MX;
- }
- }
- /*解密時使用函數, buf里面的內容就是解密后的數據，key是解密密鑰*/
- void btea_decrpyt( unsigned char* buf, unsigned char* key )
- {
- unsigned char n=BLOCK_SIZE/4;
- unsigned long *v=(unsigned long *)buf;
- unsigned long *k=(unsigned long *)key;
- unsigned long z = v[n - 1],y = v[0],sum = 0,e ;
- unsigned char p,q ;
- //Decoding Part...
- q = S_LOOPTIME + 52 / n ;
- sum = q * DELTA ;
- while ( sum != 0 )
- {
- e = sum >> 2 & 3 ;
- for ( p = n - 1 ; p > 0 ; p-- )
- z = v[p - 1],
- y = v[p] -= MX;
- z = v[n - 1] ;
- y = v[0] -= MX;
- sum -= DELTA ;
- }
- }
- /************************************************************************************************************/
- void CreateBUF(unsigned char *buf)
- {
- int i = 0;
- for (i = 0;i < DATA_LEN; i++)
- {
- buf[i] = rand()%255;
- }
- }
- void Trans(unsigned char *buf1, unsigned char *buf2)
- {
- int i = 0;
- for (i = 0;i < DATA_LEN; i++)
- {
- buf2[i] = buf1[i];
- }
- }
- void DIS(unsigned char sts, unsigned char*buf)
- {
- int i = 0;
-
- printf("\n");
- switch (sts)
- {
- case 0: printf("實際發送數組:"); break;
- case 1: printf("加密數據數組:"); break;
- case 2: printf("實際接收數組:"); break;
- default: break;
- }
- for (i = 0;i < DATA_LEN; i++)
- {
- printf("%d ", buf[i]);
- }
- printf("\n");
- }
- int main(void)
- {
- srand((time(NULL)));
- CreateBUF(TX_buffer); //生成一組隨機數
- DIS(0,TX_buffer); //顯示實際數據
- btea_encrypt(TX_buffer, TEA_key); //發送數組加密
- DIS(1,TX_buffer); //顯示加密后的數據
- Trans(TX_buffer, RX_buffer); //模擬信道
- btea_decrpyt(RX_buffer, TEA_key); //接收數組解密
- DIS(2, RX_buffer); //顯示接收數據
- return 0;
- }
所有資料51hei提供下載:
TEA加密解密.zip
(209.98 KB, 下載次數: 73)
2018-10-16 17:57 上傳
點擊文件名下載附件
TEA加密解密
|
[復制鏈接]
