//-----------------------------------------------------------------------------
#include "util.h"
-void print_result(char *name, uint8_t *buf, size_t len) {
- uint8_t *p = buf;
-
- if ( len % 16 == 0 ) {
- for(; p-buf < len; p += 16)
- Dbprintf("[%s:%d/%d] %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x",
- name,
- p-buf,
- len,
- p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7],p[8], p[9], p[10], p[11], p[12], p[13], p[14], p[15]
- );
- }
- else {
- for(; p-buf < len; p += 8)
- Dbprintf("[%s:%d/%d] %02x %02x %02x %02x %02x %02x %02x %02x",
- name,
- p-buf,
- len,
- p[0], p[1], p[2], p[3], p[4], p[5], p[6], p[7]);
- }
-}
-
size_t nbytes(size_t nbits) {
return (nbits >> 3)+((nbits % 8) > 0);
}
return (data[2] << 16) | (data[1] << 8) | data[0];
}
+//convert hex digit to integer
+uint8_t hex2int(char hexchar){
+ switch(hexchar){
+ case '0': return 0; break;
+ case '1': return 1; break;
+ case '2': return 2; break;
+ case '3': return 3; break;
+ case '4': return 4; break;
+ case '5': return 5; break;
+ case '6': return 6; break;
+ case '7': return 7; break;
+ case '8': return 8; break;
+ case '9': return 9; break;
+ case 'a':
+ case 'A': return 10; break;
+ case 'b':
+ case 'B': return 11; break;
+ case 'c':
+ case 'C': return 12; break;
+ case 'd':
+ case 'D': return 13; break;
+ case 'e':
+ case 'E': return 14; break;
+ case 'f':
+ case 'F': return 15; break;
+ default:
+ return 0;
+ }
+}
+
void LEDsoff() {
LED_A_OFF();
LED_B_OFF();