//-----------------------------------------------------------------------------
#include "util.h"
+#define MAX_BIN_BREAK_LENGTH (3072+384+1)
#ifndef _WIN32
#include <termios.h>
}
char *sprint_bin_break(const uint8_t *data, const size_t len, const uint8_t breaks) {
-
- int maxLen = ( len > 1020) ? 1020 : len;
- static char buf[1024];
- memset(buf, 0x00, 1024);
+ // make sure we don't go beyond our char array memory
+ int max_len = ( len+(len/breaks) > MAX_BIN_BREAK_LENGTH ) ? MAX_BIN_BREAK_LENGTH : len+(len/breaks);
+ static char buf[MAX_BIN_BREAK_LENGTH]; // 3072 + end of line characters if broken at 8 bits
+ //clear memory
+ memset(buf, 0x00, sizeof(buf));
char *tmp = buf;
- for (size_t i=0; i < maxLen; ++i){
- sprintf(tmp++, "%u", data[i]);
- if (breaks > 0 && !((i+1) % breaks))
+ size_t in_index = 0;
+ // loop through the out_index to make sure we don't go too far
+ for (size_t out_index=0; out_index < max_len; out_index++) {
+ // set character
+ sprintf(tmp++, "%u", data[in_index]);
+ // check if a line break is needed
+ if ( (breaks > 0) && !((in_index+1) % breaks) && (out_index+1 != max_len) ) {
+ // increment and print line break
+ out_index++;
sprintf(tmp++, "%s","\n");
}
+ in_index++;
+ }
return buf;
}
// hh,gg,ff,ee,dd,cc,bb,aa, pp,oo,nn,mm,ll,kk,jj,ii
// up to 64 bytes or 512 bits
uint8_t *SwapEndian64(const uint8_t *src, const size_t len, const uint8_t blockSize){
- static uint8_t buf[64];
+ //static uint8_t buf[64];
+ uint8_t buf[64];
memset(buf, 0x00, 64);
uint8_t *tmp = buf;
for (uint8_t block=0; block < (uint8_t)(len/blockSize); block++){
return (data[2] << 16) | (data[1] << 8) | data[0];
}
-
uint32_t PackBits(uint8_t start, uint8_t len, uint8_t* bits) {
+
+ if (len > 32) return 0;
int i = start;
int j = len-1;
-
- if (len > 32) return 0;
-
uint32_t tmp = 0;
+
for (; j >= 0; --j, ++i)
tmp |= bits[i] << j;
return tmp;
}
+
+// RotateLeft - Ultralight, Desfire
+void rol(uint8_t *data, const size_t len){
+ uint8_t first = data[0];
+ for (size_t i = 0; i < len-1; i++) {
+ data[i] = data[i+1];
+ }
+ data[len-1] = first;
+}
\ No newline at end of file