lmx/99_7018_lmx
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
Files
141b538bf5a669d6b24f911f31671279132270f0
99_7018_lmx/apps/earphone/94_rfid_stc/decode_printcipher.c

614 lines
20 KiB
C
Raw Normal View History

cun
2025-12-01 10:01:10 +08:00
#include <stdio.h>
#include "print.h"
#include "READER.h"
#include "random_generator.h"
unsigned char ciphertext_to_binary[48] ; //用来存储算法逆运算每轮的中间数据 需要定义成全局变量
unsigned char lsfr[48];
unsigned char lsfr_length;
unsigned char decode_printcipher( unsigned char ciphertext[] , unsigned char long_key[] , unsigned char short_key[] )//解密函数
{
unsigned char a[6][8];
unsigned char i , j ;
unsigned char t ;
unsigned char k ; //k是用在sbox中的
unsigned char num ; //主循环
unsigned char long_key_to_binary[48] ;
unsigned char temp[48] ;
unsigned char short_key_to_binary[32] ;
unsigned char rev_counter[6] = {1,0,0,1,0,0};
unsigned char temp_rev_counter[6];
//----------------------------------ciphertext-------------------------------------------------//
for(i=0 ; i<6 ; ++i) //
{ //
for(j=0 ; j<8 ; ++j) //
{ // 该作用是把密文以二进制保存在数组中ciphertext
a[i][8-1-j] = ciphertext[i] % 2 ; // a[7]应该是二进制最低位，a[0]最高位
ciphertext[i] /= 2 ; //
} //
} //
for(i=0 ; i<6 ; ++i)
{
for(j=0 ; j<8 ; ++j)
{
ciphertext_to_binary[i*8+j] = a[i][j] ;
}
}
//printf("%x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x \n",ciphertext_to_binary[0],ciphertext_to_binary[1],ciphertext_to_binary[2],\
ciphertext_to_binary[3],ciphertext_to_binary[4],ciphertext_to_binary[5],ciphertext_to_binary[6],ciphertext_to_binary[7],\
ciphertext_to_binary[40],ciphertext_to_binary[41],ciphertext_to_binary[42],ciphertext_to_binary[43],ciphertext_to_binary[44],ciphertext_to_binary[45],ciphertext_to_binary[46],ciphertext_to_binary[47]);
//-------------------------------------ciphertext---------------------------------------------//
//-------------------------------------long_key----------------------------------------------//
for(i=0 ; i<6 ; ++i) //
{ //
for(j=0 ; j<8 ; ++j) //
{ // 该作用是把密文以二进制保存在数组中long_key
a[i][8-1-j] = long_key[i] % 2 ; //
long_key[i] /= 2; //
} //
} //
for(i=0 ; i<6 ; ++i)
{
for(j=0 ; j<8 ; ++j)
{
long_key_to_binary[i*8+j] = a[i][j] ;
}
}
//printf("%x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x \n",long_key_to_binary[0],long_key_to_binary[1],long_key_to_binary[2],\
long_key_to_binary[3],long_key_to_binary[4],long_key_to_binary[5],long_key_to_binary[6],long_key_to_binary[7],\
long_key_to_binary[40],long_key_to_binary[41],long_key_to_binary[42],long_key_to_binary[43],long_key_to_binary[44],long_key_to_binary[45],long_key_to_binary[46],ciphertext_to_binary[47]);
//-------------------------------- long_key---------------------------------------------------//
//-------------------------------- short_key-------------------------------------------------//
for(i=0 ; i<4 ; ++i) //
{ //
for(j=0 ; j<8 ; ++j) //
{ // 该作用是把密文以二进制保存在数组中short_key
a[i][8-1-j] = short_key[i] % 2 ; //
short_key[i] /= 2 ; //
} //
} //
for(i=0 ; i<4 ; ++i)
{
for(j=0 ; j<8 ; ++j)
{
short_key_to_binary[i*8+j] = a[i][j] ;
}
}
//printf("%x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x \n",short_key_to_binary[0],short_key_to_binary[1],short_key_to_binary[2],\
short_key_to_binary[3],short_key_to_binary[4],short_key_to_binary[5],short_key_to_binary[6],short_key_to_binary[7],\
short_key_to_binary[24],short_key_to_binary[25],short_key_to_binary[26],short_key_to_binary[27],short_key_to_binary[28],short_key_to_binary[29],short_key_to_binary[30],short_key_to_binary[31]);
//-------------------------------- short_key-------------------------------------------------//
for(num = 0 ; num < 48 ; num++)
{
for(k=0 ; k<16 ; k++)
{
if((short_key_to_binary[k*2]==0) &&(short_key_to_binary[k*2+1]==0) )
{
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
}
//////////////////////////////01
if((short_key_to_binary[k*2]==0) &&(short_key_to_binary[k*2+1]==1) )
{
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
}
//////////////////////////////////////////10
if((short_key_to_binary[k*2]==1) &&(short_key_to_binary[k*2+1]==0) )
{
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
}
////////////////////////////////////////////11
if((short_key_to_binary[k*2]==1) &&(short_key_to_binary[k*2+1]==1) )
{
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==0) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==0)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 1;
temp[k*3+2]= 1;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==0))
{
temp[k*3] = 1;
temp[k*3+1]= 1;
temp[k*3+2]= 0;
}
if((ciphertext_to_binary[k*3]==1) && (ciphertext_to_binary[k*3+1]==1)&&(ciphertext_to_binary[k*3+2]==1))
{
temp[k*3] = 0;
temp[k*3+1]= 0;
temp[k*3+2]= 1;
}
}
}
// printf("%x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x \n",temp[0],temp[1],temp[2],temp[3],temp[4],temp[5],temp[6],temp[7],temp[8],temp[9],temp[10],temp[11],temp[12],temp[13],temp[14],temp[15],temp[40],temp[41],temp[42],temp[43],temp[44],temp[45],temp[46],temp[47]);
//下面的函数是对RC的逆运算
t = 1 ^ rev_counter[0] ^ rev_counter[5];
temp_rev_counter [0] = rev_counter[1] ;
temp_rev_counter [1] = rev_counter[2] ;
temp_rev_counter [2] = rev_counter[3] ;
temp_rev_counter [3] = rev_counter[4] ;
temp_rev_counter [4] = rev_counter[5] ;
temp_rev_counter [5] = t ;
for(i=0 ; i<6 ; i++ )
{
rev_counter [i] = temp_rev_counter[i] ; //rev_counter[5]是最高位
}
temp[47] = rev_counter[0] ^ temp[47] ;
temp[46] = rev_counter[1] ^ temp[46] ;
temp[45] = rev_counter[2] ^ temp[45] ;
temp[44] = rev_counter[3] ^ temp[44] ;
temp[43] = rev_counter[4] ^ temp[43] ;
temp[42] = rev_counter[5] ^ temp[42] ;
// printf("%x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x %x \n",temp[0],temp[1],temp[2],temp[3],temp[4],temp[5],temp[6],temp[7],temp[8],temp[9],temp[10],temp[11],temp[12],temp[13],temp[14],temp[15],temp[40],temp[41],temp[42],temp[43],temp[44],temp[45],temp[46],temp[47]);
//下面是对linear diffusion的逆运算
ciphertext_to_binary[0] = temp[0] ;
ciphertext_to_binary[1] = temp[3] ;
ciphertext_to_binary[2] = temp[6] ;
ciphertext_to_binary[3] = temp[9] ;
ciphertext_to_binary[4] = temp[12] ;
ciphertext_to_binary[5] = temp[15] ;
ciphertext_to_binary[6] = temp[18] ;
ciphertext_to_binary[7] = temp[21] ;
ciphertext_to_binary[8] = temp[24] ;
ciphertext_to_binary[9] = temp[27] ;
ciphertext_to_binary[10] = temp[30] ;
ciphertext_to_binary[11] = temp[33] ;
ciphertext_to_binary[12] = temp[36] ;
ciphertext_to_binary[13] = temp[39] ;
ciphertext_to_binary[14] = temp[42] ;
ciphertext_to_binary[15] = temp[45] ;
ciphertext_to_binary[16] = temp[1] ;
ciphertext_to_binary[17] = temp[4] ;
ciphertext_to_binary[18] = temp[7] ;
ciphertext_to_binary[19] = temp[10] ;
ciphertext_to_binary[20] = temp[13] ;
ciphertext_to_binary[21] = temp[16] ;
ciphertext_to_binary[22] = temp[19] ;
ciphertext_to_binary[23] = temp[22] ;
ciphertext_to_binary[24] = temp[25] ;
ciphertext_to_binary[25] = temp[28] ;
ciphertext_to_binary[26] = temp[31] ;
ciphertext_to_binary[27] = temp[34] ;
ciphertext_to_binary[28] = temp[37] ;
ciphertext_to_binary[29] = temp[40] ;
ciphertext_to_binary[30] = temp[43] ;
ciphertext_to_binary[31] = temp[46] ;
ciphertext_to_binary[32] = temp[2] ;
ciphertext_to_binary[33] = temp[5] ;
ciphertext_to_binary[34] = temp[8] ;
ciphertext_to_binary[35] = temp[11] ;
ciphertext_to_binary[36] = temp[14] ;
ciphertext_to_binary[37] = temp[17] ;
ciphertext_to_binary[38] = temp[20] ;
ciphertext_to_binary[39] = temp[23] ;
ciphertext_to_binary[40] = temp[26] ;
ciphertext_to_binary[41] = temp[29] ;
ciphertext_to_binary[42] = temp[32] ;
ciphertext_to_binary[43] = temp[35] ;
ciphertext_to_binary[44] = temp[38] ;
ciphertext_to_binary[45] = temp[41] ;
ciphertext_to_binary[46] = temp[44] ;
ciphertext_to_binary[47] = temp[47] ;
for(i=0 ; i<48 ; i++)
{
ciphertext_to_binary[i] = ciphertext_to_binary[i] ^ long_key_to_binary[i] ;
}
}
// printf (" %x %x %x %x %x %x %x %x\n %x %x %x %x %x %x %x %x\n %x %x %x %x %x %x %x %x\n %x %x %x %x %x %x %x %x\n %x %x %x %x %x %x %x %x\n %x %x %x %x %x %x %x %x\n",ciphertext_to_binary[0],ciphertext_to_binary[1],ciphertext_to_binary[2],ciphertext_to_binary[3],ciphertext_to_binary[4],ciphertext_to_binary[5],ciphertext_to_binary[6],ciphertext_to_binary[7],\
ciphertext_to_binary[8],ciphertext_to_binary[9],ciphertext_to_binary[10],ciphertext_to_binary[11],ciphertext_to_binary[12],ciphertext_to_binary[13],ciphertext_to_binary[14],ciphertext_to_binary[15],\
ciphertext_to_binary[16],ciphertext_to_binary[17],ciphertext_to_binary[18],ciphertext_to_binary[19],ciphertext_to_binary[20],ciphertext_to_binary[21],ciphertext_to_binary[22],ciphertext_to_binary[23],\
ciphertext_to_binary[24],ciphertext_to_binary[25],ciphertext_to_binary[26],ciphertext_to_binary[27],ciphertext_to_binary[28],ciphertext_to_binary[29],ciphertext_to_binary[30],ciphertext_to_binary[31],\
ciphertext_to_binary[32],ciphertext_to_binary[33],ciphertext_to_binary[34],ciphertext_to_binary[35],ciphertext_to_binary[36],ciphertext_to_binary[37],ciphertext_to_binary[38],ciphertext_to_binary[39],\
ciphertext_to_binary[40],ciphertext_to_binary[41],ciphertext_to_binary[42],ciphertext_to_binary[43],ciphertext_to_binary[44],ciphertext_to_binary[45],ciphertext_to_binary[46],ciphertext_to_binary[47] );
return 0 ;
}
void Print_AUTH(unsigned char *key,unsigned char *TOKEN,unsigned char *rece_buff)//print 认证
{
unsigned char i,j;
unsigned char long_key[6] = {0xff,0xff,0xff,0xff,0xff,0xff}; //长key
unsigned char short_key[4] = {0xff,0xff,0xff,0xff}; //短key，注意短key的最后一个字节是整个key的第一个字节
unsigned char PWD_key[10] = {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00};//tag的秘钥占10个字节
for(i = 0;i<10;i++)
{
PWD_key[i] = key[9-i];//需要把PWD 倒顺序一下,做下反向,需要特别注意，之前的密码需要倒序一下
}
memcpy(&long_key[0],PWD_key,6);
memcpy(&short_key[0],&PWD_key[6],4);
decode_printcipher(TOKEN, &long_key[0] , &short_key[0]);
for(i=0 ; i<6 ; i++)
{
for(j=0 ; j<8 ; j++)
{
rece_buff[i] = (rece_buff[i]<<1)+ciphertext_to_binary[i*8+j] ; //把最终的结果赋值给明文中
}
}
}
unsigned char lsfr_fm458(void) //length 这里是byte
{
char j ;
unsigned char temp;
unsigned char temp1;
temp1 = lsfr[47];
temp = lsfr[47] ^ lsfr[27] ^ lsfr[26] ^ lsfr[0];
for (j = 46; j >= 0; j--)
{
lsfr[j + 1] = lsfr[j];
}
lsfr[0] = temp;
return temp1;
}
void lsfr_init(unsigned char *S022_Token2)
{
unsigned char z,k;
unsigned char load_key[6];
//备份初始密钥流
memcpy(load_key, S022_Token2, 6);
//把R2和R3的结果加载进移位寄存器
for (z = 0; z < 6; z++)
{
for (k = 0; k <= 7; k++)
{
if ((unsigned char)((load_key[z] << k) & 0x80) == 0)
lsfr[47 - (k + z * 8)] = 0;
else
lsfr[47 - (k + z * 8)] = 1;
}
}
//lsfr_length = 48;
//printf("lsfr = %x%x%x%x%x%x%x%x\r\n",lsfr[0],lsfr[1],lsfr[2],lsfr[3],lsfr[4],lsfr[5],lsfr[6],lsfr[7]);
}
//data_len 最多16byte
//unsigned char PRINT_Calc_sendData(unsigned char *data_buf, unsigned char data_len, BOOL half_byte)
unsigned char PRINT_Calc_sendData(unsigned char *data_buf, unsigned char data_len)
{
unsigned char i,y;
unsigned char round;
unsigned char temp[8];
unsigned char temp1[8];
unsigned char encry[64];
unsigned char senddata[16];
round = data_len * 8;
for (y = 0; y < round; y++)
{
encry[y] = lsfr_fm458();
}
for (y = 0; y < data_len; y++)
{
for(i=0; i<8; i++)
{
temp[i] = (unsigned char)((data_buf[y] >> i) & 0x01);
}
//发送的byte按位异或 加密
for(i=0 ; i<8 ;i++)
{
temp1[i] = temp[i] ^ encry[i + y * 8]; //异或就是和密码流进行加密
}
senddata[y] = (unsigned char)(temp1[0] * 1 + temp1[1] * 2 + temp1[2] * 4 + temp1[3] * 8 + temp1[4] * 16 + temp1[5] * 32 + temp1[6] * 64 + temp1[7] * 128);
}
memcpy(data_buf, senddata, data_len);
// authstat = CAL_COMMAND_FLOW;
return SUCCESS;
}
//unsigned char PRINT_Calc_recvData(unsigned char *data_buf, unsigned char data_len, BOOL half_byte)
unsigned char PRINT_Calc_recvData(unsigned char *data_buf, unsigned char data_len)
{
unsigned char encry[128];
unsigned char i,y;
unsigned char temp[8];
unsigned char temp1[8];
unsigned char recvdata[16];
unsigned char round;
round = (data_len) * 8;
if (data_len == 0x01) //该添加为了类似写指令回发ACK等4bit的加密流方法。
{
round = round / 2;
}
for (y = 0; y < round; y++)
{
encry[y] = lsfr_fm458();
}
//已经有了加密数据，就要想办法进行异或操作
for (y = 0; y < data_len; y++)
{
for (i = 0; i < 8; i++)
{
temp[i] = (unsigned char)((data_buf[y] >> i) & 0x01);
}
//发送的byte按位异或 加密
for (i = 0; i < 8; i++)
{
temp1[i] = temp[i] ^ encry[i + y * 8]; //异或就是和密码流进行加密
}
recvdata[y] = (unsigned char)(temp1[0] * 1 + temp1[1] * 2 + temp1[2] * 4 + temp1[3] * 8 + temp1[4] * 16 + temp1[5] * 32 + temp1[6] * 64 + temp1[7] * 128);
}
memcpy(data_buf, recvdata, data_len);
return SUCCESS;
}
Reference in New Issue Copy Permalink