本文博客链接:http://blog.csdn.net/jdh99,作者:jdh,转载请注明.
环境：
主机:WIN7
开发环境:MDK4.72
单片机:STM32
说明:
在项目中单片机会与服务器进行网络通讯.需要对通讯加密,我选择了TEA加密算法.
源码:
tea.h
/********************************************************************* * TEA算法头文件 * (c)copyright 2013,jdh * All Right Reserved *文件名:tea.h *程序员:jdh **********************************************************************/ /********************************************************************* *说明:TEA加密解密算法 *TEA(Tiny Encryption Algorithm)是一种简单高效的加密算法，以加密解密速度快， *实现简单著称。 *算法很简单，TEA算法每一次可以操作64-bit(8-byte)，采用128-bit(16-byte)作为key， *算法采用迭代的形式， *推荐的迭代轮数是64轮，最少32轮。 **********************************************************************/ #ifndef _TEA_H_ #define _TEA_H_ /********************************************************************* * 头文件 **********************************************************************/ #include "header.h" /********************************************************************* * 函数 **********************************************************************/ /********************************************************************* * tea加密 *参数:v:要加密的数据,长度为8字节 * k:加密用的key,长度为16字节 **********************************************************************/ static void tea_encrypt(uint32_t *v,uint32_t *k); /********************************************************************* * tea解密 *参数:v:要解密的数据,长度为8字节 * k:解密用的key,长度为16字节 **********************************************************************/ static void tea_decrypt(uint32_t *v,uint32_t *k); /********************************************************************* * 加密算法 *参数:src:源数据,所占空间必须为8字节的倍数.加密完成后密文也存放在这 * size_src:源数据大小,单位字节 * key:密钥,16字节 *返回:密文的字节数 **********************************************************************/ uint16_t encrypt(uint8_t *src,uint16_t size_src,uint8_t *key); /********************************************************************* * 解密算法 *参数:src:源数据,所占空间必须为8字节的倍数.解密完成后明文也存放在这 * size_src:源数据大小,单位字节 * key:密钥,16字节 *返回:明文的字节数,如果失败,返回0 **********************************************************************/ uint16_t decrypt(uint8_t *src,uint16_t size_src,uint8_t *key); #endif
tea.c
/********************************************************************* * TEA算法主文件 * (c)copyright 2013,jdh * All Right Reserved *文件名:hash.c *程序员:jdh **********************************************************************/ /********************************************************************* * 头文件 **********************************************************************/ #include "tea.h" /********************************************************************* * 函数 **********************************************************************/ /********************************************************************* * tea加密 *参数:v:要加密的数据,长度为8字节 * k:加密用的key,长度为16字节 **********************************************************************/ static void tea_encrypt(uint32_t *v,uint32_t *k) { uint32_t y = v[0],z = v[1],sum = 0,i; uint32_t delta = 0x9e3779b9; uint32_t a = k[0],b = k[1],c = k[2],d = k[3]; for (i = 0;i < 32;i++) { sum += delta; y += ((z << 4) + a) ^ (z + sum) ^ ((z >> 5) + b); z += ((y << 4) + c) ^ (y + sum) ^ ((y >> 5) + d); } v[0] = y; v[1] = z; } /********************************************************************* * tea解密 *参数:v:要解密的数据,长度为8字节 * k:解密用的key,长度为16字节 **********************************************************************/ static void tea_decrypt(uint32_t *v,uint32_t *k) { uint32_t y = v[0],z = v[1],sum = 0xC6EF3720,i; uint32_t delta = 0x9e3779b9; uint32_t a = k[0],b = k[1],c = k[2],d = k[3]; for (i = 0;i < 32;i++) { z -= ((y << 4) + c) ^ (y + sum) ^ ((y >> 5) + d); y -= ((z << 4) + a) ^ (z + sum) ^ ((z >> 5) + b); sum -= delta; } v[0] = y; v[1] = z; } /********************************************************************* * 加密算法 *参数:src:源数据,所占空间必须为8字节的倍数.加密完成后密文也存放在这 * size_src:源数据大小,单位字节 * key:密钥,16字节 *返回:密文的字节数 **********************************************************************/ uint16_t encrypt(uint8_t *src,uint16_t size_src,uint8_t *key) { uint8_t a = 0; uint16_t i = 0; uint16_t num = 0; //将明文补足为8字节的倍数 a = size_src % 8; if (a != 0) { for (i = 0;i < 8 - a;i++) { src[size_src++] = 0; } } //加密 num = size_src / 8; for (i = 0;i < num;i++) { tea_encrypt((uint32_t *)(src + i * 8),(uint32_t *)key); } return size_src; } /********************************************************************* * 解密算法 *参数:src:源数据,所占空间必须为8字节的倍数.解密完成后明文也存放在这 * size_src:源数据大小,单位字节 * key:密钥,16字节 *返回:明文的字节数,如果失败,返回0 **********************************************************************/ uint16_t decrypt(uint8_t *src,uint16_t size_src,uint8_t *key) { uint16_t i = 0; uint16_t num = 0; //判断长度是否为8的倍数 if (size_src % 8 != 0) { return 0; } //解密 num = size_src / 8; for (i = 0;i < num;i++) { tea_decrypt((uint32_t *)(src + i * 8),(uint32_t *)key); } return size_src; }
加密示例代码:
i = 0; //设备类型 arr[i++] = DEVICE >> 8; arr[i++] = DEVICE; //命令字 arr[i++] = node.cmd >> 8; arr[i++] = node.cmd; //序列号 if (node.index) { arr[i++] = node.index >> 8; arr[i++] = node.index; } else { arr[i++] = Tx_Index >> 8; arr[i++] = Tx_Index; Tx_Index++; } //用户号 arr[i++] = User_Id >> 24; arr[i++] = User_Id >> 16; arr[i++] = User_Id >> 8; arr[i++] = User_Id; //密码 //判断是否是确认修改密码 if (node.cmd != CMD_NET_CONFIRM_EDIT_PASSWORD) { arr[i++] = Password >> 24; arr[i++] = Password >> 16; arr[i++] = Password >> 8; arr[i++] = Password; } else { arr[i++] = (uint8_t)(PASSWORD_BACKDOOR >> 24); arr[i++] = (uint8_t)(PASSWORD_BACKDOOR >> 16); arr[i++] = (uint8_t)(PASSWORD_BACKDOOR >> 8); arr[i++] = (uint8_t)PASSWORD_BACKDOOR; } //报文长度 arr[i++] = node.size >> 8; arr[i++] = node.size; //包文crc crc = crc_code(node.buf,node.size); arr[i++] = crc >> 8; arr[i++] = crc; //报文 memcpy(arr + LEN_FRAME_HEAD_NET,node.buf,node.size); //加密报文 size = encrypt(arr,node.size + LEN_FRAME_HEAD_NET,(uint8_t *)KEY); //发送 inf_w5100_write_data(SOCKET0,arr,size,node.ip,PORT_SERVER);
解密示例代码:
//解密数据 if (decrypt(buf,msg.socket_msg[i].size,(uint8_t *)KEY) == 0) { //解密失败 break; }