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