Sergei G / W5500Interface

W5500 from SeeedStudio on NUCLEO-L476RG

Dependents:   coap-example Borsch coap-example

Fork of W5500Interface by AMETEK Powervar

W5500Interface.cpp@3:61ff27ed8355, 2017-07-05 (annotated)

Committer:
sgnezdov
Date:
Wed Jul 05 18:37:40 2017 +0000
Revision:
3:61ff27ed8355
Parent:
2:06b6f9f7c071
Child:
4:80e302a610fd
cleaned up my own debug statements; interface works with DHCP.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dgriffin65 0:77e050d1fb12 1 // EthernetInterface for W5500 2014/8/20
dgriffin65 0:77e050d1fb12 2 /*
dgriffin65 0:77e050d1fb12 3 // sample usgae.
dgriffin65 0:77e050d1fb12 4 // copy below code block to main code.
dgriffin65 0:77e050d1fb12 5
dgriffin65 0:77e050d1fb12 6 #if defined(TARGET_LPC1114)
dgriffin65 0:77e050d1fb12 7 SPI spi(dp2, dp1, dp6); // mosi, miso, sclk
dgriffin65 0:77e050d1fb12 8 EthernetInterface eth(&spi, dp25, dp26); // spi, cs, reset
dgriffin65 0:77e050d1fb12 9 wait(1); // 1 second for stable state
dgriffin65 0:77e050d1fb12 10 #elif defined(TARGET_LPC1768)
dgriffin65 0:77e050d1fb12 11 SPI spi(p11, p12, p13); // mosi, miso, sclk
dgriffin65 0:77e050d1fb12 12 EthernetInterface eth(&spi, p14, p15); // spi, cs, reset
dgriffin65 0:77e050d1fb12 13 wait(1); // 1 second for stable state
dgriffin65 0:77e050d1fb12 14 #elif defined(TARGET_LPC11U68)
dgriffin65 0:77e050d1fb12 15 SPI spi(P0_9, P0_8, P1_29); // mosi, miso, sclk
dgriffin65 0:77e050d1fb12 16 EthernetInterface eth(&spi, P0_2, P1_28);//, nRESET(p9); // reset pin is dummy, don't affect any pin of WIZ550io
dgriffin65 0:77e050d1fb12 17 spi.format(8,0); // 8bit, mode 0
dgriffin65 0:77e050d1fb12 18 spi.frequency(7000000); // 7MHz
dgriffin65 0:77e050d1fb12 19 wait(1); // 1 second for stable state
dgriffin65 0:77e050d1fb12 20 #endif
dgriffin65 0:77e050d1fb12 21
dgriffin65 0:77e050d1fb12 22 eth.init(); //Use DHCP
dgriffin65 0:77e050d1fb12 23 dbg.printf("init\r\n");
dgriffin65 0:77e050d1fb12 24 eth.connect();
dgriffin65 0:77e050d1fb12 25 dbg.printf("IP address: %s\r\n", eth.getIPAddress());
dgriffin65 0:77e050d1fb12 26
dgriffin65 0:77e050d1fb12 27 */
dgriffin65 0:77e050d1fb12 28
dgriffin65 0:77e050d1fb12 29 #include "mbed.h"
dgriffin65 0:77e050d1fb12 30 #include "W5500Interface.h"
dgriffin65 0:77e050d1fb12 31
dgriffin65 0:77e050d1fb12 32 static int udp_local_port = 0;
dgriffin65 0:77e050d1fb12 33
dgriffin65 1:2dee44ea52a9 34 DigitalOut led1(LED1);
dgriffin65 1:2dee44ea52a9 35
dgriffin65 0:77e050d1fb12 36 #define SKT(h) ((w5500_socket*)h)
sgnezdov 2:06b6f9f7c071 37 #define w5500_WAIT_TIMEOUT 1500
dgriffin65 0:77e050d1fb12 38 #define w5500_ACCEPT_TIMEOUT 3000
dgriffin65 0:77e050d1fb12 39
dgriffin65 0:77e050d1fb12 40 /* Interface implementation */
dgriffin65 0:77e050d1fb12 41
dgriffin65 0:77e050d1fb12 42 W5500Interface::W5500Interface(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset) :
dgriffin65 0:77e050d1fb12 43 WIZnet_Chip(mosi, miso, sclk, cs, reset)
dgriffin65 0:77e050d1fb12 44 {
dgriffin65 0:77e050d1fb12 45 ip_set = false;
dgriffin65 0:77e050d1fb12 46 }
dgriffin65 0:77e050d1fb12 47
dgriffin65 0:77e050d1fb12 48 W5500Interface::W5500Interface(SPI* spi, PinName cs, PinName reset) :
dgriffin65 0:77e050d1fb12 49 WIZnet_Chip(spi, cs, reset)
dgriffin65 0:77e050d1fb12 50 {
dgriffin65 0:77e050d1fb12 51 ip_set = false;
dgriffin65 0:77e050d1fb12 52 }
dgriffin65 0:77e050d1fb12 53
dgriffin65 1:2dee44ea52a9 54 w5500_socket* W5500Interface::get_sock(int fd)
dgriffin65 1:2dee44ea52a9 55 {
dgriffin65 1:2dee44ea52a9 56 for (int i=0; i<MAX_SOCK_NUM ; i++) {
dgriffin65 1:2dee44ea52a9 57 if (w5500_sockets[i].fd == -1) {
dgriffin65 1:2dee44ea52a9 58 w5500_sockets[i].fd = fd;
dgriffin65 1:2dee44ea52a9 59 w5500_sockets[i].proto = NSAPI_TCP;
dgriffin65 1:2dee44ea52a9 60 w5500_sockets[i].connected = false;
dgriffin65 1:2dee44ea52a9 61 w5500_sockets[i].callback = NULL;
dgriffin65 1:2dee44ea52a9 62 w5500_sockets[i].callback_data = NULL;
dgriffin65 1:2dee44ea52a9 63 return &w5500_sockets[i];
dgriffin65 1:2dee44ea52a9 64 }
dgriffin65 1:2dee44ea52a9 65 }
dgriffin65 1:2dee44ea52a9 66 return NULL;
dgriffin65 1:2dee44ea52a9 67 }
dgriffin65 1:2dee44ea52a9 68
dgriffin65 1:2dee44ea52a9 69 void W5500Interface::init_socks()
dgriffin65 1:2dee44ea52a9 70 {
dgriffin65 1:2dee44ea52a9 71 for (int i=0; i<MAX_SOCK_NUM ; i++) {
dgriffin65 1:2dee44ea52a9 72 w5500_sockets[i].fd = -1;
dgriffin65 1:2dee44ea52a9 73 w5500_sockets[i].proto = NSAPI_TCP;
dgriffin65 1:2dee44ea52a9 74 w5500_sockets[i].callback = NULL;
dgriffin65 1:2dee44ea52a9 75 w5500_sockets[i].callback_data = NULL;
dgriffin65 1:2dee44ea52a9 76 w5500_sockets[i].connected = false;
dgriffin65 1:2dee44ea52a9 77 }
dgriffin65 1:2dee44ea52a9 78
dgriffin65 1:2dee44ea52a9 79 //initialize the socket isr
dgriffin65 1:2dee44ea52a9 80 _daemon = new Thread(osPriorityNormal, 1024);
dgriffin65 1:2dee44ea52a9 81 _daemon->start(callback(this, &W5500Interface::daemon));
dgriffin65 1:2dee44ea52a9 82 }
dgriffin65 1:2dee44ea52a9 83
dgriffin65 0:77e050d1fb12 84 int W5500Interface::init()
dgriffin65 0:77e050d1fb12 85 {
dgriffin65 0:77e050d1fb12 86 WIZnet_Chip::reg_wr<uint32_t>(SIPR, 0x00000000); // local ip "0.0.0.0"
dgriffin65 1:2dee44ea52a9 87 //WIZnet_Chip::reg_wr<uint8_t>(SIMR, 0xFF); //
dgriffin65 0:77e050d1fb12 88 reset();
dgriffin65 1:2dee44ea52a9 89 init_socks();
dgriffin65 0:77e050d1fb12 90 return 0;
dgriffin65 0:77e050d1fb12 91 }
dgriffin65 0:77e050d1fb12 92
dgriffin65 0:77e050d1fb12 93 int W5500Interface::init(uint8_t * mac)
dgriffin65 0:77e050d1fb12 94 {
sgnezdov 2:06b6f9f7c071 95 WIZnet_Chip::reg_wr<uint32_t>(SIPR, 0x00000000); // local ip "0.0.0.0"
dgriffin65 0:77e050d1fb12 96 for (int i =0; i < 6; i++) this->mac[i] = mac[i];
dgriffin65 0:77e050d1fb12 97 setmac();
sgnezdov 2:06b6f9f7c071 98 reset(); // sets buffers; does not alter MAC
dgriffin65 1:2dee44ea52a9 99 init_socks();
dgriffin65 0:77e050d1fb12 100 return 0;
dgriffin65 0:77e050d1fb12 101 }
dgriffin65 0:77e050d1fb12 102
dgriffin65 0:77e050d1fb12 103 // add this function, because sometimes no needed MAC address in init calling.
dgriffin65 0:77e050d1fb12 104 int W5500Interface::init(const char* ip, const char* mask, const char* gateway)
dgriffin65 0:77e050d1fb12 105 {
dgriffin65 0:77e050d1fb12 106 this->ip = str_to_ip(ip);
dgriffin65 0:77e050d1fb12 107 strcpy(ip_string, ip);
dgriffin65 0:77e050d1fb12 108 ip_set = true;
dgriffin65 0:77e050d1fb12 109 this->netmask = str_to_ip(mask);
dgriffin65 0:77e050d1fb12 110 this->gateway = str_to_ip(gateway);
dgriffin65 0:77e050d1fb12 111 reset();
dgriffin65 0:77e050d1fb12 112
dgriffin65 0:77e050d1fb12 113 // @Jul. 8. 2014 add code. should be called to write chip.
dgriffin65 0:77e050d1fb12 114 setip();
dgriffin65 1:2dee44ea52a9 115 init_socks();
dgriffin65 0:77e050d1fb12 116
dgriffin65 0:77e050d1fb12 117 return 0;
dgriffin65 0:77e050d1fb12 118 }
dgriffin65 0:77e050d1fb12 119
dgriffin65 0:77e050d1fb12 120 int W5500Interface::init(uint8_t * mac, const char* ip, const char* mask, const char* gateway)
dgriffin65 0:77e050d1fb12 121 {
dgriffin65 0:77e050d1fb12 122 //
dgriffin65 0:77e050d1fb12 123 for (int i =0; i < 6; i++) this->mac[i] = mac[i];
dgriffin65 0:77e050d1fb12 124 //
dgriffin65 0:77e050d1fb12 125 this->ip = str_to_ip(ip);
dgriffin65 0:77e050d1fb12 126 strcpy(ip_string, ip);
dgriffin65 0:77e050d1fb12 127 ip_set = true;
dgriffin65 0:77e050d1fb12 128 this->netmask = str_to_ip(mask);
dgriffin65 0:77e050d1fb12 129 this->gateway = str_to_ip(gateway);
dgriffin65 0:77e050d1fb12 130 reset();
dgriffin65 0:77e050d1fb12 131
dgriffin65 0:77e050d1fb12 132 // @Jul. 8. 2014 add code. should be called to write chip.
dgriffin65 0:77e050d1fb12 133 setmac();
dgriffin65 0:77e050d1fb12 134 setip();
dgriffin65 1:2dee44ea52a9 135 init_socks();
dgriffin65 0:77e050d1fb12 136
dgriffin65 0:77e050d1fb12 137 return 0;
dgriffin65 0:77e050d1fb12 138 }
dgriffin65 0:77e050d1fb12 139
dgriffin65 1:2dee44ea52a9 140 void W5500Interface::daemon () {
dgriffin65 1:2dee44ea52a9 141 for (;;) {
dgriffin65 1:2dee44ea52a9 142 for (int i=0; i<MAX_SOCK_NUM ; i++) {
dgriffin65 1:2dee44ea52a9 143 if (w5500_sockets[i].fd > 0 && w5500_sockets[i].callback) {
dgriffin65 1:2dee44ea52a9 144 int size = sreg<uint16_t>(w5500_sockets[i].fd, Sn_RX_RSR);
dgriffin65 1:2dee44ea52a9 145 if (size > 0) {
dgriffin65 1:2dee44ea52a9 146 led1 = !led1;
dgriffin65 1:2dee44ea52a9 147 w5500_sockets[i].callback(w5500_sockets[i].callback_data);
dgriffin65 1:2dee44ea52a9 148 }
dgriffin65 1:2dee44ea52a9 149 }
dgriffin65 1:2dee44ea52a9 150 }
dgriffin65 1:2dee44ea52a9 151 wait(0.2);
dgriffin65 1:2dee44ea52a9 152 }
dgriffin65 1:2dee44ea52a9 153 }
dgriffin65 1:2dee44ea52a9 154
dgriffin65 0:77e050d1fb12 155 int W5500Interface::connect()
dgriffin65 0:77e050d1fb12 156 {
dgriffin65 0:77e050d1fb12 157 if (WIZnet_Chip::setip() == false) return NSAPI_ERROR_DHCP_FAILURE;
dgriffin65 0:77e050d1fb12 158 return 0;
dgriffin65 0:77e050d1fb12 159 }
dgriffin65 0:77e050d1fb12 160
dgriffin65 0:77e050d1fb12 161 int W5500Interface::disconnect()
dgriffin65 0:77e050d1fb12 162 {
dgriffin65 0:77e050d1fb12 163 WIZnet_Chip::disconnect();
dgriffin65 0:77e050d1fb12 164 return 0;
dgriffin65 0:77e050d1fb12 165 }
dgriffin65 0:77e050d1fb12 166
dgriffin65 0:77e050d1fb12 167 const char *W5500Interface::get_ip_address()
dgriffin65 0:77e050d1fb12 168 {
dgriffin65 0:77e050d1fb12 169 uint32_t ip = reg_rd<uint32_t>(SIPR);
dgriffin65 0:77e050d1fb12 170 snprintf(ip_string, sizeof(ip_string), "%d.%d.%d.%d", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, ip&0xff);
dgriffin65 0:77e050d1fb12 171 return ip_string;
dgriffin65 0:77e050d1fb12 172 }
dgriffin65 0:77e050d1fb12 173
dgriffin65 0:77e050d1fb12 174 const char *W5500Interface::get_mac_address()
dgriffin65 0:77e050d1fb12 175 {
dgriffin65 0:77e050d1fb12 176 uint8_t mac[6];
dgriffin65 0:77e050d1fb12 177 reg_rd_mac(SHAR, mac);
dgriffin65 0:77e050d1fb12 178 snprintf(mac_string, sizeof(mac_string), "%02X:%02X:%02X:%02X:%02X:%02X", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
dgriffin65 0:77e050d1fb12 179 return mac_string;
dgriffin65 0:77e050d1fb12 180 }
dgriffin65 0:77e050d1fb12 181
sgnezdov 2:06b6f9f7c071 182 void W5500Interface::get_mac(uint8_t mac[6])
sgnezdov 2:06b6f9f7c071 183 {
sgnezdov 2:06b6f9f7c071 184 reg_rd_mac(SHAR, mac);
sgnezdov 2:06b6f9f7c071 185 }
sgnezdov 2:06b6f9f7c071 186
dgriffin65 0:77e050d1fb12 187 nsapi_error_t W5500Interface::socket_open(nsapi_socket_t *handle, nsapi_protocol_t proto)
dgriffin65 0:77e050d1fb12 188 {
dgriffin65 0:77e050d1fb12 189 //a socket is created the same way regardless of the protocol
dgriffin65 0:77e050d1fb12 190 int sock_fd = WIZnet_Chip::new_socket();
dgriffin65 0:77e050d1fb12 191 if (sock_fd < 0) {
dgriffin65 0:77e050d1fb12 192 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 0:77e050d1fb12 193 }
dgriffin65 0:77e050d1fb12 194
dgriffin65 1:2dee44ea52a9 195 w5500_socket *h = get_sock(sock_fd);
dgriffin65 0:77e050d1fb12 196
dgriffin65 1:2dee44ea52a9 197 if (!h) {
dgriffin65 1:2dee44ea52a9 198 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 1:2dee44ea52a9 199 }
dgriffin65 1:2dee44ea52a9 200
dgriffin65 1:2dee44ea52a9 201 h->proto = proto;
dgriffin65 1:2dee44ea52a9 202 h->connected = false;
dgriffin65 1:2dee44ea52a9 203 h->callback = NULL;
dgriffin65 1:2dee44ea52a9 204 h->callback_data = NULL;
dgriffin65 0:77e050d1fb12 205
dgriffin65 0:77e050d1fb12 206 //new up an int to store the socket fd
dgriffin65 0:77e050d1fb12 207 *handle = h;
dgriffin65 0:77e050d1fb12 208
dgriffin65 0:77e050d1fb12 209 return 0;
dgriffin65 0:77e050d1fb12 210 }
dgriffin65 0:77e050d1fb12 211
dgriffin65 1:2dee44ea52a9 212 void W5500Interface::signal_event(nsapi_socket_t handle)
dgriffin65 1:2dee44ea52a9 213 {
dgriffin65 1:2dee44ea52a9 214 if (SKT(handle)->callback != NULL) {
dgriffin65 1:2dee44ea52a9 215 SKT(handle)->callback(SKT(handle)->callback_data);
dgriffin65 1:2dee44ea52a9 216 }
dgriffin65 1:2dee44ea52a9 217 }
dgriffin65 1:2dee44ea52a9 218
dgriffin65 0:77e050d1fb12 219 nsapi_error_t W5500Interface::socket_close(nsapi_socket_t handle)
dgriffin65 0:77e050d1fb12 220 {
dgriffin65 0:77e050d1fb12 221 if (handle == NULL) return 0;
dgriffin65 0:77e050d1fb12 222 WIZnet_Chip::close(SKT(handle)->fd);
dgriffin65 1:2dee44ea52a9 223
dgriffin65 1:2dee44ea52a9 224 SKT(handle)->fd = -1;
dgriffin65 1:2dee44ea52a9 225
dgriffin65 0:77e050d1fb12 226 return 0;
dgriffin65 0:77e050d1fb12 227 }
dgriffin65 0:77e050d1fb12 228
dgriffin65 0:77e050d1fb12 229 nsapi_error_t W5500Interface::socket_bind(nsapi_socket_t handle, const SocketAddress &address)
dgriffin65 0:77e050d1fb12 230 {
dgriffin65 0:77e050d1fb12 231 if (handle < 0) {
dgriffin65 0:77e050d1fb12 232 return NSAPI_ERROR_DEVICE_ERROR;
dgriffin65 0:77e050d1fb12 233 }
dgriffin65 0:77e050d1fb12 234
dgriffin65 0:77e050d1fb12 235 switch (SKT(handle)->proto) {
dgriffin65 0:77e050d1fb12 236 case NSAPI_UDP:
dgriffin65 0:77e050d1fb12 237 // set local port
dgriffin65 0:77e050d1fb12 238 if (address.get_port() != 0) {
dgriffin65 0:77e050d1fb12 239 WIZnet_Chip::sreg<uint16_t>(SKT(handle)->fd, Sn_PORT, address.get_port());
dgriffin65 0:77e050d1fb12 240 } else {
dgriffin65 0:77e050d1fb12 241 udp_local_port++;
dgriffin65 0:77e050d1fb12 242 WIZnet_Chip::sreg<uint16_t>(SKT(handle)->fd, Sn_PORT, udp_local_port);
dgriffin65 0:77e050d1fb12 243 }
dgriffin65 0:77e050d1fb12 244 // set udp protocol
dgriffin65 0:77e050d1fb12 245 WIZnet_Chip::setProtocol(SKT(handle)->fd, UDP);
dgriffin65 0:77e050d1fb12 246 WIZnet_Chip::scmd(SKT(handle)->fd, OPEN);
dgriffin65 0:77e050d1fb12 247 return 0;
dgriffin65 0:77e050d1fb12 248 case NSAPI_TCP:
dgriffin65 0:77e050d1fb12 249 listen_port = address.get_port();
dgriffin65 0:77e050d1fb12 250 // set TCP protocol
dgriffin65 0:77e050d1fb12 251 WIZnet_Chip::setProtocol(SKT(handle)->fd, TCP);
dgriffin65 0:77e050d1fb12 252 // set local port
dgriffin65 0:77e050d1fb12 253 WIZnet_Chip::sreg<uint16_t>(SKT(handle)->fd, Sn_PORT, address.get_port());
dgriffin65 0:77e050d1fb12 254 // connect the network
dgriffin65 0:77e050d1fb12 255 WIZnet_Chip::scmd(SKT(handle)->fd, OPEN);
dgriffin65 0:77e050d1fb12 256 return 0;
dgriffin65 0:77e050d1fb12 257 }
dgriffin65 0:77e050d1fb12 258
dgriffin65 0:77e050d1fb12 259 return NSAPI_ERROR_DEVICE_ERROR;
dgriffin65 0:77e050d1fb12 260 }
dgriffin65 0:77e050d1fb12 261
dgriffin65 0:77e050d1fb12 262 nsapi_error_t W5500Interface::socket_listen(nsapi_socket_t handle, int backlog)
dgriffin65 0:77e050d1fb12 263 {
dgriffin65 0:77e050d1fb12 264 if (SKT(handle)->fd < 0) {
dgriffin65 0:77e050d1fb12 265 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 0:77e050d1fb12 266 }
dgriffin65 0:77e050d1fb12 267 if (backlog != 1) {
dgriffin65 0:77e050d1fb12 268 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 0:77e050d1fb12 269 }
dgriffin65 0:77e050d1fb12 270 WIZnet_Chip::scmd(SKT(handle)->fd, LISTEN);
dgriffin65 0:77e050d1fb12 271 return 0;
dgriffin65 0:77e050d1fb12 272 }
dgriffin65 0:77e050d1fb12 273
dgriffin65 0:77e050d1fb12 274 nsapi_size_or_error_t W5500Interface::socket_connect(nsapi_socket_t handle, const SocketAddress &address)
dgriffin65 0:77e050d1fb12 275 {
dgriffin65 0:77e050d1fb12 276 //check for a valid socket
dgriffin65 0:77e050d1fb12 277 if (SKT(handle)->fd < 0) {
dgriffin65 0:77e050d1fb12 278 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 0:77e050d1fb12 279 }
dgriffin65 0:77e050d1fb12 280
dgriffin65 0:77e050d1fb12 281 //before we attempt to connect, we are not connected
dgriffin65 0:77e050d1fb12 282 SKT(handle)->connected = false;
dgriffin65 0:77e050d1fb12 283
dgriffin65 0:77e050d1fb12 284 //try to connect
dgriffin65 0:77e050d1fb12 285 if (!WIZnet_Chip::connect(SKT(handle)->fd, address.get_ip_address(), address.get_port(), 0)) {
dgriffin65 0:77e050d1fb12 286 return -1;
dgriffin65 0:77e050d1fb12 287 }
dgriffin65 0:77e050d1fb12 288
dgriffin65 0:77e050d1fb12 289 //we are now connected
dgriffin65 0:77e050d1fb12 290 SKT(handle)->connected = true;
dgriffin65 0:77e050d1fb12 291
dgriffin65 0:77e050d1fb12 292 return 0;
dgriffin65 0:77e050d1fb12 293 }
dgriffin65 0:77e050d1fb12 294
dgriffin65 0:77e050d1fb12 295 nsapi_error_t W5500Interface::socket_accept(nsapi_socket_t server, nsapi_socket_t *handle, SocketAddress *address)
dgriffin65 0:77e050d1fb12 296 {
dgriffin65 0:77e050d1fb12 297 if (SKT(server)->fd < 0) {
dgriffin65 0:77e050d1fb12 298 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 0:77e050d1fb12 299 }
dgriffin65 0:77e050d1fb12 300
dgriffin65 0:77e050d1fb12 301 SKT(server)->connected = false;
dgriffin65 0:77e050d1fb12 302
dgriffin65 0:77e050d1fb12 303 Timer t;
dgriffin65 0:77e050d1fb12 304 t.reset();
dgriffin65 0:77e050d1fb12 305 t.start();
dgriffin65 1:2dee44ea52a9 306
dgriffin65 0:77e050d1fb12 307 while(1) {
dgriffin65 1:2dee44ea52a9 308 //if (t.read_ms() > w5500_ACCEPT_TIMEOUT) {
dgriffin65 1:2dee44ea52a9 309 // printf("W5500Interface::socket_accept, timed out\r\n");
dgriffin65 1:2dee44ea52a9 310 // return NSAPI_ERROR_WOULD_BLOCK;
dgriffin65 1:2dee44ea52a9 311 //}
dgriffin65 1:2dee44ea52a9 312
dgriffin65 1:2dee44ea52a9 313 nsapi_error_t err = WIZnet_Chip::sreg<uint8_t>(SKT(server)->fd, Sn_SR);
dgriffin65 1:2dee44ea52a9 314
dgriffin65 1:2dee44ea52a9 315 if (err == SOCK_ESTABLISHED) {
dgriffin65 0:77e050d1fb12 316 break;
dgriffin65 0:77e050d1fb12 317 }
dgriffin65 0:77e050d1fb12 318 }
dgriffin65 0:77e050d1fb12 319
dgriffin65 1:2dee44ea52a9 320 //get socket for the connection
dgriffin65 1:2dee44ea52a9 321 *handle = get_sock(SKT(server)->fd);
dgriffin65 1:2dee44ea52a9 322
dgriffin65 1:2dee44ea52a9 323 if (!(*handle)) {
dgriffin65 1:2dee44ea52a9 324 error("No more socketa for binding");
dgriffin65 1:2dee44ea52a9 325 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 1:2dee44ea52a9 326 }
dgriffin65 1:2dee44ea52a9 327
dgriffin65 0:77e050d1fb12 328 //give it all of the socket info from the server
dgriffin65 0:77e050d1fb12 329 SKT(*handle)->proto = SKT(server)->proto;
dgriffin65 0:77e050d1fb12 330 SKT(*handle)->connected = true;
dgriffin65 1:2dee44ea52a9 331
dgriffin65 0:77e050d1fb12 332 //create a new tcp socket for the server
dgriffin65 0:77e050d1fb12 333 SKT(server)->fd = WIZnet_Chip::new_socket();
dgriffin65 0:77e050d1fb12 334 if (SKT(server)->fd < 0) {
dgriffin65 0:77e050d1fb12 335 error("Unable to open a new socket");
dgriffin65 0:77e050d1fb12 336 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 0:77e050d1fb12 337 }
dgriffin65 0:77e050d1fb12 338
dgriffin65 0:77e050d1fb12 339 SKT(server)->proto = NSAPI_TCP;
dgriffin65 0:77e050d1fb12 340 SKT(server)->connected = false;
dgriffin65 0:77e050d1fb12 341
dgriffin65 0:77e050d1fb12 342 SocketAddress _addr;
dgriffin65 0:77e050d1fb12 343 _addr.set_port(listen_port);
dgriffin65 0:77e050d1fb12 344
dgriffin65 0:77e050d1fb12 345 // and then, for the next connection, server socket should be assigned new one.
dgriffin65 0:77e050d1fb12 346 if (socket_bind(server, _addr) < 0) {
dgriffin65 0:77e050d1fb12 347 error("No more socketa for binding");
dgriffin65 0:77e050d1fb12 348 return NSAPI_ERROR_NO_SOCKET;
dgriffin65 0:77e050d1fb12 349 }
dgriffin65 0:77e050d1fb12 350
dgriffin65 0:77e050d1fb12 351 if (socket_listen(server, 1) < 0) {
dgriffin65 1:2dee44ea52a9 352 error("No more sockets for listening");
dgriffin65 0:77e050d1fb12 353 }
dgriffin65 0:77e050d1fb12 354
dgriffin65 0:77e050d1fb12 355 if (address) {
dgriffin65 0:77e050d1fb12 356 uint32_t ip = WIZnet_Chip::sreg<uint32_t>(SKT(*handle)->fd, Sn_DIPR);
dgriffin65 0:77e050d1fb12 357 char host[17];
dgriffin65 0:77e050d1fb12 358 snprintf(host, sizeof(host), "%d.%d.%d.%d", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, ip&0xff);
dgriffin65 0:77e050d1fb12 359 int port = WIZnet_Chip::sreg<uint16_t>(SKT(*handle)->fd, Sn_DPORT);
dgriffin65 0:77e050d1fb12 360
dgriffin65 0:77e050d1fb12 361 _addr.set_ip_address(host);
dgriffin65 0:77e050d1fb12 362 _addr.set_port(port);
dgriffin65 0:77e050d1fb12 363 *address = _addr;
dgriffin65 0:77e050d1fb12 364 }
dgriffin65 0:77e050d1fb12 365
dgriffin65 0:77e050d1fb12 366 return 0;
dgriffin65 0:77e050d1fb12 367 }
dgriffin65 0:77e050d1fb12 368
dgriffin65 0:77e050d1fb12 369 nsapi_size_or_error_t W5500Interface::socket_send(nsapi_socket_t handle, const void *data, nsapi_size_t size)
dgriffin65 0:77e050d1fb12 370 {
dgriffin65 0:77e050d1fb12 371 int writtenLen = 0;
dgriffin65 0:77e050d1fb12 372 while (writtenLen < size) {
dgriffin65 0:77e050d1fb12 373 int _size = WIZnet_Chip::wait_writeable(SKT(handle)->fd, w5500_WAIT_TIMEOUT);
dgriffin65 0:77e050d1fb12 374 if (_size < 0) {
dgriffin65 0:77e050d1fb12 375 return NSAPI_ERROR_WOULD_BLOCK;
dgriffin65 0:77e050d1fb12 376 }
dgriffin65 0:77e050d1fb12 377 if (_size > (size-writtenLen)) {
dgriffin65 0:77e050d1fb12 378 _size = (size-writtenLen);
dgriffin65 0:77e050d1fb12 379 }
dgriffin65 0:77e050d1fb12 380 int ret = WIZnet_Chip::send(SKT(handle)->fd, (char*)data, (int)_size);
dgriffin65 0:77e050d1fb12 381 if (ret < 0) {
dgriffin65 0:77e050d1fb12 382 return -1;
dgriffin65 0:77e050d1fb12 383 }
dgriffin65 0:77e050d1fb12 384 writtenLen += ret;
dgriffin65 0:77e050d1fb12 385 }
dgriffin65 0:77e050d1fb12 386 return writtenLen;
dgriffin65 0:77e050d1fb12 387 }
dgriffin65 0:77e050d1fb12 388
dgriffin65 0:77e050d1fb12 389 nsapi_size_or_error_t W5500Interface::socket_recv(nsapi_socket_t handle, void *data, nsapi_size_t size)
dgriffin65 0:77e050d1fb12 390 {
dgriffin65 0:77e050d1fb12 391 // add to cover exception.
dgriffin65 0:77e050d1fb12 392 if ((SKT(handle)->fd < 0) || !SKT(handle)->connected) {
dgriffin65 0:77e050d1fb12 393 return -1;
dgriffin65 0:77e050d1fb12 394 }
dgriffin65 0:77e050d1fb12 395
dgriffin65 0:77e050d1fb12 396 int _size = WIZnet_Chip::wait_readable(SKT(handle)->fd, w5500_WAIT_TIMEOUT);
dgriffin65 0:77e050d1fb12 397
dgriffin65 0:77e050d1fb12 398 if (_size < 0) {
dgriffin65 0:77e050d1fb12 399 return NSAPI_ERROR_WOULD_BLOCK;
dgriffin65 0:77e050d1fb12 400 }
dgriffin65 0:77e050d1fb12 401
dgriffin65 0:77e050d1fb12 402 if (_size > size) {
dgriffin65 0:77e050d1fb12 403 _size = size;
dgriffin65 0:77e050d1fb12 404 }
dgriffin65 0:77e050d1fb12 405 return WIZnet_Chip::recv(SKT(handle)->fd, (char*)data, (int)_size);
dgriffin65 0:77e050d1fb12 406 }
dgriffin65 0:77e050d1fb12 407
dgriffin65 0:77e050d1fb12 408 nsapi_size_or_error_t W5500Interface::socket_sendto(nsapi_socket_t handle, const SocketAddress &address,
dgriffin65 0:77e050d1fb12 409 const void *data, nsapi_size_t size)
dgriffin65 0:77e050d1fb12 410 {
sgnezdov 3:61ff27ed8355 411 //compare with original: int size = eth->wait_writeable(_sock_fd, _blocking ? -1 : _timeout, length-1);
sgnezdov 3:61ff27ed8355 412 int len = WIZnet_Chip::wait_writeable(SKT(handle)->fd, w5500_WAIT_TIMEOUT, size-1);
dgriffin65 0:77e050d1fb12 413 if (len < 0) {
dgriffin65 0:77e050d1fb12 414 return NSAPI_ERROR_WOULD_BLOCK;;
dgriffin65 0:77e050d1fb12 415 }
dgriffin65 0:77e050d1fb12 416
dgriffin65 0:77e050d1fb12 417 // set remote host
dgriffin65 0:77e050d1fb12 418 WIZnet_Chip::sreg_ip(SKT(handle)->fd, Sn_DIPR, address.get_ip_address());
dgriffin65 0:77e050d1fb12 419 // set remote port
dgriffin65 0:77e050d1fb12 420 WIZnet_Chip::sreg<uint16_t>(SKT(handle)->fd, Sn_DPORT, address.get_port());
sgnezdov 3:61ff27ed8355 421
dgriffin65 0:77e050d1fb12 422 return WIZnet_Chip::send(SKT(handle)->fd, (const char*)data, size);
dgriffin65 0:77e050d1fb12 423 }
dgriffin65 0:77e050d1fb12 424
dgriffin65 0:77e050d1fb12 425 nsapi_size_or_error_t W5500Interface::socket_recvfrom(nsapi_socket_t handle, SocketAddress *address,
dgriffin65 0:77e050d1fb12 426 void *buffer, nsapi_size_t size)
dgriffin65 0:77e050d1fb12 427 {
dgriffin65 0:77e050d1fb12 428 //check for null pointers
dgriffin65 0:77e050d1fb12 429 if (address == NULL || buffer == NULL) return -1;
dgriffin65 0:77e050d1fb12 430
dgriffin65 0:77e050d1fb12 431 uint8_t info[8];
dgriffin65 0:77e050d1fb12 432 int len = WIZnet_Chip::wait_readable(SKT(handle)->fd, w5500_WAIT_TIMEOUT, sizeof(info));
dgriffin65 0:77e050d1fb12 433 if (len < 0) {
dgriffin65 0:77e050d1fb12 434 return NSAPI_ERROR_WOULD_BLOCK;
dgriffin65 0:77e050d1fb12 435 }
dgriffin65 0:77e050d1fb12 436
dgriffin65 0:77e050d1fb12 437 //receive endpoint information
dgriffin65 0:77e050d1fb12 438 WIZnet_Chip::recv(SKT(handle)->fd, (char*)info, sizeof(info));
dgriffin65 0:77e050d1fb12 439
dgriffin65 0:77e050d1fb12 440 char addr[17];
dgriffin65 0:77e050d1fb12 441 snprintf(addr, sizeof(addr), "%d.%d.%d.%d", info[0], info[1], info[2], info[3]);
dgriffin65 0:77e050d1fb12 442 uint16_t port = info[4]<<8|info[5];
dgriffin65 0:77e050d1fb12 443 address->set_ip_address(addr);
dgriffin65 0:77e050d1fb12 444 address->set_port(port);
dgriffin65 0:77e050d1fb12 445
dgriffin65 0:77e050d1fb12 446 int udp_size = info[6]<<8|info[7];
dgriffin65 0:77e050d1fb12 447
dgriffin65 0:77e050d1fb12 448 if (udp_size > (len-sizeof(info))) {
dgriffin65 0:77e050d1fb12 449 return -1;
dgriffin65 0:77e050d1fb12 450 }
dgriffin65 0:77e050d1fb12 451
dgriffin65 0:77e050d1fb12 452 //receive from socket
dgriffin65 0:77e050d1fb12 453 return WIZnet_Chip::recv(SKT(handle)->fd, (char*)buffer, udp_size);
dgriffin65 0:77e050d1fb12 454 }
dgriffin65 0:77e050d1fb12 455
dgriffin65 0:77e050d1fb12 456 void W5500Interface::socket_attach(void *handle, void (*callback)(void *), void *data)
dgriffin65 0:77e050d1fb12 457 {
dgriffin65 1:2dee44ea52a9 458 if (handle == NULL) return;
dgriffin65 1:2dee44ea52a9 459
dgriffin65 1:2dee44ea52a9 460 SKT(handle)->callback = callback;
dgriffin65 1:2dee44ea52a9 461 SKT(handle)->callback_data = data;
dgriffin65 0:77e050d1fb12 462 }