Rudy Raab / WIZ820ioInterface

Revised to prevent DHCPClient::discover from hanging.

Fork of WIZ820ioInterface by ban4jp -

WIZ820io/WIZ820io.cpp@9:c1722862c13b, 2014-08-15 (annotated)

Committer:
rraab
Date:
Fri Aug 15 19:53:25 2014 +0000
Revision:
9:c1722862c13b
Parent:
7:c0cd6680bcb7 
Fixed DHCPClient::discover calling rand, which hangs in an infinite loop.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
samux 1:fb4494783863 1 /* Copyright (C) 2012 mbed.org, MIT License
samux 1:fb4494783863 2 *
samux 1:fb4494783863 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
samux 1:fb4494783863 4 * and associated documentation files (the "Software"), to deal in the Software without restriction,
samux 1:fb4494783863 5 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
samux 1:fb4494783863 6 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
samux 1:fb4494783863 7 * furnished to do so, subject to the following conditions:
samux 1:fb4494783863 8 *
samux 1:fb4494783863 9 * The above copyright notice and this permission notice shall be included in all copies or
samux 1:fb4494783863 10 * substantial portions of the Software.
samux 1:fb4494783863 11 *
samux 1:fb4494783863 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
samux 1:fb4494783863 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
samux 1:fb4494783863 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
samux 1:fb4494783863 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
samux 1:fb4494783863 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
samux 1:fb4494783863 17 */
samux 1:fb4494783863 18
samux 1:fb4494783863 19 #include "mbed.h"
va009039 5:fb15c35d1e28 20 #include "mbed_debug.h"
va009039 5:fb15c35d1e28 21 #include "WIZ820io.h"
va009039 5:fb15c35d1e28 22 #include "DNSClient.h"
samux 1:fb4494783863 23
samux 1:fb4494783863 24 //Debug is disabled by default
rraab 9:c1722862c13b 25 #if 1
va009039 5:fb15c35d1e28 26 #define DBG(...) do{debug("%p %d %s ", this,__LINE__,__PRETTY_FUNCTION__); debug(__VA_ARGS__); } while(0);
va009039 5:fb15c35d1e28 27 //#define DBG(x, ...) debug("[WIZ820io:DBG]"x"\r\n", ##__VA_ARGS__);
va009039 5:fb15c35d1e28 28 #define WARN(x, ...) debug("[WIZ820io:WARN]"x"\r\n", ##__VA_ARGS__);
va009039 5:fb15c35d1e28 29 #define ERR(x, ...) debug("[WIZ820io:ERR]"x"\r\n", ##__VA_ARGS__);
samux 1:fb4494783863 30 #else
samux 1:fb4494783863 31 #define DBG(x, ...)
samux 1:fb4494783863 32 #define WARN(x, ...)
samux 1:fb4494783863 33 #define ERR(x, ...)
samux 1:fb4494783863 34 #endif
samux 1:fb4494783863 35
va009039 5:fb15c35d1e28 36 #if 1
va009039 5:fb15c35d1e28 37 #define INFO(x, ...) debug("[WIZ820io:INFO]"x"\r\n", ##__VA_ARGS__);
samux 1:fb4494783863 38 #else
samux 1:fb4494783863 39 #define INFO(x, ...)
samux 1:fb4494783863 40 #endif
samux 1:fb4494783863 41
rraab 9:c1722862c13b 42 #define DBG_SPI 1
samux 1:fb4494783863 43
va009039 5:fb15c35d1e28 44 WIZ820io* WIZ820io::inst;
samux 1:fb4494783863 45
va009039 5:fb15c35d1e28 46 WIZ820io::WIZ820io(PinName mosi, PinName miso, PinName sclk, PinName _cs, PinName _reset):
va009039 5:fb15c35d1e28 47 cs(_cs), reset_pin(_reset)
samux 1:fb4494783863 48 {
va009039 5:fb15c35d1e28 49 spi = new SPI(mosi, miso, sclk);
va009039 5:fb15c35d1e28 50 cs = 1;
va009039 5:fb15c35d1e28 51 reset_pin = 1;
va009039 5:fb15c35d1e28 52 inst = this;
va009039 5:fb15c35d1e28 53 }
samux 1:fb4494783863 54
va009039 5:fb15c35d1e28 55 WIZ820io::WIZ820io(SPI* spi, PinName _cs, PinName _reset):
va009039 5:fb15c35d1e28 56 cs(_cs), reset_pin(_reset)
va009039 5:fb15c35d1e28 57 {
va009039 5:fb15c35d1e28 58 this->spi = spi;
va009039 5:fb15c35d1e28 59 cs = 1;
va009039 5:fb15c35d1e28 60 reset_pin = 1;
va009039 5:fb15c35d1e28 61 inst = this;
va009039 5:fb15c35d1e28 62 }
va009039 5:fb15c35d1e28 63
va009039 5:fb15c35d1e28 64 bool WIZ820io::join()
va009039 5:fb15c35d1e28 65 {
va009039 5:fb15c35d1e28 66 reg_wr<uint32_t>(SIPR, ip);
va009039 5:fb15c35d1e28 67 reg_wr<uint32_t>(GAR, gateway);
va009039 5:fb15c35d1e28 68 reg_wr<uint32_t>(SUBR, netmask);
va009039 5:fb15c35d1e28 69 return true;
va009039 5:fb15c35d1e28 70 }
va009039 5:fb15c35d1e28 71
va009039 5:fb15c35d1e28 72 bool WIZ820io::setProtocol(int socket, Protocol p)
va009039 5:fb15c35d1e28 73 {
va009039 5:fb15c35d1e28 74 if (socket < 0) {
va009039 5:fb15c35d1e28 75 return false;
samux 1:fb4494783863 76 }
va009039 5:fb15c35d1e28 77 sreg<uint8_t>(socket, Sn_MR, p);
va009039 5:fb15c35d1e28 78 return true;
samux 1:fb4494783863 79 }
samux 1:fb4494783863 80
va009039 5:fb15c35d1e28 81 bool WIZ820io::connect(int socket, const char * host, int port, int timeout_ms)
samux 1:fb4494783863 82 {
va009039 5:fb15c35d1e28 83 if (socket < 0) {
va009039 5:fb15c35d1e28 84 return false;
va009039 5:fb15c35d1e28 85 }
va009039 5:fb15c35d1e28 86 sreg<uint8_t>(socket, Sn_MR, TCP);
va009039 5:fb15c35d1e28 87 scmd(socket, OPEN);
va009039 5:fb15c35d1e28 88 sreg_ip(socket, Sn_DIPR, host);
va009039 5:fb15c35d1e28 89 sreg<uint16_t>(socket, Sn_DPORT, port);
va009039 5:fb15c35d1e28 90 sreg<uint16_t>(socket, Sn_PORT, new_port());
va009039 5:fb15c35d1e28 91 scmd(socket, CONNECT);
va009039 5:fb15c35d1e28 92 Timer t;
va009039 5:fb15c35d1e28 93 t.reset();
va009039 5:fb15c35d1e28 94 t.start();
va009039 5:fb15c35d1e28 95 while(!is_connected(socket)) {
va009039 5:fb15c35d1e28 96 if (t.read_ms() > timeout_ms) {
va009039 5:fb15c35d1e28 97 return false;
va009039 5:fb15c35d1e28 98 }
va009039 5:fb15c35d1e28 99 }
va009039 5:fb15c35d1e28 100 return true;
va009039 5:fb15c35d1e28 101 }
samux 1:fb4494783863 102
va009039 5:fb15c35d1e28 103 bool WIZ820io::gethostbyname(const char* host, uint32_t* ip)
va009039 5:fb15c35d1e28 104 {
va009039 5:fb15c35d1e28 105 uint32_t addr = str_to_ip(host);
va009039 5:fb15c35d1e28 106 char buf[17];
va009039 5:fb15c35d1e28 107 snprintf(buf, sizeof(buf), "%d.%d.%d.%d", (addr>>24)&0xff, (addr>>16)&0xff, (addr>>8)&0xff, addr&0xff);
va009039 5:fb15c35d1e28 108 if (strcmp(buf, host) == 0) {
va009039 5:fb15c35d1e28 109 *ip = addr;
va009039 5:fb15c35d1e28 110 return true;
va009039 5:fb15c35d1e28 111 }
va009039 5:fb15c35d1e28 112 DNSClient client;
va009039 5:fb15c35d1e28 113 if(client.lookup(host)) {
va009039 5:fb15c35d1e28 114 *ip = client.ip;
va009039 5:fb15c35d1e28 115 return true;
va009039 5:fb15c35d1e28 116 }
va009039 5:fb15c35d1e28 117 return false;
va009039 5:fb15c35d1e28 118 }
samux 1:fb4494783863 119
va009039 5:fb15c35d1e28 120 bool WIZ820io::disconnect()
va009039 5:fb15c35d1e28 121 {
va009039 5:fb15c35d1e28 122 return true;
va009039 5:fb15c35d1e28 123 }
samux 1:fb4494783863 124
va009039 5:fb15c35d1e28 125 bool WIZ820io::is_connected(int socket)
va009039 5:fb15c35d1e28 126 {
va009039 5:fb15c35d1e28 127 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_ESTABLISHED) {
samux 1:fb4494783863 128 return true;
samux 1:fb4494783863 129 }
samux 1:fb4494783863 130 return false;
samux 1:fb4494783863 131 }
samux 1:fb4494783863 132
va009039 5:fb15c35d1e28 133 void WIZ820io::reset()
samux 1:fb4494783863 134 {
va009039 5:fb15c35d1e28 135 reset_pin = 1;
va009039 5:fb15c35d1e28 136 reset_pin = 0;
va009039 5:fb15c35d1e28 137 wait_us(2); // 2us
va009039 5:fb15c35d1e28 138 reset_pin = 1;
va009039 5:fb15c35d1e28 139 wait_ms(150); // 150ms
ban4jp 7:c0cd6680bcb7 140
va009039 5:fb15c35d1e28 141 reg_wr<uint8_t>(MR, 1<<7);
ban4jp 7:c0cd6680bcb7 142
va009039 5:fb15c35d1e28 143 #ifdef TARGET_LPC1114
va009039 5:fb15c35d1e28 144 uint8_t mac[6] = {0x00,0x02,0xf7,0xf0,0x00,0x00};
va009039 5:fb15c35d1e28 145 #else
rraab 9:c1722862c13b 146 uint8_t mac[6] = {0x00,0x02,0xf7,0xf0,0x00,0x00};
rraab 9:c1722862c13b 147 //mbed_mac_address((char*)mac);
va009039 5:fb15c35d1e28 148 #endif
rraab 9:c1722862c13b 149 printf("Writing MAC...\r\n");
va009039 5:fb15c35d1e28 150 reg_wr_mac(SHAR, mac);
samux 1:fb4494783863 151 }
samux 1:fb4494783863 152
va009039 5:fb15c35d1e28 153 bool WIZ820io::close(int socket)
samux 1:fb4494783863 154 {
va009039 5:fb15c35d1e28 155 if (socket < 0) {
samux 1:fb4494783863 156 return false;
samux 1:fb4494783863 157 }
va009039 5:fb15c35d1e28 158 // if not connected, return
va009039 5:fb15c35d1e28 159 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_CLOSED) {
samux 1:fb4494783863 160 return true;
samux 1:fb4494783863 161 }
va009039 5:fb15c35d1e28 162 if (sreg<uint8_t>(socket, Sn_MR) == TCP) {
va009039 5:fb15c35d1e28 163 scmd(socket, DISCON);
va009039 5:fb15c35d1e28 164 }
va009039 5:fb15c35d1e28 165 scmd(socket, CLOSE);
ban4jp 7:c0cd6680bcb7 166 sreg<uint8_t>(socket, Sn_IR, 0xff);
samux 1:fb4494783863 167 return true;
samux 1:fb4494783863 168 }
samux 1:fb4494783863 169
va009039 5:fb15c35d1e28 170 int WIZ820io::wait_readable(int socket, int wait_time_ms, int req_size)
samux 1:fb4494783863 171 {
va009039 5:fb15c35d1e28 172 if (socket < 0) {
va009039 5:fb15c35d1e28 173 return -1;
va009039 5:fb15c35d1e28 174 }
va009039 5:fb15c35d1e28 175 Timer t;
va009039 5:fb15c35d1e28 176 t.reset();
va009039 5:fb15c35d1e28 177 t.start();
va009039 5:fb15c35d1e28 178 while(1) {
va009039 5:fb15c35d1e28 179 int size = sreg<uint16_t>(socket, Sn_RX_RSR);
va009039 5:fb15c35d1e28 180 if (size > req_size) {
va009039 5:fb15c35d1e28 181 return size;
va009039 5:fb15c35d1e28 182 }
va009039 5:fb15c35d1e28 183 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
va009039 5:fb15c35d1e28 184 break;
va009039 5:fb15c35d1e28 185 }
va009039 5:fb15c35d1e28 186 }
va009039 5:fb15c35d1e28 187 return -1;
samux 1:fb4494783863 188 }
samux 1:fb4494783863 189
va009039 5:fb15c35d1e28 190 int WIZ820io::wait_writeable(int socket, int wait_time_ms, int req_size)
samux 1:fb4494783863 191 {
va009039 5:fb15c35d1e28 192 if (socket < 0) {
va009039 5:fb15c35d1e28 193 return -1;
va009039 5:fb15c35d1e28 194 }
va009039 5:fb15c35d1e28 195 Timer t;
va009039 5:fb15c35d1e28 196 t.reset();
va009039 5:fb15c35d1e28 197 t.start();
va009039 5:fb15c35d1e28 198 while(1) {
va009039 5:fb15c35d1e28 199 int size = sreg<uint16_t>(socket, Sn_TX_FSR);
va009039 5:fb15c35d1e28 200 if (size > req_size) {
va009039 5:fb15c35d1e28 201 return size;
va009039 5:fb15c35d1e28 202 }
va009039 5:fb15c35d1e28 203 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
va009039 5:fb15c35d1e28 204 break;
va009039 5:fb15c35d1e28 205 }
va009039 5:fb15c35d1e28 206 }
va009039 5:fb15c35d1e28 207 return -1;
samux 3:9aa05e19c62e 208 }
samux 3:9aa05e19c62e 209
va009039 5:fb15c35d1e28 210 int WIZ820io::send(int socket, const char * str, int len)
samux 1:fb4494783863 211 {
va009039 5:fb15c35d1e28 212 if (socket < 0) {
va009039 5:fb15c35d1e28 213 return -1;
va009039 5:fb15c35d1e28 214 }
va009039 5:fb15c35d1e28 215 uint16_t base = 0x8000 + socket * 0x800;
va009039 5:fb15c35d1e28 216 uint16_t ptr = sreg<uint16_t>(socket, Sn_TX_WR);
va009039 5:fb15c35d1e28 217 uint16_t dst = base + (ptr&(0x800-1));
va009039 5:fb15c35d1e28 218 if ((dst + len) > (base+0x800)) {
va009039 5:fb15c35d1e28 219 int len2 = base + 0x800 - dst;
va009039 5:fb15c35d1e28 220 spi_write(dst, (uint8_t*)str, len2);
va009039 5:fb15c35d1e28 221 spi_write(base, (uint8_t*)str+len2, len-len2);
va009039 5:fb15c35d1e28 222 } else {
va009039 5:fb15c35d1e28 223 spi_write(dst, (uint8_t*)str, len);
va009039 5:fb15c35d1e28 224 }
va009039 5:fb15c35d1e28 225 sreg<uint16_t>(socket, Sn_TX_WR, ptr + len);
va009039 5:fb15c35d1e28 226 scmd(socket, SEND);
va009039 5:fb15c35d1e28 227 return len;
samux 1:fb4494783863 228 }
samux 1:fb4494783863 229
va009039 5:fb15c35d1e28 230 int WIZ820io::recv(int socket, char* buf, int len)
samux 1:fb4494783863 231 {
va009039 5:fb15c35d1e28 232 if (socket < 0) {
va009039 5:fb15c35d1e28 233 return -1;
va009039 5:fb15c35d1e28 234 }
va009039 5:fb15c35d1e28 235 uint16_t base = 0xc000 + socket * 0x800;
va009039 5:fb15c35d1e28 236 uint16_t ptr = sreg<uint16_t>(socket, Sn_RX_RD);
va009039 5:fb15c35d1e28 237 uint16_t src = base + (ptr&(0x800-1));
va009039 5:fb15c35d1e28 238 if ((src + len) > (base+0x800)) {
va009039 5:fb15c35d1e28 239 int len2 = base + 0x800 - src;
va009039 5:fb15c35d1e28 240 spi_read(src, (uint8_t*)buf, len2);
va009039 5:fb15c35d1e28 241 spi_read(base, (uint8_t*)buf+len2, len-len2);
va009039 5:fb15c35d1e28 242 } else {
va009039 5:fb15c35d1e28 243 spi_read(src, (uint8_t*)buf, len);
va009039 5:fb15c35d1e28 244 }
va009039 5:fb15c35d1e28 245 sreg<uint16_t>(socket, Sn_RX_RD, ptr + len);
va009039 5:fb15c35d1e28 246 scmd(socket, RECV);
va009039 5:fb15c35d1e28 247 return len;
samux 1:fb4494783863 248 }
samux 1:fb4494783863 249
va009039 5:fb15c35d1e28 250 int WIZ820io::new_socket()
samux 1:fb4494783863 251 {
va009039 5:fb15c35d1e28 252 for(int s = 0; s < 8; s++) {
va009039 5:fb15c35d1e28 253 if (sreg<uint8_t>(s, Sn_SR) == SOCK_CLOSED) {
va009039 5:fb15c35d1e28 254 return s;
va009039 5:fb15c35d1e28 255 }
va009039 5:fb15c35d1e28 256 }
va009039 5:fb15c35d1e28 257 return -1;
samux 1:fb4494783863 258 }
samux 1:fb4494783863 259
va009039 5:fb15c35d1e28 260 uint16_t WIZ820io::new_port()
samux 1:fb4494783863 261 {
va009039 5:fb15c35d1e28 262 uint16_t port = rand();
va009039 5:fb15c35d1e28 263 port |= 49152;
va009039 5:fb15c35d1e28 264 return port;
samux 1:fb4494783863 265 }
samux 1:fb4494783863 266
va009039 5:fb15c35d1e28 267 void WIZ820io::scmd(int socket, Command cmd)
samux 1:fb4494783863 268 {
va009039 5:fb15c35d1e28 269 sreg<uint8_t>(socket, Sn_CR, cmd);
ban4jp 7:c0cd6680bcb7 270 while(sreg<uint8_t>(socket, Sn_CR));
samux 1:fb4494783863 271 }
samux 1:fb4494783863 272
va009039 5:fb15c35d1e28 273 void WIZ820io::spi_write(uint16_t addr, const uint8_t *buf, uint16_t len)
samux 1:fb4494783863 274 {
va009039 5:fb15c35d1e28 275 cs = 0;
va009039 5:fb15c35d1e28 276 spi->write(addr >> 8);
va009039 5:fb15c35d1e28 277 spi->write(addr & 0xff);
va009039 5:fb15c35d1e28 278 spi->write((0x80 | ((len & 0x7f00) >> 8)));
va009039 5:fb15c35d1e28 279 spi->write(len & 0xff);
va009039 5:fb15c35d1e28 280 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 281 spi->write(buf[i]);
va009039 5:fb15c35d1e28 282 }
va009039 5:fb15c35d1e28 283 cs = 1;
va009039 5:fb15c35d1e28 284
va009039 5:fb15c35d1e28 285 #if DBG_SPI
va009039 5:fb15c35d1e28 286 debug("[SPI]W %04x(%d)", addr, len);
va009039 5:fb15c35d1e28 287 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 288 debug(" %02x", buf[i]);
va009039 5:fb15c35d1e28 289 if (i > 16) {
va009039 5:fb15c35d1e28 290 debug(" ...");
va009039 5:fb15c35d1e28 291 break;
va009039 5:fb15c35d1e28 292 }
va009039 5:fb15c35d1e28 293 }
va009039 5:fb15c35d1e28 294 debug("\r\n");
va009039 5:fb15c35d1e28 295 #endif
va009039 5:fb15c35d1e28 296 }
va009039 5:fb15c35d1e28 297
va009039 5:fb15c35d1e28 298 void WIZ820io::spi_read(uint16_t addr, uint8_t *buf, uint16_t len)
va009039 5:fb15c35d1e28 299 {
va009039 5:fb15c35d1e28 300 cs = 0;
va009039 5:fb15c35d1e28 301 spi->write(addr >> 8);
va009039 5:fb15c35d1e28 302 spi->write(addr & 0xff);
va009039 5:fb15c35d1e28 303 spi->write((0x00 | ((len & 0x7f00) >> 8)));
va009039 5:fb15c35d1e28 304 spi->write(len & 0xff);
va009039 5:fb15c35d1e28 305 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 306 buf[i] = spi->write(0);
va009039 5:fb15c35d1e28 307 }
va009039 5:fb15c35d1e28 308 cs = 1;
va009039 5:fb15c35d1e28 309
va009039 5:fb15c35d1e28 310 #if DBG_SPI
va009039 5:fb15c35d1e28 311 debug("[SPI]R %04x(%d)", addr, len);
va009039 5:fb15c35d1e28 312 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 313 debug(" %02x", buf[i]);
va009039 5:fb15c35d1e28 314 if (i > 16) {
va009039 5:fb15c35d1e28 315 debug(" ...");
va009039 5:fb15c35d1e28 316 break;
va009039 5:fb15c35d1e28 317 }
va009039 5:fb15c35d1e28 318 }
va009039 5:fb15c35d1e28 319 debug("\r\n");
va009039 5:fb15c35d1e28 320 if ((addr&0xf0ff)==0x4026 || (addr&0xf0ff)==0x4003) {
va009039 5:fb15c35d1e28 321 wait_ms(200);
va009039 5:fb15c35d1e28 322 }
va009039 5:fb15c35d1e28 323 #endif
samux 1:fb4494783863 324 }
samux 1:fb4494783863 325
va009039 5:fb15c35d1e28 326 uint32_t str_to_ip(const char* str)
samux 1:fb4494783863 327 {
va009039 5:fb15c35d1e28 328 uint32_t ip = 0;
va009039 5:fb15c35d1e28 329 char* p = (char*)str;
va009039 5:fb15c35d1e28 330 for(int i = 0; i < 4; i++) {
va009039 5:fb15c35d1e28 331 ip |= atoi(p);
va009039 5:fb15c35d1e28 332 p = strchr(p, '.');
va009039 5:fb15c35d1e28 333 if (p == NULL) {
va009039 5:fb15c35d1e28 334 break;
va009039 5:fb15c35d1e28 335 }
va009039 5:fb15c35d1e28 336 ip <<= 8;
va009039 5:fb15c35d1e28 337 p++;
va009039 5:fb15c35d1e28 338 }
va009039 5:fb15c35d1e28 339 return ip;
va009039 5:fb15c35d1e28 340 }
samux 1:fb4494783863 341
va009039 5:fb15c35d1e28 342 void printfBytes(char* str, uint8_t* buf, int len)
va009039 5:fb15c35d1e28 343 {
va009039 5:fb15c35d1e28 344 printf("%s %d:", str, len);
va009039 5:fb15c35d1e28 345 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 346 printf(" %02x", buf[i]);
va009039 5:fb15c35d1e28 347 }
va009039 5:fb15c35d1e28 348 printf("\n");
va009039 5:fb15c35d1e28 349 }
samux 1:fb4494783863 350
va009039 5:fb15c35d1e28 351 void printHex(uint8_t* buf, int len)
va009039 5:fb15c35d1e28 352 {
va009039 5:fb15c35d1e28 353 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 354 if ((i%16) == 0) {
va009039 5:fb15c35d1e28 355 printf("%p", buf+i);
samux 1:fb4494783863 356 }
va009039 5:fb15c35d1e28 357 printf(" %02x", buf[i]);
va009039 5:fb15c35d1e28 358 if ((i%16) == 15) {
va009039 5:fb15c35d1e28 359 printf("\n");
va009039 5:fb15c35d1e28 360 }
samux 1:fb4494783863 361 }
va009039 5:fb15c35d1e28 362 printf("\n");
va009039 5:fb15c35d1e28 363 }
samux 1:fb4494783863 364
va009039 5:fb15c35d1e28 365 void debug_hex(uint8_t* buf, int len)
va009039 5:fb15c35d1e28 366 {
va009039 5:fb15c35d1e28 367 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 368 if ((i%16) == 0) {
va009039 5:fb15c35d1e28 369 debug("%p", buf+i);
samux 1:fb4494783863 370 }
va009039 5:fb15c35d1e28 371 debug(" %02x", buf[i]);
va009039 5:fb15c35d1e28 372 if ((i%16) == 15) {
va009039 5:fb15c35d1e28 373 debug("\n");
va009039 5:fb15c35d1e28 374 }
samux 1:fb4494783863 375 }
va009039 5:fb15c35d1e28 376 debug("\n");
va009039 5:fb15c35d1e28 377 }