BXI Protocol data generator 

  1 #include"iostream.h"
  2 #include "string" 
  3 #include <windows.h>
  4 using namespace std; 
  5 
  6 typedef unsigned long u32;
  7 typedef unsigned char u8;
  8 typedef unsigned int u16;
  9 u16 crc_16(u16 crc,  u8 data);
 10 u16 database_task(char*s,int length);
 11 ///10100141b915
 12 int main()
 13 {
 14     int len;
 15     char s[512];
 16     char offset[512];
 17     u16 checksum=0;
 18     HANDLE hOut;
 19     hOut = GetStdHandle(STD_OUTPUT_HANDLE);
 20     //SetConsoleTextAttribute(hOut,10);
 21     cout<<"Designer: Milo lu @ March"<<endl;
 22     while(1)
 23     {
 24         cin>>s;
 25         if((!strcmp(s,"exit"))||(!strcmp(s,"EXIT")))
 26         {
 27             break;
 28         }
 29         len = strlen(s);
 30         if(len%2)        //if not to be a 8bits array, going to rebuild, fill '0' at first.
 31         {
 32             len++;
 33             strncpy(offset,s,len-1);
 34             s[0]=0x30;
 35             for(int i=0;i<len;i++)
 36             {
 37                 s[i+1]=offset[i];
 38             }
 39             s[i]=0;        //NULL end flag
 40         }
 41         checksum = database_task(s,len);
 42         if(checksum==0xffff)
 43         {
 44             continue;
 45         }
 46         cout<<"1010";
 47         cout.fill('0');cout.width(2);cout<<dec<<len/2;
 48         cout.fill('0');cout.width(len);cout<<s;
 49         cout.fill('0');cout.width(4);cout<<hex<<checksum<<endl;
 50     }
 51     return 0;
 52 }
 53 
 54 const unsigned short crc_table[256]={ 
 55         0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50a5, 0x60c6, 0x70e7, 
 56         0x8108, 0x9129, 0xa14a, 0xb16b, 0xc18c, 0xd1ad, 0xe1ce, 0xf1ef, 
 57         0x1231, 0x0210, 0x3273, 0x2252, 0x52b5, 0x4294, 0x72f7, 0x62d6, 
 58         0x9339, 0x8318, 0xb37b, 0xa35a, 0xd3bd, 0xc39c, 0xf3ff, 0xe3de, 
 59         0x2462, 0x3443, 0x0420, 0x1401, 0x64e6, 0x74c7, 0x44a4, 0x5485, 
 60         0xa56a, 0xb54b, 0x8528, 0x9509, 0xe5ee, 0xf5cf, 0xc5ac, 0xd58d, 
 61         0x3653, 0x2672, 0x1611, 0x0630, 0x76d7, 0x66f6, 0x5695, 0x46b4, 
 62         0xb75b, 0xa77a, 0x9719, 0x8738, 0xf7df, 0xe7fe, 0xd79d, 0xc7bc, 
 63         0x48c4, 0x58e5, 0x6886, 0x78a7, 0x0840, 0x1861, 0x2802, 0x3823, 
 64         0xc9cc, 0xd9ed, 0xe98e, 0xf9af, 0x8948, 0x9969, 0xa90a, 0xb92b, 
 65         0x5af5, 0x4ad4, 0x7ab7, 0x6a96, 0x1a71, 0x0a50, 0x3a33, 0x2a12, 
 66         0xdbfd, 0xcbdc, 0xfbbf, 0xeb9e, 0x9b79, 0x8b58, 0xbb3b, 0xab1a, 
 67         0x6ca6, 0x7c87, 0x4ce4, 0x5cc5, 0x2c22, 0x3c03, 0x0c60, 0x1c41, 
 68         0xedae, 0xfd8f, 0xcdec, 0xddcd, 0xad2a, 0xbd0b, 0x8d68, 0x9d49, 
 69         0x7e97, 0x6eb6, 0x5ed5, 0x4ef4, 0x3e13, 0x2e32, 0x1e51, 0x0e70, 
 70         0xff9f, 0xefbe, 0xdfdd, 0xcffc, 0xbf1b, 0xaf3a, 0x9f59, 0x8f78, 
 71         0x9188, 0x81a9, 0xb1ca, 0xa1eb, 0xd10c, 0xc12d, 0xf14e, 0xe16f, 
 72         0x1080, 0x00a1, 0x30c2, 0x20e3, 0x5004, 0x4025, 0x7046, 0x6067, 
 73         0x83b9, 0x9398, 0xa3fb, 0xb3da, 0xc33d, 0xd31c, 0xe37f, 0xf35e, 
 74         0x02b1, 0x1290, 0x22f3, 0x32d2, 0x4235, 0x5214, 0x6277, 0x7256, 
 75         0xb5ea, 0xa5cb, 0x95a8, 0x8589, 0xf56e, 0xe54f, 0xd52c, 0xc50d, 
 76         0x34e2, 0x24c3, 0x14a0, 0x0481, 0x7466, 0x6447, 0x5424, 0x4405, 
 77         0xa7db, 0xb7fa, 0x8799, 0x97b8, 0xe75f, 0xf77e, 0xc71d, 0xd73c, 
 78         0x26d3, 0x36f2, 0x0691, 0x16b0, 0x6657, 0x7676, 0x4615, 0x5634, 
 79         0xd94c, 0xc96d, 0xf90e, 0xe92f, 0x99c8, 0x89e9, 0xb98a, 0xa9ab, 
 80         0x5844, 0x4865, 0x7806, 0x6827, 0x18c0, 0x08e1, 0x3882, 0x28a3, 
 81         0xcb7d, 0xdb5c, 0xeb3f, 0xfb1e, 0x8bf9, 0x9bd8, 0xabbb, 0xbb9a, 
 82         0x4a75, 0x5a54, 0x6a37, 0x7a16, 0x0af1, 0x1ad0, 0x2ab3, 0x3a92, 
 83         0xfd2e, 0xed0f, 0xdd6c, 0xcd4d, 0xbdaa, 0xad8b, 0x9de8, 0x8dc9, 
 84         0x7c26, 0x6c07, 0x5c64, 0x4c45, 0x3ca2, 0x2c83, 0x1ce0, 0x0cc1, 
 85         0xef1f, 0xff3e, 0xcf5d, 0xdf7c, 0xaf9b, 0xbfba, 0x8fd9, 0x9ff8, 
 86         0x6e17, 0x7e36, 0x4e55, 0x5e74, 0x2e93, 0x3eb2, 0x0ed1, 0x1ef0 
 87 }; 
 88 
 89 
 90 /************************************************
 91 function name: crc 16
 92 using e.g.
 93   crc = 0xffff;
 94   for(i=0;i<bytes_length;i++)
 95   {
 96     crc = crc_16(crc,data_bytes_buf[i]);
 97   }
 98   return crc;
 99 ***
100 parameter: crc, data
101 return: crc-16
102 ************************************************/
103 u16 crc_16(u16 crc,  u8 data)
104 { 
105   u8 da;
106   
107   da=(u8)(crc/256);
108   crc<<=8;              //crc=crc*256
109   crc ^= crc_table[da^data];
110   return(crc);
111 }
112 /////10100141b915
113 u16 database_task(char*s,int length)
114 {
115     u16 crc = 0xffff;
116     unsigned char hex[256]={0};
117     for(int i=0;i<length/2;i++)
118     {
119         //high 4bits
120         if((*s>='A')&&('F'>=*s))
121         {
122             hex[i]=*s++ - 0x37;
123             hex[i]<<=4;
124         }
125         else if((*s>='a')&&('f'>=*s))
126         {
127             hex[i]=*s++ - 0x57;
128             hex[i]<<=4;
129         }
130         else if((*s>='0')&&('9'>=*s))
131         {
132             hex[i]=*s++ - 0x30;
133             hex[i]<<=4;
134         }
135         else
136         {
137             cout<<"ERROR"<<endl;    //other char break;
138             crc = 0xffff;
139             break;
140         }
141         //low 4bits
142         if((*s>='A')&&('F'>=*s))
143         {
144             hex[i]|=*s++ - 0x37;
145         }
146         else if((*s>='a')&&('f'>=*s))
147         {
148             hex[i]|=*s++ - 0x57;
149         }
150         else if((*s>='0')&&('9'>=*s))
151         {
152             hex[i]|=*s++ - 0x30;
153         }
154         else
155         {
156             cout<<"ERROR"<<endl;
157             crc = 0xffff;
158             break;
159         }
160         crc = crc_16(crc,hex[i]);
161     }
162     return crc&0xffff;    //because the u16 size is more than 16bits in PC system.
163 }
164 ///================== end file =========================
View Code

 

Thanks.

posted on 2018-03-03 23:40  Milo_lu  阅读(114)  评论(0)  编辑  收藏  举报

导航