W5500-Ethernet-Interface Makers / EthernetInterfaceW5500

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of EthernetInterfaceW5500 by Bongjun Hur

WIZnet/W5500.cpp@14:a089e591e530, 2014-08-19 (annotated)

Committer:
Bongjun
Date:
Tue Aug 19 23:32:48 2014 +0000
Revision:
14:a089e591e530
Parent:
10:cadac6bcd169 
change the code which is related to Sn_RX_RXR, Sn_TX_FSR.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Bongjun 10:cadac6bcd169 1
Bongjun 10:cadac6bcd169 2 #include "mbed.h"
Bongjun 10:cadac6bcd169 3 #include "mbed_debug.h"
Bongjun 10:cadac6bcd169 4 #include "wiznet.h"
Bongjun 10:cadac6bcd169 5 #include "DNSClient.h"
Bongjun 10:cadac6bcd169 6
Bongjun 10:cadac6bcd169 7 #ifdef USE_W5500
Bongjun 10:cadac6bcd169 8
Bongjun 10:cadac6bcd169 9 //Debug is disabled by default
Bongjun 10:cadac6bcd169 10 #if 0
Bongjun 10:cadac6bcd169 11 #define DBG(...) do{debug("%p %d %s ", this,__LINE__,__PRETTY_FUNCTION__); debug(__VA_ARGS__); } while(0);
Bongjun 10:cadac6bcd169 12 //#define DBG(x, ...) debug("[W5500:DBG]"x"\r\n", ##__VA_ARGS__);
Bongjun 10:cadac6bcd169 13 #define WARN(x, ...) debug("[W5500:WARN]"x"\r\n", ##__VA_ARGS__);
Bongjun 10:cadac6bcd169 14 #define ERR(x, ...) debug("[W5500:ERR]"x"\r\n", ##__VA_ARGS__);
Bongjun 10:cadac6bcd169 15 #else
Bongjun 10:cadac6bcd169 16 #define DBG(x, ...)
Bongjun 10:cadac6bcd169 17 #define WARN(x, ...)
Bongjun 10:cadac6bcd169 18 #define ERR(x, ...)
Bongjun 10:cadac6bcd169 19 #endif
Bongjun 10:cadac6bcd169 20
Bongjun 10:cadac6bcd169 21 #if 1
Bongjun 10:cadac6bcd169 22 #define INFO(x, ...) debug("[W5500:INFO]"x"\r\n", ##__VA_ARGS__);
Bongjun 10:cadac6bcd169 23 #else
Bongjun 10:cadac6bcd169 24 #define INFO(x, ...)
Bongjun 10:cadac6bcd169 25 #endif
Bongjun 10:cadac6bcd169 26
Bongjun 10:cadac6bcd169 27 #define DBG_SPI 0
Bongjun 10:cadac6bcd169 28
Bongjun 10:cadac6bcd169 29 WIZnet_Chip* WIZnet_Chip::inst;
Bongjun 10:cadac6bcd169 30
Bongjun 10:cadac6bcd169 31 WIZnet_Chip::WIZnet_Chip(PinName mosi, PinName miso, PinName sclk, PinName _cs, PinName _reset):
Bongjun 10:cadac6bcd169 32 cs(_cs), reset_pin(_reset)
Bongjun 10:cadac6bcd169 33 {
Bongjun 10:cadac6bcd169 34 spi = new SPI(mosi, miso, sclk);
Bongjun 10:cadac6bcd169 35 cs = 1;
Bongjun 10:cadac6bcd169 36 reset_pin = 1;
Bongjun 10:cadac6bcd169 37 inst = this;
Bongjun 10:cadac6bcd169 38 }
Bongjun 10:cadac6bcd169 39
Bongjun 10:cadac6bcd169 40 WIZnet_Chip::WIZnet_Chip(SPI* spi, PinName _cs, PinName _reset):
Bongjun 10:cadac6bcd169 41 cs(_cs), reset_pin(_reset)
Bongjun 10:cadac6bcd169 42 {
Bongjun 10:cadac6bcd169 43 this->spi = spi;
Bongjun 10:cadac6bcd169 44 cs = 1;
Bongjun 10:cadac6bcd169 45 reset_pin = 1;
Bongjun 10:cadac6bcd169 46 inst = this;
Bongjun 10:cadac6bcd169 47 }
Bongjun 10:cadac6bcd169 48
Bongjun 10:cadac6bcd169 49 bool WIZnet_Chip::setmac()
Bongjun 10:cadac6bcd169 50 {
Bongjun 10:cadac6bcd169 51
Bongjun 10:cadac6bcd169 52 for (int i =0; i < 6; i++) reg_wr<uint8_t>(SHAR+i, mac[i]);
Bongjun 10:cadac6bcd169 53
Bongjun 10:cadac6bcd169 54 return true;
Bongjun 10:cadac6bcd169 55 }
Bongjun 10:cadac6bcd169 56
Bongjun 10:cadac6bcd169 57 // Set the IP
Bongjun 10:cadac6bcd169 58 bool WIZnet_Chip::setip()
Bongjun 10:cadac6bcd169 59 {
Bongjun 10:cadac6bcd169 60 reg_wr<uint32_t>(SIPR, ip);
Bongjun 10:cadac6bcd169 61 reg_wr<uint32_t>(GAR, gateway);
Bongjun 10:cadac6bcd169 62 reg_wr<uint32_t>(SUBR, netmask);
Bongjun 10:cadac6bcd169 63 return true;
Bongjun 10:cadac6bcd169 64 }
Bongjun 10:cadac6bcd169 65
Bongjun 10:cadac6bcd169 66 bool WIZnet_Chip::setProtocol(int socket, Protocol p)
Bongjun 10:cadac6bcd169 67 {
Bongjun 10:cadac6bcd169 68 if (socket < 0) {
Bongjun 10:cadac6bcd169 69 return false;
Bongjun 10:cadac6bcd169 70 }
Bongjun 10:cadac6bcd169 71 sreg<uint8_t>(socket, Sn_MR, p);
Bongjun 10:cadac6bcd169 72 return true;
Bongjun 10:cadac6bcd169 73 }
Bongjun 10:cadac6bcd169 74
Bongjun 10:cadac6bcd169 75 bool WIZnet_Chip::connect(int socket, const char * host, int port, int timeout_ms)
Bongjun 10:cadac6bcd169 76 {
Bongjun 10:cadac6bcd169 77 if (socket < 0) {
Bongjun 10:cadac6bcd169 78 return false;
Bongjun 10:cadac6bcd169 79 }
Bongjun 10:cadac6bcd169 80 sreg<uint8_t>(socket, Sn_MR, TCP);
Bongjun 10:cadac6bcd169 81 scmd(socket, OPEN);
Bongjun 10:cadac6bcd169 82 sreg_ip(socket, Sn_DIPR, host);
Bongjun 10:cadac6bcd169 83 sreg<uint16_t>(socket, Sn_DPORT, port);
Bongjun 10:cadac6bcd169 84 sreg<uint16_t>(socket, Sn_PORT, new_port());
Bongjun 10:cadac6bcd169 85 scmd(socket, CONNECT);
Bongjun 10:cadac6bcd169 86 Timer t;
Bongjun 10:cadac6bcd169 87 t.reset();
Bongjun 10:cadac6bcd169 88 t.start();
Bongjun 10:cadac6bcd169 89 while(!is_connected(socket)) {
Bongjun 10:cadac6bcd169 90 if (t.read_ms() > timeout_ms) {
Bongjun 10:cadac6bcd169 91 return false;
Bongjun 10:cadac6bcd169 92 }
Bongjun 10:cadac6bcd169 93 }
Bongjun 10:cadac6bcd169 94 return true;
Bongjun 10:cadac6bcd169 95 }
Bongjun 10:cadac6bcd169 96
Bongjun 10:cadac6bcd169 97 bool WIZnet_Chip::gethostbyname(const char* host, uint32_t* ip)
Bongjun 10:cadac6bcd169 98 {
Bongjun 10:cadac6bcd169 99 uint32_t addr = str_to_ip(host);
Bongjun 10:cadac6bcd169 100 char buf[17];
Bongjun 10:cadac6bcd169 101 snprintf(buf, sizeof(buf), "%d.%d.%d.%d", (addr>>24)&0xff, (addr>>16)&0xff, (addr>>8)&0xff, addr&0xff);
Bongjun 10:cadac6bcd169 102 if (strcmp(buf, host) == 0) {
Bongjun 10:cadac6bcd169 103 *ip = addr;
Bongjun 10:cadac6bcd169 104 return true;
Bongjun 10:cadac6bcd169 105 }
Bongjun 10:cadac6bcd169 106 DNSClient client;
Bongjun 10:cadac6bcd169 107 if(client.lookup(host)) {
Bongjun 10:cadac6bcd169 108 *ip = client.ip;
Bongjun 10:cadac6bcd169 109 return true;
Bongjun 10:cadac6bcd169 110 }
Bongjun 10:cadac6bcd169 111 return false;
Bongjun 10:cadac6bcd169 112 }
Bongjun 10:cadac6bcd169 113
Bongjun 10:cadac6bcd169 114 bool WIZnet_Chip::disconnect()
Bongjun 10:cadac6bcd169 115 {
Bongjun 10:cadac6bcd169 116 return true;
Bongjun 10:cadac6bcd169 117 }
Bongjun 10:cadac6bcd169 118
Bongjun 10:cadac6bcd169 119 bool WIZnet_Chip::is_connected(int socket)
Bongjun 10:cadac6bcd169 120 {
Bongjun 10:cadac6bcd169 121 uint8_t tmpSn_SR;
Bongjun 10:cadac6bcd169 122 tmpSn_SR = sreg<uint8_t>(socket, Sn_SR);
Bongjun 10:cadac6bcd169 123 // packet sending is possible, when state is SOCK_CLOSE_WAIT.
Bongjun 10:cadac6bcd169 124 if ((tmpSn_SR == SOCK_ESTABLISHED) || (tmpSn_SR == SOCK_CLOSE_WAIT)) {
Bongjun 10:cadac6bcd169 125 return true;
Bongjun 10:cadac6bcd169 126 }
Bongjun 10:cadac6bcd169 127 return false;
Bongjun 10:cadac6bcd169 128 }
Bongjun 10:cadac6bcd169 129
Bongjun 10:cadac6bcd169 130 // Reset the chip & set the buffer
Bongjun 10:cadac6bcd169 131 void WIZnet_Chip::reset()
Bongjun 10:cadac6bcd169 132 {
Bongjun 10:cadac6bcd169 133 reset_pin = 1;
Bongjun 10:cadac6bcd169 134 reset_pin = 0;
Bongjun 10:cadac6bcd169 135 wait_us(500); // 500us (w5500)
Bongjun 10:cadac6bcd169 136 reset_pin = 1;
Bongjun 10:cadac6bcd169 137 wait_ms(400); // 400ms (w5500)
Bongjun 10:cadac6bcd169 138
Bongjun 10:cadac6bcd169 139 #if defined(USE_WIZ550IO_MAC)
Bongjun 10:cadac6bcd169 140 //reg_rd_mac(SHAR, mac); // read the MAC address inside the module
Bongjun 10:cadac6bcd169 141 #endif
Bongjun 10:cadac6bcd169 142
Bongjun 10:cadac6bcd169 143 //reg_wr_mac(SHAR, mac);
Bongjun 10:cadac6bcd169 144
Bongjun 10:cadac6bcd169 145 // set RX and TX buffer size
Bongjun 10:cadac6bcd169 146 for (int socket = 0; socket < MAX_SOCK_NUM; socket++) {
Bongjun 10:cadac6bcd169 147 sreg<uint8_t>(socket, Sn_RXBUF_SIZE, 2);
Bongjun 10:cadac6bcd169 148 sreg<uint8_t>(socket, Sn_TXBUF_SIZE, 2);
Bongjun 10:cadac6bcd169 149 }
Bongjun 10:cadac6bcd169 150 }
Bongjun 10:cadac6bcd169 151
Bongjun 10:cadac6bcd169 152
Bongjun 10:cadac6bcd169 153 bool WIZnet_Chip::close(int socket)
Bongjun 10:cadac6bcd169 154 {
Bongjun 10:cadac6bcd169 155 if (socket < 0) {
Bongjun 10:cadac6bcd169 156 return false;
Bongjun 10:cadac6bcd169 157 }
Bongjun 10:cadac6bcd169 158 // if not connected, return
Bongjun 10:cadac6bcd169 159 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_CLOSED) {
Bongjun 10:cadac6bcd169 160 return true;
Bongjun 10:cadac6bcd169 161 }
Bongjun 10:cadac6bcd169 162 if (sreg<uint8_t>(socket, Sn_MR) == TCP) {
Bongjun 10:cadac6bcd169 163 scmd(socket, DISCON);
Bongjun 10:cadac6bcd169 164 }
Bongjun 10:cadac6bcd169 165 scmd(socket, CLOSE);
Bongjun 10:cadac6bcd169 166 sreg<uint8_t>(socket, Sn_IR, 0xff);
Bongjun 10:cadac6bcd169 167 return true;
Bongjun 10:cadac6bcd169 168 }
Bongjun 10:cadac6bcd169 169
Bongjun 10:cadac6bcd169 170 int WIZnet_Chip::wait_readable(int socket, int wait_time_ms, int req_size)
Bongjun 10:cadac6bcd169 171 {
Bongjun 14:a089e591e530 172 int size, size2;
Bongjun 10:cadac6bcd169 173 if (socket < 0) {
Bongjun 10:cadac6bcd169 174 return -1;
Bongjun 10:cadac6bcd169 175 }
Bongjun 10:cadac6bcd169 176 Timer t;
Bongjun 10:cadac6bcd169 177 t.reset();
Bongjun 10:cadac6bcd169 178 t.start();
Bongjun 10:cadac6bcd169 179 while(1) {
Bongjun 14:a089e591e530 180 //int size = sreg<uint16_t>(socket, Sn_RX_RSR);
Bongjun 14:a089e591e530 181 // during the reading Sn_RX_RXR, it has the possible change of this register.
Bongjun 14:a089e591e530 182 // so read twice and get same value then use size information.
Bongjun 14:a089e591e530 183 do {
Bongjun 14:a089e591e530 184 size = sreg<uint16_t>(socket, Sn_RX_RSR);
Bongjun 14:a089e591e530 185 size2 = sreg<uint16_t>(socket, Sn_RX_RSR);
Bongjun 14:a089e591e530 186 } while (size != size2);
Bongjun 14:a089e591e530 187
Bongjun 14:a089e591e530 188
Bongjun 10:cadac6bcd169 189 if (size > req_size) {
Bongjun 10:cadac6bcd169 190 return size;
Bongjun 10:cadac6bcd169 191 }
Bongjun 10:cadac6bcd169 192 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
Bongjun 10:cadac6bcd169 193 break;
Bongjun 10:cadac6bcd169 194 }
Bongjun 10:cadac6bcd169 195 }
Bongjun 10:cadac6bcd169 196 return -1;
Bongjun 10:cadac6bcd169 197 }
Bongjun 10:cadac6bcd169 198
Bongjun 10:cadac6bcd169 199 int WIZnet_Chip::wait_writeable(int socket, int wait_time_ms, int req_size)
Bongjun 10:cadac6bcd169 200 {
Bongjun 14:a089e591e530 201 int size, size2;
Bongjun 10:cadac6bcd169 202 if (socket < 0) {
Bongjun 10:cadac6bcd169 203 return -1;
Bongjun 10:cadac6bcd169 204 }
Bongjun 10:cadac6bcd169 205 Timer t;
Bongjun 10:cadac6bcd169 206 t.reset();
Bongjun 10:cadac6bcd169 207 t.start();
Bongjun 10:cadac6bcd169 208 while(1) {
Bongjun 14:a089e591e530 209 //int size = sreg<uint16_t>(socket, Sn_TX_FSR);
Bongjun 14:a089e591e530 210 // during the reading Sn_TX_FSR, it has the possible change of this register.
Bongjun 14:a089e591e530 211 // so read twice and get same value then use size information.
Bongjun 14:a089e591e530 212 do {
Bongjun 14:a089e591e530 213 size = sreg<uint16_t>(socket, Sn_TX_FSR);
Bongjun 14:a089e591e530 214 size2 = sreg<uint16_t>(socket, Sn_TX_FSR);
Bongjun 14:a089e591e530 215 } while (size != size2);
Bongjun 10:cadac6bcd169 216 if (size > req_size) {
Bongjun 10:cadac6bcd169 217 return size;
Bongjun 10:cadac6bcd169 218 }
Bongjun 10:cadac6bcd169 219 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
Bongjun 10:cadac6bcd169 220 break;
Bongjun 10:cadac6bcd169 221 }
Bongjun 10:cadac6bcd169 222 }
Bongjun 10:cadac6bcd169 223 return -1;
Bongjun 10:cadac6bcd169 224 }
Bongjun 10:cadac6bcd169 225
Bongjun 10:cadac6bcd169 226 int WIZnet_Chip::send(int socket, const char * str, int len)
Bongjun 10:cadac6bcd169 227 {
Bongjun 10:cadac6bcd169 228 if (socket < 0) {
Bongjun 10:cadac6bcd169 229 return -1;
Bongjun 10:cadac6bcd169 230 }
Bongjun 10:cadac6bcd169 231 uint16_t ptr = sreg<uint16_t>(socket, Sn_TX_WR);
Bongjun 10:cadac6bcd169 232 uint8_t cntl_byte = (0x14 + (socket << 5));
Bongjun 10:cadac6bcd169 233 spi_write(ptr, cntl_byte, (uint8_t*)str, len);
Bongjun 10:cadac6bcd169 234 sreg<uint16_t>(socket, Sn_TX_WR, ptr + len);
Bongjun 10:cadac6bcd169 235 scmd(socket, SEND);
Bongjun 10:cadac6bcd169 236 uint8_t tmp_Sn_IR;
Bongjun 10:cadac6bcd169 237 while (( (tmp_Sn_IR = sreg<uint8_t>(socket, Sn_IR)) & INT_SEND_OK) != INT_SEND_OK) {
Bongjun 10:cadac6bcd169 238 // @Jul.10, 2014 fix contant name, and udp sendto function.
Bongjun 10:cadac6bcd169 239 switch (sreg<uint8_t>(socket, Sn_SR)) {
Bongjun 10:cadac6bcd169 240 case SOCK_CLOSED :
Bongjun 10:cadac6bcd169 241 close(socket);
Bongjun 10:cadac6bcd169 242 return 0;
Bongjun 10:cadac6bcd169 243 //break;
Bongjun 10:cadac6bcd169 244 case SOCK_UDP :
Bongjun 10:cadac6bcd169 245 // ARP timeout is possible.
Bongjun 10:cadac6bcd169 246 if ((tmp_Sn_IR & INT_TIMEOUT) == INT_TIMEOUT) {
Bongjun 10:cadac6bcd169 247 sreg<uint8_t>(socket, Sn_IR, INT_TIMEOUT);
Bongjun 10:cadac6bcd169 248 return 0;
Bongjun 10:cadac6bcd169 249 }
Bongjun 10:cadac6bcd169 250 break;
Bongjun 10:cadac6bcd169 251 default :
Bongjun 10:cadac6bcd169 252 break;
Bongjun 10:cadac6bcd169 253 }
Bongjun 10:cadac6bcd169 254 }
Bongjun 10:cadac6bcd169 255 sreg<uint8_t>(socket, Sn_IR, INT_SEND_OK);
Bongjun 10:cadac6bcd169 256
Bongjun 10:cadac6bcd169 257 return len;
Bongjun 10:cadac6bcd169 258 }
Bongjun 10:cadac6bcd169 259
Bongjun 10:cadac6bcd169 260 int WIZnet_Chip::recv(int socket, char* buf, int len)
Bongjun 10:cadac6bcd169 261 {
Bongjun 10:cadac6bcd169 262 if (socket < 0) {
Bongjun 10:cadac6bcd169 263 return -1;
Bongjun 10:cadac6bcd169 264 }
Bongjun 10:cadac6bcd169 265 uint16_t ptr = sreg<uint16_t>(socket, Sn_RX_RD);
Bongjun 10:cadac6bcd169 266 uint8_t cntl_byte = (0x18 + (socket << 5));
Bongjun 10:cadac6bcd169 267 spi_read(ptr, cntl_byte, (uint8_t*)buf, len);
Bongjun 10:cadac6bcd169 268 sreg<uint16_t>(socket, Sn_RX_RD, ptr + len);
Bongjun 10:cadac6bcd169 269 scmd(socket, RECV);
Bongjun 10:cadac6bcd169 270 return len;
Bongjun 10:cadac6bcd169 271 }
Bongjun 10:cadac6bcd169 272
Bongjun 10:cadac6bcd169 273 int WIZnet_Chip::new_socket()
Bongjun 10:cadac6bcd169 274 {
Bongjun 10:cadac6bcd169 275 for(int s = 0; s < MAX_SOCK_NUM; s++) {
Bongjun 10:cadac6bcd169 276 if (sreg<uint8_t>(s, Sn_SR) == SOCK_CLOSED) {
Bongjun 10:cadac6bcd169 277 return s;
Bongjun 10:cadac6bcd169 278 }
Bongjun 10:cadac6bcd169 279 }
Bongjun 10:cadac6bcd169 280 return -1;
Bongjun 10:cadac6bcd169 281 }
Bongjun 10:cadac6bcd169 282
Bongjun 10:cadac6bcd169 283 uint16_t WIZnet_Chip::new_port()
Bongjun 10:cadac6bcd169 284 {
Bongjun 10:cadac6bcd169 285 uint16_t port = rand();
Bongjun 10:cadac6bcd169 286 port |= 49152;
Bongjun 10:cadac6bcd169 287 return port;
Bongjun 10:cadac6bcd169 288 }
Bongjun 10:cadac6bcd169 289
Bongjun 10:cadac6bcd169 290 void WIZnet_Chip::scmd(int socket, Command cmd)
Bongjun 10:cadac6bcd169 291 {
Bongjun 10:cadac6bcd169 292 sreg<uint8_t>(socket, Sn_CR, cmd);
Bongjun 10:cadac6bcd169 293 while(sreg<uint8_t>(socket, Sn_CR));
Bongjun 10:cadac6bcd169 294 }
Bongjun 10:cadac6bcd169 295
Bongjun 10:cadac6bcd169 296 void WIZnet_Chip::spi_write(uint16_t addr, uint8_t cb, const uint8_t *buf, uint16_t len)
Bongjun 10:cadac6bcd169 297 {
Bongjun 10:cadac6bcd169 298 cs = 0;
Bongjun 10:cadac6bcd169 299 spi->write(addr >> 8);
Bongjun 10:cadac6bcd169 300 spi->write(addr & 0xff);
Bongjun 10:cadac6bcd169 301 spi->write(cb);
Bongjun 10:cadac6bcd169 302 for(int i = 0; i < len; i++) {
Bongjun 10:cadac6bcd169 303 spi->write(buf[i]);
Bongjun 10:cadac6bcd169 304 }
Bongjun 10:cadac6bcd169 305 cs = 1;
Bongjun 10:cadac6bcd169 306
Bongjun 10:cadac6bcd169 307 #if DBG_SPI
Bongjun 10:cadac6bcd169 308 debug("[SPI]W %04x(%02x %d)", addr, cb, len);
Bongjun 10:cadac6bcd169 309 for(int i = 0; i < len; i++) {
Bongjun 10:cadac6bcd169 310 debug(" %02x", buf[i]);
Bongjun 10:cadac6bcd169 311 if (i > 16) {
Bongjun 10:cadac6bcd169 312 debug(" ...");
Bongjun 10:cadac6bcd169 313 break;
Bongjun 10:cadac6bcd169 314 }
Bongjun 10:cadac6bcd169 315 }
Bongjun 10:cadac6bcd169 316 debug("\r\n");
Bongjun 10:cadac6bcd169 317 #endif
Bongjun 10:cadac6bcd169 318 }
Bongjun 10:cadac6bcd169 319
Bongjun 10:cadac6bcd169 320 void WIZnet_Chip::spi_read(uint16_t addr, uint8_t cb, uint8_t *buf, uint16_t len)
Bongjun 10:cadac6bcd169 321 {
Bongjun 10:cadac6bcd169 322 cs = 0;
Bongjun 10:cadac6bcd169 323 spi->write(addr >> 8);
Bongjun 10:cadac6bcd169 324 spi->write(addr & 0xff);
Bongjun 10:cadac6bcd169 325 spi->write(cb);
Bongjun 10:cadac6bcd169 326 for(int i = 0; i < len; i++) {
Bongjun 10:cadac6bcd169 327 buf[i] = spi->write(0);
Bongjun 10:cadac6bcd169 328 }
Bongjun 10:cadac6bcd169 329 cs = 1;
Bongjun 10:cadac6bcd169 330
Bongjun 10:cadac6bcd169 331 #if DBG_SPI
Bongjun 10:cadac6bcd169 332 debug("[SPI]R %04x(%02x %d)", addr, cb, len);
Bongjun 10:cadac6bcd169 333 for(int i = 0; i < len; i++) {
Bongjun 10:cadac6bcd169 334 debug(" %02x", buf[i]);
Bongjun 10:cadac6bcd169 335 if (i > 16) {
Bongjun 10:cadac6bcd169 336 debug(" ...");
Bongjun 10:cadac6bcd169 337 break;
Bongjun 10:cadac6bcd169 338 }
Bongjun 10:cadac6bcd169 339 }
Bongjun 10:cadac6bcd169 340 debug("\r\n");
Bongjun 10:cadac6bcd169 341 if ((addr&0xf0ff)==0x4026 || (addr&0xf0ff)==0x4003) {
Bongjun 10:cadac6bcd169 342 wait_ms(200);
Bongjun 10:cadac6bcd169 343 }
Bongjun 10:cadac6bcd169 344 #endif
Bongjun 10:cadac6bcd169 345 }
Bongjun 10:cadac6bcd169 346
Bongjun 10:cadac6bcd169 347 uint32_t str_to_ip(const char* str)
Bongjun 10:cadac6bcd169 348 {
Bongjun 10:cadac6bcd169 349 uint32_t ip = 0;
Bongjun 10:cadac6bcd169 350 char* p = (char*)str;
Bongjun 10:cadac6bcd169 351 for(int i = 0; i < 4; i++) {
Bongjun 10:cadac6bcd169 352 ip |= atoi(p);
Bongjun 10:cadac6bcd169 353 p = strchr(p, '.');
Bongjun 10:cadac6bcd169 354 if (p == NULL) {
Bongjun 10:cadac6bcd169 355 break;
Bongjun 10:cadac6bcd169 356 }
Bongjun 10:cadac6bcd169 357 ip <<= 8;
Bongjun 10:cadac6bcd169 358 p++;
Bongjun 10:cadac6bcd169 359 }
Bongjun 10:cadac6bcd169 360 return ip;
Bongjun 10:cadac6bcd169 361 }
Bongjun 10:cadac6bcd169 362
Bongjun 10:cadac6bcd169 363 void printfBytes(char* str, uint8_t* buf, int len)
Bongjun 10:cadac6bcd169 364 {
Bongjun 10:cadac6bcd169 365 printf("%s %d:", str, len);
Bongjun 10:cadac6bcd169 366 for(int i = 0; i < len; i++) {
Bongjun 10:cadac6bcd169 367 printf(" %02x", buf[i]);
Bongjun 10:cadac6bcd169 368 }
Bongjun 10:cadac6bcd169 369 printf("\n");
Bongjun 10:cadac6bcd169 370 }
Bongjun 10:cadac6bcd169 371
Bongjun 10:cadac6bcd169 372 void printHex(uint8_t* buf, int len)
Bongjun 10:cadac6bcd169 373 {
Bongjun 10:cadac6bcd169 374 for(int i = 0; i < len; i++) {
Bongjun 10:cadac6bcd169 375 if ((i%16) == 0) {
Bongjun 10:cadac6bcd169 376 printf("%p", buf+i);
Bongjun 10:cadac6bcd169 377 }
Bongjun 10:cadac6bcd169 378 printf(" %02x", buf[i]);
Bongjun 10:cadac6bcd169 379 if ((i%16) == 15) {
Bongjun 10:cadac6bcd169 380 printf("\n");
Bongjun 10:cadac6bcd169 381 }
Bongjun 10:cadac6bcd169 382 }
Bongjun 10:cadac6bcd169 383 printf("\n");
Bongjun 10:cadac6bcd169 384 }
Bongjun 10:cadac6bcd169 385
Bongjun 10:cadac6bcd169 386 void debug_hex(uint8_t* buf, int len)
Bongjun 10:cadac6bcd169 387 {
Bongjun 10:cadac6bcd169 388 for(int i = 0; i < len; i++) {
Bongjun 10:cadac6bcd169 389 if ((i%16) == 0) {
Bongjun 10:cadac6bcd169 390 debug("%p", buf+i);
Bongjun 10:cadac6bcd169 391 }
Bongjun 10:cadac6bcd169 392 debug(" %02x", buf[i]);
Bongjun 10:cadac6bcd169 393 if ((i%16) == 15) {
Bongjun 10:cadac6bcd169 394 debug("\n");
Bongjun 10:cadac6bcd169 395 }
Bongjun 10:cadac6bcd169 396 }
Bongjun 10:cadac6bcd169 397 debug("\n");
Bongjun 10:cadac6bcd169 398 }
Bongjun 10:cadac6bcd169 399
Bongjun 10:cadac6bcd169 400 #endif