WIZnet / WIZnet_Library

This is WIZnet Ethernet Interface using Hardware TCP/IP chip, W5500, W5200 and W5100. One of them can be selected by enabling it in wiznet.h.

Dependents:   Embedded_web EmailButton EmailButton HTTPClient_Weather ... more

other drivers

for only W5500 / WIZ550io user, you could use

Import libraryW5500Interface

This is the Interface library for WIZnet W5500 chip which forked of EthernetInterfaceW5500, WIZnetInterface and WIZ550ioInterface. This library has simple name as "W5500Interface". and can be used for Wiz550io users also.

Last commit 28 Apr 2015 by W5500-Ethernet-Interface Makers

WIZnetInterface/WIZnet/W5500.cpp@1:8138a268fbd2, 2014-05-09 (annotated)

Committer:
jbkim
Date:
Fri May 09 01:17:51 2014 +0000
Revision:
1:8138a268fbd2
Parent:
0:b72d22e10709
Child:
2:c2eb7a08d7e6
Wiznet Ethernet library 1st release

Who changed what in which revision?

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