Bongjun Hur / W5500Interface

W5500 driver for mbed OS 5

Dependents:   http-webserver-example mbed-os-example-sockets

Fork of W5500Interface by Sergei G

WIZnet/W5500.cpp@2:06b6f9f7c071, 2017-07-01 (annotated)

Committer:
sgnezdov
Date:
Sat Jul 01 07:29:02 2017 +0000
Revision:
2:06b6f9f7c071
Parent:
1:2dee44ea52a9
Child:
3:61ff27ed8355
UDP packets are sent now; ; problem of blocking state tracking is exposed.

Who changed what in which revision?

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