W5500 driver for mbed OS 5

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

Fork of W5500Interface by Sergei G

Committer:
Bongjun
Date:
Thu Aug 09 08:10:27 2018 +0000
Revision:
6:e2ab76b2be07
Parent:
4:80e302a610fd
Child:
8:c71c66d43703
changes for mbed OS 5 web server example; - add internal W5500 instance; - changes for web server example

Who changed what in which revision?

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