00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00025 #ifdef HAVE_CONFIG_H
00026 #include "config.h"
00027 #endif // HAVE_CONFIG_H
00028
00029 #include <stdio.h>
00030
00031 #include "bitutils.h"
00032
00033 const static byte_t OddParity[256] = {
00034 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
00035 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00036 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00037 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
00038 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00039 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
00040 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
00041 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00042 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00043 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
00044 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
00045 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00046 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
00047 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00048 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0,
00049 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1
00050 };
00051
00052 const static byte_t ByteMirror[256] = {
00053 0x00, 0x80, 0x40, 0xc0, 0x20, 0xa0, 0x60, 0xe0, 0x10, 0x90, 0x50, 0xd0, 0x30,
00054 0xb0, 0x70, 0xf0, 0x08, 0x88, 0x48, 0xc8, 0x28, 0xa8, 0x68, 0xe8, 0x18, 0x98,
00055 0x58, 0xd8, 0x38, 0xb8, 0x78, 0xf8, 0x04, 0x84, 0x44, 0xc4, 0x24, 0xa4, 0x64,
00056 0xe4, 0x14, 0x94, 0x54, 0xd4, 0x34, 0xb4, 0x74, 0xf4, 0x0c, 0x8c, 0x4c, 0xcc,
00057 0x2c, 0xac, 0x6c, 0xec, 0x1c, 0x9c, 0x5c, 0xdc, 0x3c, 0xbc, 0x7c, 0xfc, 0x02,
00058 0x82, 0x42, 0xc2, 0x22, 0xa2, 0x62, 0xe2, 0x12, 0x92, 0x52, 0xd2, 0x32, 0xb2,
00059 0x72, 0xf2, 0x0a, 0x8a, 0x4a, 0xca, 0x2a, 0xaa, 0x6a, 0xea, 0x1a, 0x9a, 0x5a,
00060 0xda, 0x3a, 0xba, 0x7a, 0xfa, 0x06, 0x86, 0x46, 0xc6, 0x26, 0xa6, 0x66, 0xe6,
00061 0x16, 0x96, 0x56, 0xd6, 0x36, 0xb6, 0x76, 0xf6, 0x0e, 0x8e, 0x4e, 0xce, 0x2e,
00062 0xae, 0x6e, 0xee, 0x1e, 0x9e, 0x5e, 0xde, 0x3e, 0xbe, 0x7e, 0xfe, 0x01, 0x81,
00063 0x41, 0xc1, 0x21, 0xa1, 0x61, 0xe1, 0x11, 0x91, 0x51, 0xd1, 0x31, 0xb1, 0x71,
00064 0xf1, 0x09, 0x89, 0x49, 0xc9, 0x29, 0xa9, 0x69, 0xe9, 0x19, 0x99, 0x59, 0xd9,
00065 0x39, 0xb9, 0x79, 0xf9, 0x05, 0x85, 0x45, 0xc5, 0x25, 0xa5, 0x65, 0xe5, 0x15,
00066 0x95, 0x55, 0xd5, 0x35, 0xb5, 0x75, 0xf5, 0x0d, 0x8d, 0x4d, 0xcd, 0x2d, 0xad,
00067 0x6d, 0xed, 0x1d, 0x9d, 0x5d, 0xdd, 0x3d, 0xbd, 0x7d, 0xfd, 0x03, 0x83, 0x43,
00068 0xc3, 0x23, 0xa3, 0x63, 0xe3, 0x13, 0x93, 0x53, 0xd3, 0x33, 0xb3, 0x73, 0xf3,
00069 0x0b, 0x8b, 0x4b, 0xcb, 0x2b, 0xab, 0x6b, 0xeb, 0x1b, 0x9b, 0x5b, 0xdb, 0x3b,
00070 0xbb, 0x7b, 0xfb, 0x07, 0x87, 0x47, 0xc7, 0x27, 0xa7, 0x67, 0xe7, 0x17, 0x97,
00071 0x57, 0xd7, 0x37, 0xb7, 0x77, 0xf7, 0x0f, 0x8f, 0x4f, 0xcf, 0x2f, 0xaf, 0x6f,
00072 0xef, 0x1f, 0x9f, 0x5f, 0xdf, 0x3f, 0xbf, 0x7f, 0xff
00073 };
00074
00075 byte_t oddparity(const byte_t bt)
00076 {
00077 return OddParity[bt];
00078 }
00079
00080 void oddparity_bytes(const byte_t* pbtData, const size_t szLen, byte_t* pbtPar)
00081 {
00082 size_t szByteNr;
00083
00084
00085 for (szByteNr=0; szByteNr<szLen; szByteNr++)
00086 {
00087 pbtPar[szByteNr] = OddParity[pbtData[szByteNr]];
00088 }
00089 }
00090
00091 byte_t mirror(byte_t bt)
00092 {
00093 return ByteMirror[bt];
00094 }
00095
00096 void mirror_bytes(byte_t *pbts, size_t szLen)
00097 {
00098 size_t szByteNr;
00099
00100 for (szByteNr=0; szByteNr<szLen; szByteNr++)
00101 {
00102 *pbts = ByteMirror[*pbts];
00103 pbts++;
00104 }
00105 }
00106
00107 uint32_t mirror32(uint32_t ui32Bits)
00108 {
00109 mirror_bytes((byte_t*)&ui32Bits,4);
00110 return ui32Bits;
00111 }
00112
00113 uint64_t mirror64(uint64_t ui64Bits)
00114 {
00115 mirror_bytes((byte_t*)&ui64Bits,8);
00116 return ui64Bits;
00117 }
00118
00119 uint32_t swap_endian32(const void* pui32)
00120 {
00121 uint32_t ui32N = *((uint32_t*)pui32);
00122 return (((ui32N&0xFF)<<24)+((ui32N&0xFF00)<<8)+((ui32N&0xFF0000)>>8)+((ui32N&0xFF000000)>>24));
00123 }
00124
00125 uint64_t swap_endian64(const void* pui64)
00126 {
00127 uint64_t ui64N = *((uint64_t *)pui64);
00128 return (((ui64N&0xFF)<<56)+((ui64N&0xFF00)<<40)+((ui64N&0xFF0000)<<24)+((ui64N&0xFF000000)<<8)+((ui64N&0xFF00000000ull)>>8)+((ui64N&0xFF0000000000ull)>>24)+((ui64N&0xFF000000000000ull)>>40)+((ui64N&0xFF00000000000000ull)>>56));
00129 }
00130
00131 void iso14443a_crc(byte_t* pbtData, size_t szLen, byte_t* pbtCrc)
00132 {
00133 byte_t bt;
00134 uint32_t wCrc = 0x6363;
00135
00136 do {
00137 bt = *pbtData++;
00138 bt = (bt^(byte_t)(wCrc & 0x00FF));
00139 bt = (bt^(bt<<4));
00140 wCrc = (wCrc >> 8)^((uint32_t)bt << 8)^((uint32_t)bt<<3)^((uint32_t)bt>>4);
00141 } while (--szLen);
00142
00143 *pbtCrc++ = (byte_t) (wCrc & 0xFF);
00144 *pbtCrc = (byte_t) ((wCrc >> 8) & 0xFF);
00145 }
00146
00147 void append_iso14443a_crc(byte_t* pbtData, size_t szLen)
00148 {
00149 iso14443a_crc(pbtData, szLen, pbtData + szLen);
00150 }
00151
00152 void print_hex(const byte_t* pbtData, const size_t szBytes)
00153 {
00154 size_t szPos;
00155
00156 for (szPos=0; szPos < szBytes; szPos++)
00157 {
00158 printf("%02x ",pbtData[szPos]);
00159 }
00160 printf("\n");
00161 }
00162
00163 void print_hex_bits(const byte_t* pbtData, const size_t szBits)
00164 {
00165 uint8_t uRemainder;
00166 size_t szPos;
00167 size_t szBytes = szBits/8;
00168
00169 for (szPos=0; szPos < szBytes; szPos++)
00170 {
00171 printf("%02x ",pbtData[szPos]);
00172 }
00173
00174 uRemainder = szBits % 8;
00175
00176 if (uRemainder != 0)
00177 {
00178 if (uRemainder < 5)
00179 printf("%01x (%d bits)",pbtData[szBytes], uRemainder);
00180 else
00181 printf("%02x (%d bits)",pbtData[szBytes], uRemainder);
00182 }
00183 printf("\n");
00184 }
00185
00186 void print_hex_par(const byte_t* pbtData, const size_t szBits, const byte_t* pbtDataPar)
00187 {
00188 uint8_t uRemainder;
00189 size_t szPos;
00190 size_t szBytes = szBits/8;
00191
00192 for (szPos=0; szPos < szBytes; szPos++)
00193 {
00194 printf("%02x",pbtData[szPos]);
00195 if (OddParity[pbtData[szPos]] != pbtDataPar[szPos])
00196 {
00197 printf("! ");
00198 } else {
00199 printf(" ");
00200 }
00201 }
00202
00203 uRemainder = szBits % 8;
00204
00205 if (uRemainder != 0)
00206 {
00207 if (uRemainder < 5)
00208 printf("%01x (%d bits)",pbtData[szBytes], uRemainder);
00209 else
00210 printf("%02x (%d bits)",pbtData[szBytes], uRemainder);
00211 }
00212 printf("\n");
00213 }
00214