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