robostep8th / Mbed 2 deprecated harurobo8th-2_ashi_master

Dependencies:   mbed

Committer:
shunsuke0427
Date:
Fri May 07 08:31:36 2021 +0000
Revision:
19:812c3572622a
Parent:
0:736c76a75def
to be published

Who changed what in which revision?

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