git.zerfleddert.de Git - proxmark3-svn/blob - client/util.h

   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 <math.h>               // math.pow
  17 #include "proxmark3.h"  // time_t
  18 #include "data.h"               // for FILE_PATH_SIZE
  19
  20 // Handle platform specific includes
  21 #ifndef _WIN32
  22   #include <termios.h>
  23   #include <sys/ioctl.h>
  24   #include <sys/time.h>
  25 #else
  26   #include <conio.h>
  27   #include <time.h>
  28   #include <windows.h>
  29 #endif
  30
  31
  32 #ifndef BITMASK
  33 # define BITMASK(X) (1 << (X))
  34 #endif
  35 #ifndef ROTR
  36 # define ROTR(x,n) (((uintmax_t)(x) >> (n)) | ((uintmax_t)(x) << ((sizeof(x) * 8) - (n))))
  37 #endif
  38
  39 #ifndef MIN
  40 # define MIN(a, b) (((a) < (b)) ? (a) : (b))
  41 #endif
  42 #ifndef MAX
  43 # define MAX(a, b) (((a) > (b)) ? (a) : (b))
  44 #endif
  45
  46 // Byte swapping
  47 #ifndef BSWAP_32
  48 # define BSWAP_32(x) \
  49      ((((x) & 0xff000000) >> 24) | (((x) & 0x00ff0000) >>  8) | \
  50       (((x) & 0x0000ff00) <<  8) | (((x) & 0x000000ff) << 24))
  51 #endif
  52 #ifndef BSWAP_16
  53 # define BSWAP_16(x) ((( ((x) & 0xFF00 ) >> 8))| ( (((x) & 0x00FF) << 8)))
  54 #endif
  55
  56 // Boolean
  57 #define TRUE                        1
  58 #define FALSE                       0
  59 #define EVEN                        0
  60 #define ODD                         1
  61
  62 // Nibble logic
  63 #ifndef NIBBLE_HIGH
  64 # define NIBBLE_HIGH(b) ( (b & 0xF0) >> 4 )
  65 #endif
  66 #ifndef NIBBLE_LOW
  67 # define NIBBLE_LOW(b)  ( b & 0x0F )
  68 #endif
  69 #ifndef CRUMB
  70 # define CRUMB(b,p)    (((b & (0x3 << p) ) >> p ) & 0xF)
  71 #endif
  72 #ifndef SWAP_NIBBLE
  73 # define SWAP_NIBBLE(b)  ( (NIBBLE_LOW(b)<< 4) | NIBBLE_HIGH(b))
  74 #endif
  75
  76 // Binary Encoded Digit
  77 #ifndef BCD2DEC
  78 # define BCD2DEC(bcd) HornerScheme(bcd, 0x10, 10)
  79 #endif
  80 #ifndef DEC2BCD
  81 # define DEC2BCD(dec) HornerScheme(dec, 10, 0x10)
  82 #endif
  83
  84 // used for save/load files
  85 #ifndef FILE_PATH_SIZE
  86 # define FILE_PATH_SIZE 1000
  87 #endif
  88
  89 #ifndef ARRAYLEN
  90 # define ARRAYLEN(x) (sizeof(x)/sizeof((x)[0]))
  91 #endif
  92
  93 int ukbhit(void);
  94
  95 void AddLogLine(char *fileName, char *extData, char *c);
  96 void AddLogHex(char *fileName, char *extData, const uint8_t * data, const size_t len);
  97 void AddLogUint64(char *fileName, char *extData, const uint64_t data);
  98 void AddLogCurrentDT(char *fileName);
  99 void FillFileNameByUID(char *fileName, uint8_t * uid, char *ext, int byteCount);
 100
 101 void print_hex(const uint8_t * data, const size_t len);
 102 void print_hex_break(const uint8_t *data, const size_t len, const uint8_t breaks);
 103 char *sprint_hex(const uint8_t * data, const size_t len);
 104 char *sprint_bin(const uint8_t * data, const size_t len);
 105 char *sprint_bin_break(const uint8_t *data, const size_t len, const uint8_t breaks);
 106 char *sprint_hex_ascii(const uint8_t *data, const size_t len);
 107
 108 void num_to_bytes(uint64_t n, size_t len, uint8_t* dest);
 109 uint64_t bytes_to_num(uint8_t* src, size_t len);
 110 void num_to_bytebits(uint64_t n, size_t len, uint8_t *dest);
 111 void num_to_bytebitsLSBF(uint64_t n, size_t len, uint8_t *dest);
 112 uint8_t *SwapEndian64(const uint8_t *src, const size_t len, const uint8_t blockSize);
 113 void SwapEndian64ex(const uint8_t *src, const size_t len, const uint8_t blockSize, uint8_t *dest);
 114
 115 char param_getchar(const char *line, int paramnum);
 116 int param_getptr(const char *line, int *bg, int *en, int paramnum);
 117 uint8_t param_get8(const char *line, int paramnum);
 118 uint8_t param_get8ex(const char *line, int paramnum, int deflt, int base);
 119 uint32_t param_get32ex(const char *line, int paramnum, int deflt, int base);
 120 uint64_t param_get64ex(const char *line, int paramnum, int deflt, int base);
 121 uint8_t param_getdec(const char *line, int paramnum, uint8_t *destination);
 122 uint8_t param_isdec(const char *line, int paramnum);
 123 int param_gethex(const char *line, int paramnum, uint8_t * data, int hexcnt);
 124 int param_gethex_ex(const char *line, int paramnum, uint8_t * data, int *hexcnt);
 125 int param_getstr(const char *line, int paramnum, char * str);
 126
 127 int hextobinarray( char *target,  char *source);
 128 int hextobinstring( char *target,  char *source);
 129 int binarraytohex( char *target,  char *source,  int length);
 130 void binarraytobinstring(char *target,  char *source,  int length);
 131 uint8_t GetParity( uint8_t *string, uint8_t type,  int length);
 132 void wiegand_add_parity(uint8_t *target, uint8_t *source, uint8_t length);
 133
 134 void xor(unsigned char * dst, unsigned char * src, size_t len);
 135 int32_t le24toh (uint8_t data[3]);
 136 uint32_t le32toh (uint8_t *data);
 137 uint32_t PackBits(uint8_t start, uint8_t len, uint8_t* bits);
 138 void rol(uint8_t *data, const size_t len);
 139 uint32_t SwapBits(uint32_t value, int nrbits);
 140 uint32_t reflect(uint32_t v, int b);
 141 uint64_t HornerScheme(uint64_t num, uint64_t divider, uint64_t factor);