X-Git-Url: http://git.rot13.org/?p=goodfet;a=blobdiff_plain;f=firmware%2Flib%2Fcommand.c;h=415171b732d9bc011f1c559acc8d6b1409d7a2ef;hp=d984fca791feb33f357e38223acde6d73d0bd090;hb=d27d75e4cedfab56742717f3ac990be059f8e168;hpb=f4a6b415e762bcdc560f3ea655851d16f483ea5a diff --git a/firmware/lib/command.c b/firmware/lib/command.c index d984fca..415171b 100644 --- a/firmware/lib/command.c +++ b/firmware/lib/command.c @@ -30,13 +30,47 @@ void debugstr(const char *str){ txstring(0xFF,0xFF,str); } +//! brief Debug a hex word string. +void debughex(u16 v) { + unsigned char a[7]; + a[0]='0'; a[1]='x'; + + a[2]=0xf&(v>>12); + a[2]+=(a[2]>9)?('a'-10):'0'; + + a[3]=0xf&(v>>8); + a[3]+=(a[3]>9)?('a'-10):'0'; + + a[4]=0xf&(v>>4); + a[4]+=(a[4]>9)?('a'-10):'0'; + + a[5]=0xf&(v>>0); + a[5]+=(a[5]>9)?('a'-10):'0'; + + a[6]=0; + + txstring(0xFF,0xFF,a); +} + +/*! \brief Transmit debug bytes. + + Transmits bytes for debugging. +*/ +void debugbytes(const char *bytes, unsigned int len){ + u16 i; + txhead(0xFF,0xFE,len); + for(i=0;i