]>
cvs.zerfleddert.de Git - proxmark3-svn/blob - client/util.c
709e2014911205631f689f1970f19594573d1930
1 //-----------------------------------------------------------------------------
2 // Copyright (C) 2010 iZsh <izsh at fail0verflow.com>
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
7 //-----------------------------------------------------------------------------
9 //-----------------------------------------------------------------------------
15 #include <sys/ioctl.h>
21 static struct termios Otty
, Ntty
;
27 Ntty
.c_iflag
= 0; /* input mode */
28 Ntty
.c_oflag
= 0; /* output mode */
29 Ntty
.c_lflag
&= ~ICANON
; /* raw mode */
30 Ntty
.c_cc
[VMIN
] = CMIN
; /* minimum time to wait */
31 Ntty
.c_cc
[VTIME
] = CTIME
; /* minimum characters to wait for */
33 if (0 == (error
= tcsetattr(0, TCSANOW
, &Ntty
))) {
34 error
+= ioctl(0, FIONREAD
, &cnt
);
35 error
+= tcsetattr(0, TCSANOW
, &Otty
);
38 return ( error
== 0 ? cnt
: -1 );
48 // log files functions
49 void AddLogLine(char *file
, char *extData
, char *c
) {
51 char filename
[FILE_PATH_SIZE
] = {0x00};
55 if (len
> FILE_PATH_SIZE
) len
= FILE_PATH_SIZE
;
56 memcpy(filename
, file
, len
);
58 fLog
= fopen(filename
, "a");
60 printf("Could not append log file %s", filename
);
64 fprintf(fLog
, "%s", extData
);
65 fprintf(fLog
, "%s\n", c
);
69 void AddLogHex(char *fileName
, char *extData
, const uint8_t * data
, const size_t len
){
70 AddLogLine(fileName
, extData
, sprint_hex(data
, len
));
73 void AddLogUint64(char *fileName
, char *extData
, const uint64_t data
) {
75 sprintf(buf
, "%x%x", (unsigned int)((data
& 0xFFFFFFFF00000000) >> 32), (unsigned int)(data
& 0xFFFFFFFF));
76 AddLogLine(fileName
, extData
, buf
);
79 void AddLogCurrentDT(char *fileName
) {
84 curTime
= gmtime(&now
);
86 strftime (buff
, sizeof(buff
), "%Y-%m-%d %H:%M:%S", curTime
);
87 AddLogLine(fileName
, "\nanticollision: ", buff
);
90 void FillFileNameByUID(char *fileName
, uint8_t * uid
, char *ext
, int byteCount
) {
91 char * fnameptr
= fileName
;
92 memset(fileName
, 0x00, 200);
94 for (int j
= 0; j
< byteCount
; j
++, fnameptr
+= 2)
95 sprintf(fnameptr
, "%02x", uid
[j
]);
96 sprintf(fnameptr
, "%s", ext
);
99 // printing and converting functions
101 void print_hex(const uint8_t * data
, const size_t len
)
105 for (i
=0; i
< len
; i
++)
106 printf("%02x ", data
[i
]);
111 char * sprint_hex(const uint8_t * data
, const size_t len
) {
113 int maxLen
= ( len
> 1024/3) ? 1024/3 : len
;
114 static char buf
[1024];
118 for (i
=0; i
< maxLen
; ++i
, tmp
+= 3)
119 sprintf(tmp
, "%02x ", data
[i
]);
124 char *sprint_bin_break(const uint8_t *data
, const size_t len
, const uint8_t breaks
) {
126 int maxLen
= ( len
> 1024) ? 1024 : len
;
127 static char buf
[1024];
130 for (size_t i
=0; i
< maxLen
; ++i
){
131 sprintf(tmp
++, "%u", data
[i
]);
132 if (breaks
> 0 && !((i
+1) % breaks
))
133 sprintf(tmp
++, "%s","\n");
139 char *sprint_bin(const uint8_t *data
, const size_t len
) {
140 return sprint_bin_break(data
, len
, 0);
142 void num_to_bytes(uint64_t n
, size_t len
, uint8_t* dest
)
145 dest
[len
] = (uint8_t) n
;
150 uint64_t bytes_to_num(uint8_t* src
, size_t len
)
155 num
= (num
<< 8) | (*src
);
161 //assumes little endian
162 char * printBits(size_t const size
, void const * const ptr
)
164 unsigned char *b
= (unsigned char*) ptr
;
166 static char buf
[1024];
170 for (i
=size
-1;i
>=0;i
--)
174 byte
= b
[i
] & (1<<j
);
176 sprintf(tmp
, "%u", byte
);
183 // -------------------------------------------------------------------------
184 // string parameters lib
185 // -------------------------------------------------------------------------
187 // -------------------------------------------------------------------------
189 // bg, en - symbol numbers in param line of beginning an ending parameter
190 // paramnum - param number (from 0)
191 // -------------------------------------------------------------------------
192 int param_getptr(const char *line
, int *bg
, int *en
, int paramnum
)
195 int len
= strlen(line
);
201 while (line
[*bg
] ==' ' || line
[*bg
]=='\t') (*bg
)++;
206 for (i
= 0; i
< paramnum
; i
++) {
207 while (line
[*bg
]!=' ' && line
[*bg
]!='\t' && line
[*bg
] != '\0') (*bg
)++;
208 while (line
[*bg
]==' ' || line
[*bg
]=='\t') (*bg
)++;
210 if (line
[*bg
] == '\0') return 1;
214 while (line
[*en
] != ' ' && line
[*en
] != '\t' && line
[*en
] != '\0') (*en
)++;
222 char param_getchar(const char *line
, int paramnum
)
226 if (param_getptr(line
, &bg
, &en
, paramnum
)) return 0x00;
231 uint8_t param_get8(const char *line
, int paramnum
)
233 return param_get8ex(line
, paramnum
, 10, 0);
237 * @brief Reads a decimal integer (actually, 0-254, not 255)
240 * @return -1 if error
242 uint8_t param_getdec(const char *line
, int paramnum
, uint8_t *destination
)
244 uint8_t val
= param_get8ex(line
, paramnum
, 255, 10);
245 if( (int8_t) val
== -1) return 1;
246 (*destination
) = val
;
250 * @brief Checks if param is decimal
255 uint8_t param_isdec(const char *line
, int paramnum
)
258 //TODO, check more thorougly
259 if (!param_getptr(line
, &bg
, &en
, paramnum
)) return 1;
260 // return strtoul(&line[bg], NULL, 10) & 0xff;
265 uint8_t param_get8ex(const char *line
, int paramnum
, int deflt
, int base
)
269 if (!param_getptr(line
, &bg
, &en
, paramnum
))
270 return strtoul(&line
[bg
], NULL
, base
) & 0xff;
275 uint32_t param_get32ex(const char *line
, int paramnum
, int deflt
, int base
)
279 if (!param_getptr(line
, &bg
, &en
, paramnum
))
280 return strtoul(&line
[bg
], NULL
, base
);
285 uint64_t param_get64ex(const char *line
, int paramnum
, int deflt
, int base
)
289 if (!param_getptr(line
, &bg
, &en
, paramnum
))
290 return strtoull(&line
[bg
], NULL
, base
);
297 int param_gethex(const char *line
, int paramnum
, uint8_t * data
, int hexcnt
)
304 if (param_getptr(line
, &bg
, &en
, paramnum
)) return 1;
306 if (en
- bg
+ 1 != hexcnt
)
309 for(i
= 0; i
< hexcnt
; i
+= 2) {
310 if (!(isxdigit(line
[bg
+ i
]) && isxdigit(line
[bg
+ i
+ 1])) ) return 1;
312 sscanf((char[]){line
[bg
+ i
], line
[bg
+ i
+ 1], 0}, "%X", &temp
);
313 data
[i
/ 2] = temp
& 0xff;
319 int param_getstr(const char *line
, int paramnum
, char * str
)
323 if (param_getptr(line
, &bg
, &en
, paramnum
)) return 0;
325 memcpy(str
, line
+ bg
, en
- bg
+ 1);
326 str
[en
- bg
+ 1] = 0;
332 The following methods comes from Rfidler sourcecode.
333 https://github.com/ApertureLabsLtd/RFIDler/blob/master/firmware/Pic32/RFIDler.X/src/
336 // convert hex to sequence of 0/1 bit values
337 // returns number of bits converted
338 int hextobinarray(char *target
, char *source
)
340 int length
, i
, count
= 0;
343 length
= strlen(source
);
344 // process 4 bits (1 hex digit) at a time
349 if (x
>= 'a' && x
<= 'f')
351 // convert to numeric value
352 if (x
>= '0' && x
<= '9')
354 else if (x
>= 'A' && x
<= 'F')
359 for(i
= 0 ; i
< 4 ; ++i
, ++count
)
360 *(target
++)= (x
>> (3 - i
)) & 1;
366 // convert hex to human readable binary string
367 int hextobinstring(char *target
, char *source
)
371 if(!(length
= hextobinarray(target
, source
)))
373 binarraytobinstring(target
, target
, length
);
377 // convert binary array of 0x00/0x01 values to hex (safe to do in place as target will always be shorter than source)
378 // return number of bits converted
379 int binarraytohex(char *target
, char *source
, int length
)
389 for(i
= x
= 0 ; i
< 4 ; ++i
)
390 x
+= ( source
[i
] << (3 - i
));
391 sprintf(target
,"%X", x
);
399 // convert binary array to human readable binary
400 void binarraytobinstring(char *target
, char *source
, int length
)
404 for(i
= 0 ; i
< length
; ++i
)
405 *(target
++)= *(source
++) + '0';
409 // return parity bit required to match type
410 uint8_t GetParity( char *bits
, uint8_t type
, int length
)
414 for(x
= 0 ; length
> 0 ; --length
)
415 x
+= bits
[length
- 1];
421 // add HID parity to binary array: EVEN prefix for 1st half of ID, ODD suffix for 2nd half
422 void wiegand_add_parity(char *target
, char *source
, char length
)
424 *(target
++)= GetParity(source
, EVEN
, length
/ 2);
425 memcpy(target
, source
, length
);
427 *(target
)= GetParity(source
+ length
/ 2, ODD
, length
/ 2);