X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/proxmark3-svn/blobdiff_plain/f4d0ffd1b99481943e77fce805be5eb10241b2d9..76a608af8e342b50718cfd0e53c0fa932304dbd9:/client/util.h diff --git a/client/util.h b/client/util.h index 446ec882..87541f4b 100644 --- a/client/util.h +++ b/client/util.h @@ -7,15 +7,37 @@ //----------------------------------------------------------------------------- // utilities //----------------------------------------------------------------------------- +#ifndef __UTIL_H_ +#define __UTIL_H_ #include -#include -#include +#include //included in data.h #include #include #include +#include // math.pow +#include // time, gmtime +#include "proxmark3.h" // time_t +#include "data.h" // for FILE_PATH_SIZE + #include -#include "data.h" +// Handle platform specific includes +#ifndef _WIN32 + #include + #include + #include +#else + #include + #include +#endif + + +#ifndef BITMASK +# define BITMASK(X) (1 << (X)) +#endif +#ifndef ROTR +# define ROTR(x,n) (((uintmax_t)(x) >> (n)) | ((uintmax_t)(x) << ((sizeof(x) * 8) - (n)))) +#endif #ifndef MIN # define MIN(a, b) (((a) < (b)) ? (a) : (b)) @@ -23,51 +45,112 @@ #ifndef MAX # define MAX(a, b) (((a) > (b)) ? (a) : (b)) #endif + +// Byte swapping +#ifndef BSWAP_64 +#define BSWAP_64(x) (((uint64_t)(x) << 56) | \\ + (((uint64_t)(x) << 40) & 0xff000000000000ULL) | \\ + (((uint64_t)(x) << 24) & 0xff0000000000ULL) | \\ + (((uint64_t)(x) << 8) & 0xff00000000ULL) | \\ + (((uint64_t)(x) >> 8) & 0xff000000ULL) | \\ + (((uint64_t)(x) >> 24) & 0xff0000ULL) | \\ + (((uint64_t)(x) >> 40) & 0xff00ULL) | \\ + ((uint64_t)(x) >> 56)) +#endif +#ifndef BSWAP_32 +# define BSWAP_32(x) \ + ((((x) & 0xff000000) >> 24) | (((x) & 0x00ff0000) >> 8) | \ + (((x) & 0x0000ff00) << 8) | (((x) & 0x000000ff) << 24)) +#endif +#ifndef BSWAP_16 +# define BSWAP_16(x) ((( ((x) & 0xFF00 ) >> 8))| ( (((x) & 0x00FF) << 8))) +#endif + +// Boolean #define TRUE 1 #define FALSE 0 #define EVEN 0 #define ODD 1 -int ukbhit(void); - -void AddLogLine(char *fileName, char *extData, char *c); -void AddLogHex(char *fileName, char *extData, const uint8_t * data, const size_t len); -void AddLogUint64(char *fileName, char *extData, const uint64_t data); -void AddLogCurrentDT(char *fileName); -void FillFileNameByUID(char *fileName, uint8_t * uid, char *ext, int byteCount); - -void print_hex(const uint8_t * data, const size_t len); -char * sprint_hex(const uint8_t * data, const size_t len); -char * sprint_bin(const uint8_t * data, const size_t len); -char * sprint_bin_break(const uint8_t *data, const size_t len, const uint8_t breaks); -char *sprint_hex_ascii(const uint8_t *data, const size_t len); - -void num_to_bytes(uint64_t n, size_t len, uint8_t* dest); -uint64_t bytes_to_num(uint8_t* src, size_t len); -void num_to_bytebits(uint64_t n, size_t len, uint8_t *dest); -uint8_t *SwapEndian64(const uint8_t *src, const size_t len, const uint8_t blockSize); -void SwapEndian64ex(const uint8_t *src, const size_t len, const uint8_t blockSize, uint8_t *dest); - -char param_getchar(const char *line, int paramnum); -int param_getptr(const char *line, int *bg, int *en, int paramnum); -uint8_t param_get8(const char *line, int paramnum); -uint8_t param_get8ex(const char *line, int paramnum, int deflt, int base); -uint32_t param_get32ex(const char *line, int paramnum, int deflt, int base); -uint64_t param_get64ex(const char *line, int paramnum, int deflt, int base); -uint8_t param_getdec(const char *line, int paramnum, uint8_t *destination); -uint8_t param_isdec(const char *line, int paramnum); -int param_gethex(const char *line, int paramnum, uint8_t * data, int hexcnt); -int param_gethex_ex(const char *line, int paramnum, uint8_t * data, int *hexcnt); -int param_getstr(const char *line, int paramnum, char * str); - -int hextobinarray( char *target, char *source); -int hextobinstring( char *target, char *source); -int binarraytohex( char *target, char *source, int length); -void binarraytobinstring(char *target, char *source, int length); -uint8_t GetParity( uint8_t *string, uint8_t type, int length); -void wiegand_add_parity(uint8_t *target, uint8_t *source, uint8_t length); - -void xor(unsigned char * dst, unsigned char * src, size_t len); -int32_t le24toh (uint8_t data[3]); -uint32_t PackBits(uint8_t start, uint8_t len, uint8_t* bits); -void rol(uint8_t *data, const size_t len); \ No newline at end of file +// Nibble logic +#ifndef NIBBLE_HIGH +# define NIBBLE_HIGH(b) ( (b & 0xF0) >> 4 ) +#endif +#ifndef NIBBLE_LOW +# define NIBBLE_LOW(b) ( b & 0x0F ) +#endif +#ifndef CRUMB +# define CRUMB(b,p) (((b & (0x3 << p) ) >> p ) & 0xF) +#endif +#ifndef SWAP_NIBBLE +# define SWAP_NIBBLE(b) ( (NIBBLE_LOW(b)<< 4) | NIBBLE_HIGH(b)) +#endif + +// Binary Encoded Digit +#ifndef BCD2DEC +# define BCD2DEC(bcd) HornerScheme(bcd, 0x10, 10) +#endif +#ifndef DEC2BCD +# define DEC2BCD(dec) HornerScheme(dec, 10, 0x10) +#endif + +// used for save/load files +#ifndef FILE_PATH_SIZE +# define FILE_PATH_SIZE 1000 +#endif + +#ifndef ARRAYLEN +# define ARRAYLEN(x) (sizeof(x)/sizeof((x)[0])) +#endif + +extern int ukbhit(void); +extern void AddLogLine(char *fileName, char *extData, char *c); +extern void AddLogHex(char *fileName, char *extData, const uint8_t * data, const size_t len); +extern void AddLogUint64(char *fileName, char *extData, const uint64_t data); +extern void AddLogCurrentDT(char *fileName); +extern void FillFileNameByUID(char *fileName, uint8_t * uid, char *ext, int byteCount); + +extern void print_hex(const uint8_t * data, const size_t len); +extern void print_hex_break(const uint8_t *data, const size_t len, const uint8_t breaks); +extern char *sprint_hex(const uint8_t * data, const size_t len); +extern char *sprint_bin(const uint8_t * data, const size_t len); +extern char *sprint_bin_break(const uint8_t *data, const size_t len, const uint8_t breaks); +extern char *sprint_hex_ascii(const uint8_t *data, const size_t len); +extern char *sprint_ascii(const uint8_t *data, const size_t len); + +extern void num_to_bytes(uint64_t n, size_t len, uint8_t* dest); +extern uint64_t bytes_to_num(uint8_t* src, size_t len); +extern void num_to_bytebits(uint64_t n, size_t len, uint8_t *dest); +extern void num_to_bytebitsLSBF(uint64_t n, size_t len, uint8_t *dest); +extern uint8_t *SwapEndian64(const uint8_t *src, const size_t len, const uint8_t blockSize); +extern void SwapEndian64ex(const uint8_t *src, const size_t len, const uint8_t blockSize, uint8_t *dest); + +extern char param_getchar(const char *line, int paramnum); +extern int param_getptr(const char *line, int *bg, int *en, int paramnum); +extern uint8_t param_get8(const char *line, int paramnum); +extern uint8_t param_get8ex(const char *line, int paramnum, int deflt, int base); +extern uint32_t param_get32ex(const char *line, int paramnum, int deflt, int base); +extern uint64_t param_get64ex(const char *line, int paramnum, int deflt, int base); +extern uint8_t param_getdec(const char *line, int paramnum, uint8_t *destination); +extern uint8_t param_isdec(const char *line, int paramnum); +extern int param_gethex(const char *line, int paramnum, uint8_t * data, int hexcnt); +extern int param_gethex_ex(const char *line, int paramnum, uint8_t * data, int *hexcnt); +extern int param_getstr(const char *line, int paramnum, char * str); + +extern int hextobinarray( char *target, char *source); +extern int hextobinstring( char *target, char *source); +extern int binarraytohex( char *target, char *source, int length); +extern void binarraytobinstring(char *target, char *source, int length); +extern uint8_t GetParity( uint8_t *string, uint8_t type, int length); +extern void wiegand_add_parity(uint8_t *target, uint8_t *source, uint8_t length); + +extern void xor(unsigned char * dst, unsigned char * src, size_t len); +extern int32_t le24toh (uint8_t data[3]); +extern uint32_t le32toh (uint8_t *data); +extern uint32_t PackBits(uint8_t start, uint8_t len, uint8_t* bits); +extern void rol(uint8_t *data, const size_t len); +extern uint32_t SwapBits(uint32_t value, int nrbits); +extern uint32_t reflect(uint32_t v, int b); +extern uint64_t HornerScheme(uint64_t num, uint64_t divider, uint64_t factor); + +#endif \ No newline at end of file