| 1 | //----------------------------------------------------------------------------- |
| 2 | // Copyright (C) 2010 iZsh <izsh at fail0verflow.com> |
| 3 | // |
| 4 | // This code is licensed to you under the terms of the GNU GPL, version 2 or, |
| 5 | // at your option, any later version. See the LICENSE.txt file for the text of |
| 6 | // the license. |
| 7 | //----------------------------------------------------------------------------- |
| 8 | // utilities |
| 9 | //----------------------------------------------------------------------------- |
| 10 | |
| 11 | #include <stdio.h> |
| 12 | #include <stdint.h> //included in data.h |
| 13 | #include <stdlib.h> |
| 14 | #include <string.h> |
| 15 | #include <ctype.h> |
| 16 | #include <time.h> |
| 17 | #include <math.h> // math.pow |
| 18 | #include "data.h" // for FILE_PATH_SIZE |
| 19 | #include "proxmark3.h" |
| 20 | |
| 21 | #ifndef BITMASK |
| 22 | # define BITMASK(X) (1 << (X)) |
| 23 | #endif |
| 24 | #ifndef ROTR |
| 25 | # define ROTR(x,n) (((uintmax_t)(x) >> (n)) | ((uintmax_t)(x) << ((sizeof(x) * 8) - (n)))) |
| 26 | #endif |
| 27 | |
| 28 | #ifndef MIN |
| 29 | # define MIN(a, b) (((a) < (b)) ? (a) : (b)) |
| 30 | #endif |
| 31 | #ifndef MAX |
| 32 | # define MAX(a, b) (((a) > (b)) ? (a) : (b)) |
| 33 | #endif |
| 34 | |
| 35 | // Byte swapping |
| 36 | #ifndef BSWAP_32 |
| 37 | # define BSWAP_32(x) \ |
| 38 | ((((x) & 0xff000000) >> 24) | (((x) & 0x00ff0000) >> 8) | \ |
| 39 | (((x) & 0x0000ff00) << 8) | (((x) & 0x000000ff) << 24)) |
| 40 | #endif |
| 41 | #ifndef BSWAP_16 |
| 42 | # define BSWAP_16(x) ((( ((x) & 0xFF00 ) >> 8))| ( (((x) & 0x00FF) << 8))) |
| 43 | #endif |
| 44 | |
| 45 | // Boolean |
| 46 | #define TRUE 1 |
| 47 | #define FALSE 0 |
| 48 | #define EVEN 0 |
| 49 | #define ODD 1 |
| 50 | |
| 51 | // Nibble logic |
| 52 | #ifndef NIBBLE_HIGH |
| 53 | # define NIBBLE_HIGH(b) ( (b & 0xF0) >> 4 ) |
| 54 | #endif |
| 55 | #ifndef NIBBLE_LOW |
| 56 | # define NIBBLE_LOW(b) ( b & 0x0F ) |
| 57 | #endif |
| 58 | #ifndef CRUMB |
| 59 | # define CRUMB(b,p) (((b & (0x3 << p) ) >> p ) & 0xF) |
| 60 | #endif |
| 61 | #ifndef SWAP_NIBBLE |
| 62 | # define SWAP_NIBBLE(b) ( (NIBBLE_LOW(b)<< 4) | NIBBLE_HIGH(b)) |
| 63 | #endif |
| 64 | |
| 65 | // Binary Encoded Digit |
| 66 | #ifndef BCD2DEC |
| 67 | # define BCD2DEC(bcd) HornerScheme(bcd, 0x10, 10) |
| 68 | #endif |
| 69 | #ifndef DEC2BCD |
| 70 | # define DEC2BCD(dec) HornerScheme(dec, 10, 0x10) |
| 71 | #endif |
| 72 | |
| 73 | // used for save/load files |
| 74 | #ifndef FILE_PATH_SIZE |
| 75 | # define FILE_PATH_SIZE 1000 |
| 76 | #endif |
| 77 | |
| 78 | #ifndef ARRAYLEN |
| 79 | # define ARRAYLEN(x) (sizeof(x)/sizeof((x)[0])) |
| 80 | #endif |
| 81 | |
| 82 | int ukbhit(void); |
| 83 | |
| 84 | void AddLogLine(char *fileName, char *extData, char *c); |
| 85 | void AddLogHex(char *fileName, char *extData, const uint8_t * data, const size_t len); |
| 86 | void AddLogUint64(char *fileName, char *extData, const uint64_t data); |
| 87 | void AddLogCurrentDT(char *fileName); |
| 88 | void FillFileNameByUID(char *fileName, uint8_t * uid, char *ext, int byteCount); |
| 89 | |
| 90 | void print_hex(const uint8_t * data, const size_t len); |
| 91 | void print_hex_break(const uint8_t *data, const size_t len, const uint8_t breaks); |
| 92 | char *sprint_hex(const uint8_t * data, const size_t len); |
| 93 | char *sprint_bin(const uint8_t * data, const size_t len); |
| 94 | char *sprint_bin_break(const uint8_t *data, const size_t len, const uint8_t breaks); |
| 95 | char *sprint_hex_ascii(const uint8_t *data, const size_t len); |
| 96 | |
| 97 | void num_to_bytes(uint64_t n, size_t len, uint8_t* dest); |
| 98 | uint64_t bytes_to_num(uint8_t* src, size_t len); |
| 99 | void num_to_bytebits(uint64_t n, size_t len, uint8_t *dest); |
| 100 | void num_to_bytebitsLSBF(uint64_t n, size_t len, uint8_t *dest); |
| 101 | uint8_t *SwapEndian64(const uint8_t *src, const size_t len, const uint8_t blockSize); |
| 102 | void SwapEndian64ex(const uint8_t *src, const size_t len, const uint8_t blockSize, uint8_t *dest); |
| 103 | |
| 104 | char param_getchar(const char *line, int paramnum); |
| 105 | int param_getptr(const char *line, int *bg, int *en, int paramnum); |
| 106 | uint8_t param_get8(const char *line, int paramnum); |
| 107 | uint8_t param_get8ex(const char *line, int paramnum, int deflt, int base); |
| 108 | uint32_t param_get32ex(const char *line, int paramnum, int deflt, int base); |
| 109 | uint64_t param_get64ex(const char *line, int paramnum, int deflt, int base); |
| 110 | uint8_t param_getdec(const char *line, int paramnum, uint8_t *destination); |
| 111 | uint8_t param_isdec(const char *line, int paramnum); |
| 112 | int param_gethex(const char *line, int paramnum, uint8_t * data, int hexcnt); |
| 113 | int param_gethex_ex(const char *line, int paramnum, uint8_t * data, int *hexcnt); |
| 114 | int param_getstr(const char *line, int paramnum, char * str); |
| 115 | |
| 116 | int hextobinarray( char *target, char *source); |
| 117 | int hextobinstring( char *target, char *source); |
| 118 | int binarraytohex( char *target, char *source, int length); |
| 119 | void binarraytobinstring(char *target, char *source, int length); |
| 120 | uint8_t GetParity( uint8_t *string, uint8_t type, int length); |
| 121 | void wiegand_add_parity(uint8_t *target, uint8_t *source, uint8_t length); |
| 122 | |
| 123 | void xor(unsigned char * dst, unsigned char * src, size_t len); |
| 124 | int32_t le24toh (uint8_t data[3]); |
| 125 | uint32_t le32toh (uint8_t *data); |
| 126 | uint32_t PackBits(uint8_t start, uint8_t len, uint8_t* bits); |
| 127 | void rol(uint8_t *data, const size_t len); |
| 128 | uint32_t SwapBits(uint32_t value, int nrbits); |
| 129 | uint32_t reflect(uint32_t v, int b); |
| 130 | uint64_t HornerScheme(uint64_t num, uint64_t divider, uint64_t factor); |