Viktor Bohuněk / 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:   EZS

Fork of WIZnet_Library by WIZnet

WIZnetInterface/WIZnet/W5500.cpp@2:c2eb7a08d7e6, 2014-07-14 (annotated)

Committer:
Bongjun
Date:
Mon Jul 14 23:52:10 2014 +0000
Revision:
2:c2eb7a08d7e6
Parent:
1:8138a268fbd2
Child:
4:37a5586c4f64
in W5500.cpp, is_connected(), send() function is changed.

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 {
Bongjun 2:c2eb7a08d7e6 129 /*
Bongjun 2:c2eb7a08d7e6 130 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_ESTABLISHED) {
Bongjun 2:c2eb7a08d7e6 131 return true;
Bongjun 2:c2eb7a08d7e6 132 }
Bongjun 2:c2eb7a08d7e6 133 */
Bongjun 2:c2eb7a08d7e6 134 uint8_t tmpSn_SR;
Bongjun 2:c2eb7a08d7e6 135 tmpSn_SR = sreg<uint8_t>(socket, Sn_SR);
Bongjun 2:c2eb7a08d7e6 136 // packet sending is possible, when state is SOCK_CLOSE_WAIT.
Bongjun 2:c2eb7a08d7e6 137 if ((tmpSn_SR == SOCK_ESTABLISHED) || (tmpSn_SR == SOCK_CLOSE_WAIT)) {
jbkim 0:b72d22e10709 138 return true;
jbkim 0:b72d22e10709 139 }
jbkim 0:b72d22e10709 140 return false;
jbkim 0:b72d22e10709 141 }
jbkim 0:b72d22e10709 142
jbkim 0:b72d22e10709 143 // Reset the chip & set the buffer
jbkim 0:b72d22e10709 144 void WIZnet_Chip::reset()
jbkim 0:b72d22e10709 145 {
jbkim 0:b72d22e10709 146 reset_pin = 1;
jbkim 0:b72d22e10709 147 reset_pin = 0;
jbkim 0:b72d22e10709 148 wait_us(500); // 500us (w5500)
jbkim 0:b72d22e10709 149 reset_pin = 1;
jbkim 0:b72d22e10709 150 wait_ms(400); // 400ms (w5500)
jbkim 0:b72d22e10709 151
jbkim 0:b72d22e10709 152 #if defined(USE_WIZ550IO_MAC)
jbkim 0:b72d22e10709 153 reg_rd_mac(SHAR, mac); // read the MAC address inside the module
jbkim 0:b72d22e10709 154 #endif
jbkim 0:b72d22e10709 155
jbkim 0:b72d22e10709 156 reg_wr_mac(SHAR, mac);
Bongjun 2:c2eb7a08d7e6 157
jbkim 0:b72d22e10709 158 // set RX and TX buffer size
jbkim 0:b72d22e10709 159 for (int socket = 0; socket < MAX_SOCK_NUM; socket++) {
jbkim 0:b72d22e10709 160 sreg<uint8_t>(socket, Sn_RXBUF_SIZE, 2);
jbkim 0:b72d22e10709 161 sreg<uint8_t>(socket, Sn_TXBUF_SIZE, 2);
jbkim 0:b72d22e10709 162 }
jbkim 0:b72d22e10709 163 }
jbkim 0:b72d22e10709 164
jbkim 0:b72d22e10709 165
jbkim 0:b72d22e10709 166 bool WIZnet_Chip::close(int socket)
jbkim 0:b72d22e10709 167 {
jbkim 0:b72d22e10709 168 if (socket < 0) {
jbkim 0:b72d22e10709 169 return false;
jbkim 0:b72d22e10709 170 }
jbkim 0:b72d22e10709 171 // if not connected, return
jbkim 0:b72d22e10709 172 if (sreg<uint8_t>(socket, Sn_SR) == SOCK_CLOSED) {
jbkim 0:b72d22e10709 173 return true;
jbkim 0:b72d22e10709 174 }
jbkim 0:b72d22e10709 175 if (sreg<uint8_t>(socket, Sn_MR) == TCP) {
jbkim 0:b72d22e10709 176 scmd(socket, DISCON);
jbkim 0:b72d22e10709 177 }
jbkim 0:b72d22e10709 178 scmd(socket, CLOSE);
jbkim 0:b72d22e10709 179 sreg<uint8_t>(socket, Sn_IR, 0xff);
jbkim 0:b72d22e10709 180 return true;
jbkim 0:b72d22e10709 181 }
jbkim 0:b72d22e10709 182
jbkim 0:b72d22e10709 183 int WIZnet_Chip::wait_readable(int socket, int wait_time_ms, int req_size)
jbkim 0:b72d22e10709 184 {
jbkim 0:b72d22e10709 185 if (socket < 0) {
jbkim 0:b72d22e10709 186 return -1;
jbkim 0:b72d22e10709 187 }
jbkim 0:b72d22e10709 188 Timer t;
jbkim 0:b72d22e10709 189 t.reset();
jbkim 0:b72d22e10709 190 t.start();
jbkim 0:b72d22e10709 191 while(1) {
jbkim 0:b72d22e10709 192 int size = sreg<uint16_t>(socket, Sn_RX_RSR);
jbkim 0:b72d22e10709 193 if (size > req_size) {
jbkim 0:b72d22e10709 194 return size;
jbkim 0:b72d22e10709 195 }
jbkim 0:b72d22e10709 196 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
jbkim 0:b72d22e10709 197 break;
jbkim 0:b72d22e10709 198 }
jbkim 0:b72d22e10709 199 }
jbkim 0:b72d22e10709 200 return -1;
jbkim 0:b72d22e10709 201 }
jbkim 0:b72d22e10709 202
jbkim 0:b72d22e10709 203 int WIZnet_Chip::wait_writeable(int socket, int wait_time_ms, int req_size)
jbkim 0:b72d22e10709 204 {
jbkim 0:b72d22e10709 205 if (socket < 0) {
jbkim 0:b72d22e10709 206 return -1;
jbkim 0:b72d22e10709 207 }
jbkim 0:b72d22e10709 208 Timer t;
jbkim 0:b72d22e10709 209 t.reset();
jbkim 0:b72d22e10709 210 t.start();
jbkim 0:b72d22e10709 211 while(1) {
jbkim 0:b72d22e10709 212 int size = sreg<uint16_t>(socket, Sn_TX_FSR);
jbkim 0:b72d22e10709 213 if (size > req_size) {
jbkim 0:b72d22e10709 214 return size;
jbkim 0:b72d22e10709 215 }
jbkim 0:b72d22e10709 216 if (wait_time_ms != (-1) && t.read_ms() > wait_time_ms) {
jbkim 0:b72d22e10709 217 break;
jbkim 0:b72d22e10709 218 }
jbkim 0:b72d22e10709 219 }
jbkim 0:b72d22e10709 220 return -1;
jbkim 0:b72d22e10709 221 }
jbkim 0:b72d22e10709 222
jbkim 0:b72d22e10709 223 int WIZnet_Chip::send(int socket, const char * str, int len)
jbkim 0:b72d22e10709 224 {
jbkim 0:b72d22e10709 225 if (socket < 0) {
jbkim 0:b72d22e10709 226 return -1;
jbkim 0:b72d22e10709 227 }
jbkim 0:b72d22e10709 228 uint16_t ptr = sreg<uint16_t>(socket, Sn_TX_WR);
jbkim 0:b72d22e10709 229 uint8_t cntl_byte = (0x14 + (socket << 5));
jbkim 0:b72d22e10709 230 spi_write(ptr, cntl_byte, (uint8_t*)str, len);
jbkim 0:b72d22e10709 231 sreg<uint16_t>(socket, Sn_TX_WR, ptr + len);
jbkim 0:b72d22e10709 232 scmd(socket, SEND);
Bongjun 2:c2eb7a08d7e6 233 uint8_t tmp_Sn_IR;
Bongjun 2:c2eb7a08d7e6 234 while (( (tmp_Sn_IR = sreg<uint8_t>(socket, Sn_IR)) & INT_SEND_OK) != INT_SEND_OK) {
Bongjun 2:c2eb7a08d7e6 235 // @Jul.10, 2014 fix contant name, and udp sendto function.
Bongjun 2:c2eb7a08d7e6 236 switch (sreg<uint8_t>(socket, Sn_SR)) {
Bongjun 2:c2eb7a08d7e6 237 case SOCK_CLOSED :
Bongjun 2:c2eb7a08d7e6 238 close(socket);
Bongjun 2:c2eb7a08d7e6 239 return 0;
Bongjun 2:c2eb7a08d7e6 240 //break;
Bongjun 2:c2eb7a08d7e6 241 case SOCK_UDP :
Bongjun 2:c2eb7a08d7e6 242 // ARP timeout is possible.
Bongjun 2:c2eb7a08d7e6 243 if ((tmp_Sn_IR & INT_TIMEOUT) == INT_TIMEOUT) {
Bongjun 2:c2eb7a08d7e6 244 sreg<uint8_t>(socket, Sn_IR, INT_TIMEOUT);
Bongjun 2:c2eb7a08d7e6 245 return 0;
Bongjun 2:c2eb7a08d7e6 246 }
Bongjun 2:c2eb7a08d7e6 247 break;
Bongjun 2:c2eb7a08d7e6 248 default :
Bongjun 2:c2eb7a08d7e6 249 break;
jbkim 0:b72d22e10709 250 }
jbkim 0:b72d22e10709 251 }
Bongjun 2:c2eb7a08d7e6 252 /*
Bongjun 2:c2eb7a08d7e6 253 while ((sreg<uint8_t>(socket, Sn_IR) & INT_SEND_OK) != INT_SEND_OK) {
Bongjun 2:c2eb7a08d7e6 254 if (sreg<uint8_t>(socket, Sn_SR) == CLOSED) {
Bongjun 2:c2eb7a08d7e6 255 close(socket);
Bongjun 2:c2eb7a08d7e6 256 return 0;
Bongjun 2:c2eb7a08d7e6 257 }
Bongjun 2:c2eb7a08d7e6 258 }
Bongjun 2:c2eb7a08d7e6 259 */
jbkim 0:b72d22e10709 260 sreg<uint8_t>(socket, Sn_IR, INT_SEND_OK);
jbkim 0:b72d22e10709 261
jbkim 0:b72d22e10709 262 return len;
jbkim 0:b72d22e10709 263 }
jbkim 0:b72d22e10709 264
jbkim 0:b72d22e10709 265 int WIZnet_Chip::recv(int socket, char* buf, int len)
jbkim 0:b72d22e10709 266 {
jbkim 0:b72d22e10709 267 if (socket < 0) {
jbkim 0:b72d22e10709 268 return -1;
jbkim 0:b72d22e10709 269 }
jbkim 0:b72d22e10709 270 uint16_t ptr = sreg<uint16_t>(socket, Sn_RX_RD);
jbkim 0:b72d22e10709 271 uint8_t cntl_byte = (0x18 + (socket << 5));
jbkim 0:b72d22e10709 272 spi_read(ptr, cntl_byte, (uint8_t*)buf, len);
jbkim 0:b72d22e10709 273 sreg<uint16_t>(socket, Sn_RX_RD, ptr + len);
jbkim 0:b72d22e10709 274 scmd(socket, RECV);
jbkim 0:b72d22e10709 275 return len;
jbkim 0:b72d22e10709 276 }
jbkim 0:b72d22e10709 277
jbkim 0:b72d22e10709 278 int WIZnet_Chip::new_socket()
jbkim 0:b72d22e10709 279 {
jbkim 0:b72d22e10709 280 for(int s = 0; s < MAX_SOCK_NUM; s++) {
jbkim 0:b72d22e10709 281 if (sreg<uint8_t>(s, Sn_SR) == SOCK_CLOSED) {
jbkim 0:b72d22e10709 282 return s;
jbkim 0:b72d22e10709 283 }
jbkim 0:b72d22e10709 284 }
jbkim 0:b72d22e10709 285 return -1;
jbkim 0:b72d22e10709 286 }
jbkim 0:b72d22e10709 287
jbkim 0:b72d22e10709 288 uint16_t WIZnet_Chip::new_port()
jbkim 0:b72d22e10709 289 {
jbkim 0:b72d22e10709 290 uint16_t port = rand();
jbkim 0:b72d22e10709 291 port |= 49152;
jbkim 0:b72d22e10709 292 return port;
jbkim 0:b72d22e10709 293 }
jbkim 0:b72d22e10709 294
jbkim 0:b72d22e10709 295 void WIZnet_Chip::scmd(int socket, Command cmd)
jbkim 0:b72d22e10709 296 {
jbkim 0:b72d22e10709 297 sreg<uint8_t>(socket, Sn_CR, cmd);
jbkim 0:b72d22e10709 298 while(sreg<uint8_t>(socket, Sn_CR));
jbkim 0:b72d22e10709 299 }
jbkim 0:b72d22e10709 300
jbkim 0:b72d22e10709 301 void WIZnet_Chip::spi_write(uint16_t addr, uint8_t cb, const uint8_t *buf, uint16_t len)
jbkim 0:b72d22e10709 302 {
jbkim 0:b72d22e10709 303 cs = 0;
jbkim 0:b72d22e10709 304 spi->write(addr >> 8);
jbkim 0:b72d22e10709 305 spi->write(addr & 0xff);
jbkim 0:b72d22e10709 306 spi->write(cb);
jbkim 0:b72d22e10709 307 for(int i = 0; i < len; i++) {
jbkim 0:b72d22e10709 308 spi->write(buf[i]);
jbkim 0:b72d22e10709 309 }
jbkim 0:b72d22e10709 310 cs = 1;
jbkim 0:b72d22e10709 311
jbkim 0:b72d22e10709 312 #if DBG_SPI
jbkim 0:b72d22e10709 313 debug("[SPI]W %04x(%02x %d)", addr, cb, len);
jbkim 0:b72d22e10709 314 for(int i = 0; i < len; i++) {
jbkim 0:b72d22e10709 315 debug(" %02x", buf[i]);
jbkim 0:b72d22e10709 316 if (i > 16) {
jbkim 0:b72d22e10709 317 debug(" ...");
jbkim 0:b72d22e10709 318 break;
jbkim 0:b72d22e10709 319 }
jbkim 0:b72d22e10709 320 }
jbkim 0:b72d22e10709 321 debug("\r\n");
Bongjun 2:c2eb7a08d7e6 322 #endif
jbkim 0:b72d22e10709 323 }
jbkim 0:b72d22e10709 324
jbkim 0:b72d22e10709 325 void WIZnet_Chip::spi_read(uint16_t addr, uint8_t cb, uint8_t *buf, uint16_t len)
jbkim 0:b72d22e10709 326 {
jbkim 0:b72d22e10709 327 cs = 0;
jbkim 0:b72d22e10709 328 spi->write(addr >> 8);
jbkim 0:b72d22e10709 329 spi->write(addr & 0xff);
jbkim 0:b72d22e10709 330 spi->write(cb);
jbkim 0:b72d22e10709 331 for(int i = 0; i < len; i++) {
jbkim 0:b72d22e10709 332 buf[i] = spi->write(0);
jbkim 0:b72d22e10709 333 }
jbkim 0:b72d22e10709 334 cs = 1;
jbkim 0:b72d22e10709 335
jbkim 0:b72d22e10709 336 #if DBG_SPI
jbkim 0:b72d22e10709 337 debug("[SPI]R %04x(%02x %d)", addr, cb, len);
jbkim 0:b72d22e10709 338 for(int i = 0; i < len; i++) {
jbkim 0:b72d22e10709 339 debug(" %02x", buf[i]);
jbkim 0:b72d22e10709 340 if (i > 16) {
jbkim 0:b72d22e10709 341 debug(" ...");
jbkim 0:b72d22e10709 342 break;
jbkim 0:b72d22e10709 343 }
jbkim 0:b72d22e10709 344 }
jbkim 0:b72d22e10709 345 debug("\r\n");
jbkim 0:b72d22e10709 346 if ((addr&0xf0ff)==0x4026 || (addr&0xf0ff)==0x4003) {
jbkim 0:b72d22e10709 347 wait_ms(200);
jbkim 0:b72d22e10709 348 }
Bongjun 2:c2eb7a08d7e6 349 #endif
jbkim 0:b72d22e10709 350 }
jbkim 0:b72d22e10709 351
jbkim 0:b72d22e10709 352 uint32_t str_to_ip(const char* str)
jbkim 0:b72d22e10709 353 {
jbkim 0:b72d22e10709 354 uint32_t ip = 0;
jbkim 0:b72d22e10709 355 char* p = (char*)str;
jbkim 0:b72d22e10709 356 for(int i = 0; i < 4; i++) {
jbkim 0:b72d22e10709 357 ip |= atoi(p);
jbkim 0:b72d22e10709 358 p = strchr(p, '.');
jbkim 0:b72d22e10709 359 if (p == NULL) {
jbkim 0:b72d22e10709 360 break;
jbkim 0:b72d22e10709 361 }
jbkim 0:b72d22e10709 362 ip <<= 8;
jbkim 0:b72d22e10709 363 p++;
jbkim 0:b72d22e10709 364 }
jbkim 0:b72d22e10709 365 return ip;
jbkim 0:b72d22e10709 366 }
jbkim 0:b72d22e10709 367
jbkim 0:b72d22e10709 368 void printfBytes(char* str, uint8_t* buf, int len)
jbkim 0:b72d22e10709 369 {
jbkim 0:b72d22e10709 370 printf("%s %d:", str, len);
jbkim 0:b72d22e10709 371 for(int i = 0; i < len; i++) {
jbkim 0:b72d22e10709 372 printf(" %02x", buf[i]);
jbkim 0:b72d22e10709 373 }
Bongjun 2:c2eb7a08d7e6 374 printf("\n");
jbkim 0:b72d22e10709 375 }
jbkim 0:b72d22e10709 376
jbkim 0:b72d22e10709 377 void printHex(uint8_t* buf, int len)
jbkim 0:b72d22e10709 378 {
jbkim 0:b72d22e10709 379 for(int i = 0; i < len; i++) {
jbkim 0:b72d22e10709 380 if ((i%16) == 0) {
jbkim 0:b72d22e10709 381 printf("%p", buf+i);
jbkim 0:b72d22e10709 382 }
jbkim 0:b72d22e10709 383 printf(" %02x", buf[i]);
jbkim 0:b72d22e10709 384 if ((i%16) == 15) {
jbkim 0:b72d22e10709 385 printf("\n");
jbkim 0:b72d22e10709 386 }
jbkim 0:b72d22e10709 387 }
jbkim 0:b72d22e10709 388 printf("\n");
jbkim 0:b72d22e10709 389 }
jbkim 0:b72d22e10709 390
jbkim 0:b72d22e10709 391 void debug_hex(uint8_t* buf, int len)
jbkim 0:b72d22e10709 392 {
jbkim 0:b72d22e10709 393 for(int i = 0; i < len; i++) {
jbkim 0:b72d22e10709 394 if ((i%16) == 0) {
jbkim 0:b72d22e10709 395 debug("%p", buf+i);
jbkim 0:b72d22e10709 396 }
jbkim 0:b72d22e10709 397 debug(" %02x", buf[i]);
jbkim 0:b72d22e10709 398 if ((i%16) == 15) {
jbkim 0:b72d22e10709 399 debug("\n");
jbkim 0:b72d22e10709 400 }
jbkim 0:b72d22e10709 401 }
jbkim 0:b72d22e10709 402 debug("\n");
jbkim 0:b72d22e10709 403 }
jbkim 0:b72d22e10709 404
jbkim 0:b72d22e10709 405 #endif