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 <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);