ban4jp - / WIZ550ioInterface

WIZnet WIZ550io (w5500) support

Dependents:   HTTPClient_HelloWorld_WIZ550io NTPClient_HelloWorld_WIZ550io

Fork of WIZ820ioInterface by ban4jp -

WIZ820io/WIZ820io.cpp@9:615198a7b82b, 2013-12-23 (annotated)

Committer:
ban4jp
Date:
Mon Dec 23 13:51:35 2013 +0000
Revision:
9:615198a7b82b
Parent:
8:8bdf6aac8cea 
Use on-board MAC Address.; Fixed compatibility.

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
va009039 5:fb15c35d1e28 25 #if 0
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
va009039 5:fb15c35d1e28 42 #define DBG_SPI 0
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;
ban4jp 7:93e358253dd8 137 //wait_us(2); // 2us
ban4jp 8:8bdf6aac8cea 138 wait_us(500); // 500us (w5500)
va009039 5:fb15c35d1e28 139 reset_pin = 1;
ban4jp 7:93e358253dd8 140 //wait_ms(150); // 150ms
ban4jp 8:8bdf6aac8cea 141 wait_ms(300); // 300ms (w5500)
ban4jp 9:615198a7b82b 142
ban4jp 9:615198a7b82b 143 //reg_wr<uint8_t>(MR, 1<<7);
ban4jp 9:615198a7b82b 144
ban4jp 9:615198a7b82b 145 //#ifdef TARGET_LPC1114
ban4jp 9:615198a7b82b 146 // uint8_t mac[6] = {0x00,0x02,0xf7,0xf0,0x00,0x00};
ban4jp 9:615198a7b82b 147 //#else
ban4jp 9:615198a7b82b 148 // uint8_t mac[6];
ban4jp 9:615198a7b82b 149 // mbed_mac_address((char*)mac);
ban4jp 9:615198a7b82b 150 //#endif
ban4jp 9:615198a7b82b 151 // reg_wr_mac(SHAR, mac);
ban4jp 9:615198a7b82b 152
ban4jp 9:615198a7b82b 153 // set RX and TX buffer size
ban4jp 9:615198a7b82b 154 for (int socket = 0; socket < MAX_SOCK_NUM; socket++) {
ban4jp 9:615198a7b82b 155 sreg<uint8_t>(socket, Sn_RXBUF_SIZE, 2);
ban4jp 9:615198a7b82b 156 sreg<uint8_t>(socket, Sn_TXBUF_SIZE, 2);
ban4jp 9:615198a7b82b 157 }
samux 1:fb4494783863 158 }
samux 1:fb4494783863 159
va009039 5:fb15c35d1e28 160 bool WIZ820io::close(int socket)
samux 1:fb4494783863 161 {
va009039 5:fb15c35d1e28 162 if (socket < 0) {
samux 1:fb4494783863 163 return false;
samux 1:fb4494783863 164 }
va009039 5:fb15c35d1e28 165 // if not connected, return
va009039 5:fb15c35d1e28 166 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_CLOSED) {
samux 1:fb4494783863 167 return true;
samux 1:fb4494783863 168 }
va009039 5:fb15c35d1e28 169 if (sreg<uint8_t>(socket, Sn_MR) == TCP) {
va009039 5:fb15c35d1e28 170 scmd(socket, DISCON);
va009039 5:fb15c35d1e28 171 }
va009039 5:fb15c35d1e28 172 scmd(socket, CLOSE);
ban4jp 9:615198a7b82b 173 sreg<uint8_t>(socket, Sn_IR, 0xff);
samux 1:fb4494783863 174 return true;
samux 1:fb4494783863 175 }
samux 1:fb4494783863 176
va009039 5:fb15c35d1e28 177 int WIZ820io::wait_readable(int socket, int wait_time_ms, int req_size)
samux 1:fb4494783863 178 {
va009039 5:fb15c35d1e28 179 if (socket < 0) {
va009039 5:fb15c35d1e28 180 return -1;
va009039 5:fb15c35d1e28 181 }
va009039 5:fb15c35d1e28 182 Timer t;
va009039 5:fb15c35d1e28 183 t.reset();
va009039 5:fb15c35d1e28 184 t.start();
va009039 5:fb15c35d1e28 185 while(1) {
va009039 5:fb15c35d1e28 186 int size = sreg<uint16_t>(socket, Sn_RX_RSR);
va009039 5:fb15c35d1e28 187 if (size > req_size) {
va009039 5:fb15c35d1e28 188 return size;
va009039 5:fb15c35d1e28 189 }
va009039 5:fb15c35d1e28 190 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
va009039 5:fb15c35d1e28 191 break;
va009039 5:fb15c35d1e28 192 }
va009039 5:fb15c35d1e28 193 }
va009039 5:fb15c35d1e28 194 return -1;
samux 1:fb4494783863 195 }
samux 1:fb4494783863 196
va009039 5:fb15c35d1e28 197 int WIZ820io::wait_writeable(int socket, int wait_time_ms, int req_size)
samux 1:fb4494783863 198 {
va009039 5:fb15c35d1e28 199 if (socket < 0) {
va009039 5:fb15c35d1e28 200 return -1;
va009039 5:fb15c35d1e28 201 }
va009039 5:fb15c35d1e28 202 Timer t;
va009039 5:fb15c35d1e28 203 t.reset();
va009039 5:fb15c35d1e28 204 t.start();
va009039 5:fb15c35d1e28 205 while(1) {
va009039 5:fb15c35d1e28 206 int size = sreg<uint16_t>(socket, Sn_TX_FSR);
va009039 5:fb15c35d1e28 207 if (size > req_size) {
va009039 5:fb15c35d1e28 208 return size;
va009039 5:fb15c35d1e28 209 }
va009039 5:fb15c35d1e28 210 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
va009039 5:fb15c35d1e28 211 break;
va009039 5:fb15c35d1e28 212 }
va009039 5:fb15c35d1e28 213 }
va009039 5:fb15c35d1e28 214 return -1;
samux 3:9aa05e19c62e 215 }
samux 3:9aa05e19c62e 216
va009039 5:fb15c35d1e28 217 int WIZ820io::send(int socket, const char * str, int len)
samux 1:fb4494783863 218 {
va009039 5:fb15c35d1e28 219 if (socket < 0) {
va009039 5:fb15c35d1e28 220 return -1;
va009039 5:fb15c35d1e28 221 }
va009039 5:fb15c35d1e28 222 uint16_t ptr = sreg<uint16_t>(socket, Sn_TX_WR);
ban4jp 7:93e358253dd8 223 uint8_t cntl_byte = (0x14 + (socket << 5));
ban4jp 7:93e358253dd8 224 spi_write(ptr, cntl_byte, (uint8_t*)str, len);
va009039 5:fb15c35d1e28 225 sreg<uint16_t>(socket, Sn_TX_WR, ptr + len);
va009039 5:fb15c35d1e28 226 scmd(socket, SEND);
ban4jp 9:615198a7b82b 227
ban4jp 9:615198a7b82b 228 while ((sreg<uint8_t>(socket, Sn_IR) & INT_SEND_OK) != INT_SEND_OK) {
ban4jp 9:615198a7b82b 229 if (sreg<uint8_t>(socket, Sn_SR) == CLOSED) {
ban4jp 9:615198a7b82b 230 close(socket);
ban4jp 9:615198a7b82b 231 return 0;
ban4jp 9:615198a7b82b 232 }
ban4jp 9:615198a7b82b 233 }
ban4jp 9:615198a7b82b 234 sreg<uint8_t>(socket, Sn_IR, INT_SEND_OK);
ban4jp 9:615198a7b82b 235
va009039 5:fb15c35d1e28 236 return len;
samux 1:fb4494783863 237 }
samux 1:fb4494783863 238
va009039 5:fb15c35d1e28 239 int WIZ820io::recv(int socket, char* buf, int len)
samux 1:fb4494783863 240 {
va009039 5:fb15c35d1e28 241 if (socket < 0) {
va009039 5:fb15c35d1e28 242 return -1;
va009039 5:fb15c35d1e28 243 }
va009039 5:fb15c35d1e28 244 uint16_t ptr = sreg<uint16_t>(socket, Sn_RX_RD);
ban4jp 7:93e358253dd8 245 uint8_t cntl_byte = (0x18 + (socket << 5));
ban4jp 7:93e358253dd8 246 spi_read(ptr, cntl_byte, (uint8_t*)buf, len);
va009039 5:fb15c35d1e28 247 sreg<uint16_t>(socket, Sn_RX_RD, ptr + len);
va009039 5:fb15c35d1e28 248 scmd(socket, RECV);
va009039 5:fb15c35d1e28 249 return len;
samux 1:fb4494783863 250 }
samux 1:fb4494783863 251
va009039 5:fb15c35d1e28 252 int WIZ820io::new_socket()
samux 1:fb4494783863 253 {
va009039 5:fb15c35d1e28 254 for(int s = 0; s < 8; s++) {
va009039 5:fb15c35d1e28 255 if (sreg<uint8_t>(s, Sn_SR) == SOCK_CLOSED) {
va009039 5:fb15c35d1e28 256 return s;
va009039 5:fb15c35d1e28 257 }
va009039 5:fb15c35d1e28 258 }
va009039 5:fb15c35d1e28 259 return -1;
samux 1:fb4494783863 260 }
samux 1:fb4494783863 261
va009039 5:fb15c35d1e28 262 uint16_t WIZ820io::new_port()
samux 1:fb4494783863 263 {
va009039 5:fb15c35d1e28 264 uint16_t port = rand();
va009039 5:fb15c35d1e28 265 port |= 49152;
va009039 5:fb15c35d1e28 266 return port;
samux 1:fb4494783863 267 }
samux 1:fb4494783863 268
va009039 5:fb15c35d1e28 269 void WIZ820io::scmd(int socket, Command cmd)
samux 1:fb4494783863 270 {
va009039 5:fb15c35d1e28 271 sreg<uint8_t>(socket, Sn_CR, cmd);
ban4jp 7:93e358253dd8 272 while(sreg<uint8_t>(socket, Sn_CR));
samux 1:fb4494783863 273 }
samux 1:fb4494783863 274
ban4jp 7:93e358253dd8 275 void WIZ820io::spi_write(uint16_t addr, uint8_t cb, const uint8_t *buf, uint16_t len)
samux 1:fb4494783863 276 {
va009039 5:fb15c35d1e28 277 cs = 0;
va009039 5:fb15c35d1e28 278 spi->write(addr >> 8);
va009039 5:fb15c35d1e28 279 spi->write(addr & 0xff);
ban4jp 7:93e358253dd8 280 spi->write(cb);
va009039 5:fb15c35d1e28 281 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 282 spi->write(buf[i]);
va009039 5:fb15c35d1e28 283 }
va009039 5:fb15c35d1e28 284 cs = 1;
va009039 5:fb15c35d1e28 285
va009039 5:fb15c35d1e28 286 #if DBG_SPI
ban4jp 7:93e358253dd8 287 debug("[SPI]W %04x(%02x %d)", addr, cb, len);
va009039 5:fb15c35d1e28 288 for(int i = 0; i < len; i++) {
va009039 5:fb15c35d1e28 289 debug(" %02x", buf[i]);
va009039 5:fb15c35d1e28 290 if (i > 16) {
va009039 5:fb15c35d1e28 291 debug(" ...");
va009039 5:fb15c35d1e28 292 break;
va009039 5:fb15c35d1e28 293 }
va009039 5:fb15c35d1e28 294 }
va009039 5:fb15c35d1e28 295 debug("\r\n");
va009039 5:fb15c35d1e28 296 #endif
va009039 5:fb15c35d1e28 297 }
va009039 5:fb15c35d1e28 298
ban4jp 7:93e358253dd8 299 void WIZ820io::spi_read(uint16_t addr, uint8_t cb, uint8_t *buf, uint16_t len)
va009039 5:fb15c35d1e28 300 {
va009039 5:fb15c35d1e28 301 cs = 0;
va009039 5:fb15c35d1e28 302 spi->write(addr >> 8);
va009039 5:fb15c35d1e28 303 spi->write(addr & 0xff);
ban4jp 7:93e358253dd8 304 spi->write(cb);
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
ban4jp 7:93e358253dd8 311 debug("[SPI]R %04x(%02x %d)", addr, cb, 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 }