Birdy YAP / Birdy_BlueWIi

Dependents:   Test_Wiimote

Utils.cpp@0:f6f434d9a03a, 2011-12-17 (annotated)

Committer:
bediyap
Date:
Sat Dec 17 02:17:39 2011 +0000
Revision:
0:f6f434d9a03a
connect to particular wii

Who changed what in which revision?

UserRevisionLine numberNew contents of line
bediyap 0:f6f434d9a03a 1
bediyap 0:f6f434d9a03a 2
bediyap 0:f6f434d9a03a 3 #include "mbed.h"
bediyap 0:f6f434d9a03a 4 #include "Utils.h"
bediyap 0:f6f434d9a03a 5
bediyap 0:f6f434d9a03a 6 void printfBytes(const char* s, const u8* data, int len)
bediyap 0:f6f434d9a03a 7 {
bediyap 0:f6f434d9a03a 8 printf("%s %d:",s,len);
bediyap 0:f6f434d9a03a 9 if (len > 256)
bediyap 0:f6f434d9a03a 10 len = 256;
bediyap 0:f6f434d9a03a 11 while (len-- > 0)
bediyap 0:f6f434d9a03a 12 printf(" %02X",*data++);
bediyap 0:f6f434d9a03a 13 printf("\n");
bediyap 0:f6f434d9a03a 14 }
bediyap 0:f6f434d9a03a 15
bediyap 0:f6f434d9a03a 16 void printHexLine(const u8* d, int addr, int len)
bediyap 0:f6f434d9a03a 17 {
bediyap 0:f6f434d9a03a 18 printf("%04X ",addr);
bediyap 0:f6f434d9a03a 19 int i;
bediyap 0:f6f434d9a03a 20 for (i = 0; i < len; i++)
bediyap 0:f6f434d9a03a 21 printf("%02X ",d[i]);
bediyap 0:f6f434d9a03a 22 for (;i < 16; i++)
bediyap 0:f6f434d9a03a 23 printf(" ");
bediyap 0:f6f434d9a03a 24 char s[16+1];
bediyap 0:f6f434d9a03a 25 memset(s,0,sizeof(s));
bediyap 0:f6f434d9a03a 26 for (i = 0; i < len; i++)
bediyap 0:f6f434d9a03a 27 {
bediyap 0:f6f434d9a03a 28 int c = d[i];
bediyap 0:f6f434d9a03a 29 if (c < 0x20 || c > 0x7E)
bediyap 0:f6f434d9a03a 30 c = '.';
bediyap 0:f6f434d9a03a 31 s[i] = c;
bediyap 0:f6f434d9a03a 32 }
bediyap 0:f6f434d9a03a 33 printf("%s\n",s);
bediyap 0:f6f434d9a03a 34 }
bediyap 0:f6f434d9a03a 35
bediyap 0:f6f434d9a03a 36 void printHex(const u8* d, int len)
bediyap 0:f6f434d9a03a 37 {
bediyap 0:f6f434d9a03a 38 int addr = 0;
bediyap 0:f6f434d9a03a 39 while (len)
bediyap 0:f6f434d9a03a 40 {
bediyap 0:f6f434d9a03a 41 int count = len;
bediyap 0:f6f434d9a03a 42 if (count > 16)
bediyap 0:f6f434d9a03a 43 count = 16;
bediyap 0:f6f434d9a03a 44 printHexLine(d+addr,addr,count);
bediyap 0:f6f434d9a03a 45 addr += 16;
bediyap 0:f6f434d9a03a 46 len -= count;
bediyap 0:f6f434d9a03a 47 }
bediyap 0:f6f434d9a03a 48 }