Bongjun Hur / W5500Interface

W5500 driver for mbed OS 5

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

Fork of W5500Interface by Sergei G

W5500Interface.cpp@17:60f75e78f35d, 2018-08-14 (annotated)

Committer:
Bongjun
Date:
Tue Aug 14 01:20:36 2018 +0000
Revision:
17:60f75e78f35d
Parent:
16:380b4a629c4f
Child:
18:afec30f0922a
remove dhcp codes in W5500.c/.h; remove gethostbyname() in W5500.c/.h; remove printfBytes(), printHex(), debug_hex() in W5500.c/.h

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Bongjun 6:e2ab76b2be07 1
Bongjun 6:e2ab76b2be07 2 /**
Bongjun 6:e2ab76b2be07 3 ******************************************************************************
Bongjun 6:e2ab76b2be07 4 * @file W5500Interface.h
Bongjun 6:e2ab76b2be07 5 * @author Bongjun Hur (modified version from Sergei G (https://os.mbed.com/users/sgnezdov/))
Bongjun 6:e2ab76b2be07 6 * @brief Implementation file of the NetworkStack for the W5500 Device
Bongjun 6:e2ab76b2be07 7 ******************************************************************************
Bongjun 6:e2ab76b2be07 8 * @attention
Bongjun 6:e2ab76b2be07 9 *
Bongjun 6:e2ab76b2be07 10 * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
Bongjun 6:e2ab76b2be07 11 * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE
Bongjun 6:e2ab76b2be07 12 * TIME. AS A RESULT, WIZnet SHALL NOT BE HELD LIABLE FOR ANY
Bongjun 6:e2ab76b2be07 13 * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING
Bongjun 6:e2ab76b2be07 14 * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE
Bongjun 6:e2ab76b2be07 15 * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
Bongjun 6:e2ab76b2be07 16 *
Bongjun 6:e2ab76b2be07 17 * <h2><center>&copy; COPYRIGHT 2017 WIZnet Co.,Ltd.</center></h2>
Bongjun 6:e2ab76b2be07 18 ******************************************************************************
Bongjun 6:e2ab76b2be07 19 */
Bongjun 6:e2ab76b2be07 20
Bongjun 6:e2ab76b2be07 21 #include "mbed.h"
Bongjun 6:e2ab76b2be07 22 #include "W5500Interface.h"
Bongjun 6:e2ab76b2be07 23
Bongjun 13:9e2a7c8da30c 24 static uint8_t W5500_DEFAULT_TESTMAC[6] = {0x00, 0x08, 0xdc, 0x45, 0x56, 0x67};
Bongjun 6:e2ab76b2be07 25 static int udp_local_port = 0;
Bongjun 6:e2ab76b2be07 26
Bongjun 6:e2ab76b2be07 27 #define SKT(h) ((w5500_socket*)h)
Bongjun 6:e2ab76b2be07 28 #define w5500_WAIT_TIMEOUT 1500
Bongjun 14:2f03158e52c3 29 #define w5500_ACCEPT_TIMEOUT 300000 //5 mins timeout, retrun NSAPI_ERROR_WOULD_BLOCK if there is no connection during 5 mins
Bongjun 6:e2ab76b2be07 30
Bongjun 15:9280e5bdd248 31 #define w5500_INTF_DBG 0
Bongjun 6:e2ab76b2be07 32
Bongjun 6:e2ab76b2be07 33 #if w5500_INTF_DBG
Bongjun 6:e2ab76b2be07 34 #define DBG(...) do{debug("[%s:%d]", __PRETTY_FUNCTION__,__LINE__);debug(__VA_ARGS__);} while(0);
Bongjun 6:e2ab76b2be07 35 #else
Bongjun 6:e2ab76b2be07 36 #define DBG(...) while(0);
Bongjun 6:e2ab76b2be07 37 #endif
Bongjun 6:e2ab76b2be07 38
Bongjun 8:c71c66d43703 39 /**
Bongjun 8:c71c66d43703 40 * @brief Defines a custom MAC address
Bongjun 8:c71c66d43703 41 * @note Have to be unique within the connected network!
Bongjun 8:c71c66d43703 42 * Modify the mac array items as needed.
Bongjun 8:c71c66d43703 43 * @param mac A 6-byte array defining the MAC address
Bongjun 8:c71c66d43703 44 * @retval
Bongjun 8:c71c66d43703 45 */
Bongjun 6:e2ab76b2be07 46 /* Interface implementation */
Bongjun 6:e2ab76b2be07 47
Bongjun 6:e2ab76b2be07 48 W5500Interface::W5500Interface(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset) :
Bongjun 6:e2ab76b2be07 49 _w5500(mosi, miso, sclk, cs, reset)
Bongjun 6:e2ab76b2be07 50 {
Bongjun 6:e2ab76b2be07 51 ip_set = false;
Bongjun 16:380b4a629c4f 52 _dhcp_enable = true;
Bongjun 6:e2ab76b2be07 53 }
Bongjun 6:e2ab76b2be07 54
Bongjun 8:c71c66d43703 55 /*
Bongjun 6:e2ab76b2be07 56 W5500Interface::W5500Interface(SPI* spi, PinName cs, PinName reset) :
Bongjun 6:e2ab76b2be07 57 _w5500(spi, cs, reset)
Bongjun 6:e2ab76b2be07 58 {
Bongjun 6:e2ab76b2be07 59 ip_set = false;
Bongjun 6:e2ab76b2be07 60 }
Bongjun 8:c71c66d43703 61 */
Bongjun 6:e2ab76b2be07 62
Bongjun 6:e2ab76b2be07 63 w5500_socket* W5500Interface::get_sock(int fd)
Bongjun 6:e2ab76b2be07 64 {
Bongjun 6:e2ab76b2be07 65 for (int i=0; i<MAX_SOCK_NUM ; i++) {
Bongjun 6:e2ab76b2be07 66 if (w5500_sockets[i].fd == -1) {
Bongjun 6:e2ab76b2be07 67 w5500_sockets[i].fd = fd;
Bongjun 6:e2ab76b2be07 68 w5500_sockets[i].proto = NSAPI_TCP;
Bongjun 6:e2ab76b2be07 69 w5500_sockets[i].connected = false;
Bongjun 6:e2ab76b2be07 70 w5500_sockets[i].callback = NULL;
Bongjun 6:e2ab76b2be07 71 w5500_sockets[i].callback_data = NULL;
Bongjun 6:e2ab76b2be07 72 return &w5500_sockets[i];
Bongjun 6:e2ab76b2be07 73 }
Bongjun 6:e2ab76b2be07 74 }
Bongjun 6:e2ab76b2be07 75 return NULL;
Bongjun 6:e2ab76b2be07 76 }
Bongjun 6:e2ab76b2be07 77
Bongjun 6:e2ab76b2be07 78 void W5500Interface::init_socks()
Bongjun 6:e2ab76b2be07 79 {
Bongjun 6:e2ab76b2be07 80 for (int i=0; i<MAX_SOCK_NUM ; i++) {
Bongjun 6:e2ab76b2be07 81 w5500_sockets[i].fd = -1;
Bongjun 6:e2ab76b2be07 82 w5500_sockets[i].proto = NSAPI_TCP;
Bongjun 6:e2ab76b2be07 83 w5500_sockets[i].connected = false;
Bongjun 6:e2ab76b2be07 84 w5500_sockets[i].callback = NULL;
Bongjun 6:e2ab76b2be07 85 w5500_sockets[i].callback_data = NULL;
Bongjun 6:e2ab76b2be07 86 }
Bongjun 6:e2ab76b2be07 87
Bongjun 11:5118c2bff025 88 dns.setup(get_stack());
Bongjun 6:e2ab76b2be07 89 //initialize the socket isr
Bongjun 6:e2ab76b2be07 90 //_daemon = new Thread(osPriorityNormal, 1024);
Bongjun 6:e2ab76b2be07 91 //_daemon->start(callback(this, &W5500Interface::daemon));
Bongjun 6:e2ab76b2be07 92 }
Bongjun 6:e2ab76b2be07 93
Bongjun 17:60f75e78f35d 94 uint32_t W5500Interface:: str_to_ip(const char* str)
Bongjun 17:60f75e78f35d 95 {
Bongjun 17:60f75e78f35d 96 uint32_t ip = 0;
Bongjun 17:60f75e78f35d 97 char* p = (char*)str;
Bongjun 17:60f75e78f35d 98 for(int i = 0; i < 4; i++) {
Bongjun 17:60f75e78f35d 99 ip |= atoi(p);
Bongjun 17:60f75e78f35d 100 p = strchr(p, '.');
Bongjun 17:60f75e78f35d 101 if (p == NULL) {
Bongjun 17:60f75e78f35d 102 break;
Bongjun 17:60f75e78f35d 103 }
Bongjun 17:60f75e78f35d 104 ip <<= 8;
Bongjun 17:60f75e78f35d 105 p++;
Bongjun 17:60f75e78f35d 106 }
Bongjun 17:60f75e78f35d 107 return ip;
Bongjun 17:60f75e78f35d 108 }
Bongjun 17:60f75e78f35d 109
Bongjun 6:e2ab76b2be07 110 int W5500Interface::init()
Bongjun 6:e2ab76b2be07 111 {
Bongjun 16:380b4a629c4f 112 _dhcp_enable = true;
Bongjun 6:e2ab76b2be07 113 _w5500.reg_wr<uint32_t>(SIPR, 0x00000000); // local ip "0.0.0.0"
Bongjun 6:e2ab76b2be07 114 //_w5500.reg_wr<uint8_t>(SIMR, 0xFF); //
Bongjun 13:9e2a7c8da30c 115 for (int i =0; i < 6; i++) _w5500.mac[i] = W5500_DEFAULT_TESTMAC[i];
Bongjun 13:9e2a7c8da30c 116 _w5500.setmac();
Bongjun 6:e2ab76b2be07 117 _w5500.reset();
Bongjun 6:e2ab76b2be07 118 init_socks();
Bongjun 6:e2ab76b2be07 119 return 0;
Bongjun 6:e2ab76b2be07 120 }
Bongjun 6:e2ab76b2be07 121
Bongjun 6:e2ab76b2be07 122 int W5500Interface::init(uint8_t * mac)
Bongjun 6:e2ab76b2be07 123 {
Bongjun 16:380b4a629c4f 124 _dhcp_enable = true;
Bongjun 6:e2ab76b2be07 125 _w5500.reg_wr<uint32_t>(SIPR, 0x00000000); // local ip "0.0.0.0"
Bongjun 8:c71c66d43703 126 // should set the mac address and keep the value in this class
Bongjun 6:e2ab76b2be07 127 for (int i =0; i < 6; i++) _w5500.mac[i] = mac[i];
Bongjun 6:e2ab76b2be07 128 _w5500.setmac();
Bongjun 8:c71c66d43703 129 _w5500.reset(); // reset chip and write mac address
Bongjun 6:e2ab76b2be07 130 init_socks();
Bongjun 6:e2ab76b2be07 131 return 0;
Bongjun 6:e2ab76b2be07 132 }
Bongjun 6:e2ab76b2be07 133
Bongjun 6:e2ab76b2be07 134 // add this function, because sometimes no needed MAC address in init calling.
Bongjun 6:e2ab76b2be07 135 int W5500Interface::init(const char* ip, const char* mask, const char* gateway)
Bongjun 6:e2ab76b2be07 136 {
Bongjun 16:380b4a629c4f 137 _dhcp_enable = false;
Bongjun 16:380b4a629c4f 138
Bongjun 6:e2ab76b2be07 139 _w5500.ip = str_to_ip(ip);
Bongjun 6:e2ab76b2be07 140 strcpy(ip_string, ip);
Bongjun 6:e2ab76b2be07 141 ip_set = true;
Bongjun 6:e2ab76b2be07 142 _w5500.netmask = str_to_ip(mask);
Bongjun 6:e2ab76b2be07 143 _w5500.gateway = str_to_ip(gateway);
Bongjun 6:e2ab76b2be07 144 _w5500.reset();
Bongjun 6:e2ab76b2be07 145
Bongjun 6:e2ab76b2be07 146 // @Jul. 8. 2014 add code. should be called to write chip.
Bongjun 6:e2ab76b2be07 147 _w5500.setip();
Bongjun 6:e2ab76b2be07 148 init_socks();
Bongjun 6:e2ab76b2be07 149
Bongjun 6:e2ab76b2be07 150 return 0;
Bongjun 6:e2ab76b2be07 151 }
Bongjun 6:e2ab76b2be07 152
Bongjun 6:e2ab76b2be07 153 int W5500Interface::init(uint8_t * mac, const char* ip, const char* mask, const char* gateway)
Bongjun 6:e2ab76b2be07 154 {
Bongjun 16:380b4a629c4f 155 _dhcp_enable = false;
Bongjun 6:e2ab76b2be07 156 //
Bongjun 6:e2ab76b2be07 157 for (int i =0; i < 6; i++) _w5500.mac[i] = mac[i];
Bongjun 6:e2ab76b2be07 158 //
Bongjun 6:e2ab76b2be07 159 _w5500.ip = str_to_ip(ip);
Bongjun 6:e2ab76b2be07 160 strcpy(ip_string, ip);
Bongjun 6:e2ab76b2be07 161 ip_set = true;
Bongjun 6:e2ab76b2be07 162 _w5500.netmask = str_to_ip(mask);
Bongjun 6:e2ab76b2be07 163 _w5500.gateway = str_to_ip(gateway);
Bongjun 6:e2ab76b2be07 164 _w5500.reset();
Bongjun 6:e2ab76b2be07 165
Bongjun 6:e2ab76b2be07 166 // @Jul. 8. 2014 add code. should be called to write chip.
Bongjun 6:e2ab76b2be07 167 _w5500.setmac();
Bongjun 6:e2ab76b2be07 168 _w5500.setip();
Bongjun 6:e2ab76b2be07 169 init_socks();
Bongjun 6:e2ab76b2be07 170
Bongjun 6:e2ab76b2be07 171 return 0;
Bongjun 6:e2ab76b2be07 172 }
Bongjun 6:e2ab76b2be07 173
Bongjun 6:e2ab76b2be07 174 /*
Bongjun 6:e2ab76b2be07 175 void W5500Interface::daemon () {
Bongjun 6:e2ab76b2be07 176 for (;;) {
Bongjun 6:e2ab76b2be07 177 for (int i=0; i<MAX_SOCK_NUM ; i++) {
Bongjun 6:e2ab76b2be07 178 if (w5500_sockets[i].fd > 0 && w5500_sockets[i].callback) {
Bongjun 6:e2ab76b2be07 179 int size = _w5500.sreg<uint16_t>(w5500_sockets[i].fd, Sn_RX_RSR);
Bongjun 6:e2ab76b2be07 180 if (size > 0) {
Bongjun 6:e2ab76b2be07 181 led1 = !led1;
Bongjun 6:e2ab76b2be07 182 w5500_sockets[i].callback(w5500_sockets[i].callback_data);
Bongjun 6:e2ab76b2be07 183 }
Bongjun 6:e2ab76b2be07 184 }
Bongjun 6:e2ab76b2be07 185 }
Bongjun 6:e2ab76b2be07 186 wait(0.2);
Bongjun 6:e2ab76b2be07 187 }
Bongjun 6:e2ab76b2be07 188 }
Bongjun 6:e2ab76b2be07 189 */
Bongjun 6:e2ab76b2be07 190
Bongjun 16:380b4a629c4f 191 int W5500Interface::IPrenew(int timeout_ms)
Bongjun 6:e2ab76b2be07 192 {
Bongjun 16:380b4a629c4f 193 DBG("[EasyConnect] DHCP start\n");
Bongjun 12:3a5f5b5ae5f8 194 int err = dhcp.setup(get_stack(), _w5500.mac, timeout_ms);
Bongjun 8:c71c66d43703 195 if (err == (-1)) {
Bongjun 16:380b4a629c4f 196 DBG("[EasyConnect] Timeout.\n");
Bongjun 16:380b4a629c4f 197 return NSAPI_ERROR_DHCP_FAILURE;
Bongjun 8:c71c66d43703 198 }
Bongjun 16:380b4a629c4f 199 DBG("[EasyConnect] DHCP completed\n");
Bongjun 16:380b4a629c4f 200 DBG("[EasyConnect] Connected, IP: %d.%d.%d.%d\r\n", dhcp.yiaddr[0], dhcp.yiaddr[1], dhcp.yiaddr[2], dhcp.yiaddr[3]);
Bongjun 8:c71c66d43703 201
Bongjun 8:c71c66d43703 202 char ip[24], gateway[24], netmask[24], dnsaddr[24];
Bongjun 8:c71c66d43703 203 sprintf(ip, "%d.%d.%d.%d", dhcp.yiaddr[0], dhcp.yiaddr[1], dhcp.yiaddr[2], dhcp.yiaddr[3]);
Bongjun 8:c71c66d43703 204 sprintf(gateway, "%d.%d.%d.%d", dhcp.gateway[0], dhcp.gateway[1], dhcp.gateway[2], dhcp.gateway[3]);
Bongjun 8:c71c66d43703 205 sprintf(netmask, "%d.%d.%d.%d", dhcp.netmask[0], dhcp.netmask[1], dhcp.netmask[2], dhcp.netmask[3]);
Bongjun 8:c71c66d43703 206 sprintf(dnsaddr, "%d.%d.%d.%d", dhcp.dnsaddr[0], dhcp.dnsaddr[1], dhcp.dnsaddr[2], dhcp.dnsaddr[3]);
Bongjun 16:380b4a629c4f 207
Bongjun 8:c71c66d43703 208 init(ip, netmask, gateway);
Bongjun 12:3a5f5b5ae5f8 209 setDnsServerIP(dnsaddr);
Bongjun 16:380b4a629c4f 210
Bongjun 16:380b4a629c4f 211 _dhcp_enable = true; // because this value was changed in init(ip, netmask, gateway).
Bongjun 16:380b4a629c4f 212
Bongjun 16:380b4a629c4f 213 return 0;
Bongjun 16:380b4a629c4f 214 }
Bongjun 16:380b4a629c4f 215
Bongjun 16:380b4a629c4f 216
Bongjun 16:380b4a629c4f 217 int W5500Interface::connect()
Bongjun 16:380b4a629c4f 218 {
Bongjun 16:380b4a629c4f 219 if (_dhcp_enable) {
Bongjun 16:380b4a629c4f 220 init(); // init default mac address
Bongjun 16:380b4a629c4f 221 int err = IPrenew(15000);
Bongjun 16:380b4a629c4f 222 if (err < 0) return err;
Bongjun 16:380b4a629c4f 223 }
Bongjun 16:380b4a629c4f 224
Bongjun 6:e2ab76b2be07 225 if (_w5500.setip() == false) return NSAPI_ERROR_DHCP_FAILURE;
Bongjun 6:e2ab76b2be07 226 return 0;
Bongjun 6:e2ab76b2be07 227 }
Bongjun 6:e2ab76b2be07 228
Bongjun 11:5118c2bff025 229 bool W5500Interface::setDnsServerIP(const char* ip_address)
Bongjun 11:5118c2bff025 230 {
Bongjun 16:380b4a629c4f 231 return dns.set_server(ip_address);
Bongjun 11:5118c2bff025 232 }
Bongjun 16:380b4a629c4f 233
Bongjun 6:e2ab76b2be07 234 int W5500Interface::disconnect()
Bongjun 6:e2ab76b2be07 235 {
Bongjun 6:e2ab76b2be07 236 _w5500.disconnect();
Bongjun 6:e2ab76b2be07 237 return 0;
Bongjun 6:e2ab76b2be07 238 }
Bongjun 6:e2ab76b2be07 239
Bongjun 6:e2ab76b2be07 240 const char *W5500Interface::get_ip_address()
Bongjun 6:e2ab76b2be07 241 {
Bongjun 6:e2ab76b2be07 242 uint32_t ip = _w5500.reg_rd<uint32_t>(SIPR);
Bongjun 6:e2ab76b2be07 243 snprintf(ip_string, sizeof(ip_string), "%d.%d.%d.%d", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, ip&0xff);
Bongjun 6:e2ab76b2be07 244 return ip_string;
Bongjun 6:e2ab76b2be07 245 }
Bongjun 6:e2ab76b2be07 246
Bongjun 10:925201b1603f 247 const char *W5500Interface::get_netmask()
Bongjun 10:925201b1603f 248 {
Bongjun 10:925201b1603f 249 uint32_t netmask = _w5500.reg_rd<uint32_t>(SUBR);
Bongjun 10:925201b1603f 250 snprintf(netmask_string, sizeof(netmask_string), "%d.%d.%d.%d", (netmask>>24)&0xff, (netmask>>16)&0xff, (netmask>>8)&0xff, netmask&0xff);
Bongjun 10:925201b1603f 251 return netmask_string;
Bongjun 10:925201b1603f 252 }
Bongjun 10:925201b1603f 253
Bongjun 10:925201b1603f 254 const char *W5500Interface::get_gateway()
Bongjun 10:925201b1603f 255 {
Bongjun 10:925201b1603f 256 uint32_t gateway = _w5500.reg_rd<uint32_t>(GAR);
Bongjun 10:925201b1603f 257 snprintf(gateway_string, sizeof(gateway_string), "%d.%d.%d.%d", (gateway>>24)&0xff, (gateway>>16)&0xff, (gateway>>8)&0xff, gateway&0xff);
Bongjun 10:925201b1603f 258 return gateway_string;
Bongjun 10:925201b1603f 259 }
Bongjun 10:925201b1603f 260
Bongjun 6:e2ab76b2be07 261 const char *W5500Interface::get_mac_address()
Bongjun 6:e2ab76b2be07 262 {
Bongjun 6:e2ab76b2be07 263 uint8_t mac[6];
Bongjun 6:e2ab76b2be07 264 _w5500.reg_rd_mac(SHAR, mac);
Bongjun 6:e2ab76b2be07 265 snprintf(mac_string, sizeof(mac_string), "%02X:%02X:%02X:%02X:%02X:%02X", mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
Bongjun 6:e2ab76b2be07 266 return mac_string;
Bongjun 6:e2ab76b2be07 267 }
Bongjun 6:e2ab76b2be07 268
Bongjun 6:e2ab76b2be07 269 void W5500Interface::get_mac(uint8_t mac[6])
Bongjun 6:e2ab76b2be07 270 {
Bongjun 6:e2ab76b2be07 271 _w5500.reg_rd_mac(SHAR, mac);
Bongjun 6:e2ab76b2be07 272 }
Bongjun 6:e2ab76b2be07 273
Bongjun 6:e2ab76b2be07 274 nsapi_error_t W5500Interface::socket_open(nsapi_socket_t *handle, nsapi_protocol_t proto)
Bongjun 6:e2ab76b2be07 275 {
Bongjun 6:e2ab76b2be07 276 //a socket is created the same way regardless of the protocol
Bongjun 6:e2ab76b2be07 277 int sock_fd = _w5500.new_socket();
Bongjun 6:e2ab76b2be07 278 if (sock_fd < 0) {
Bongjun 6:e2ab76b2be07 279 return NSAPI_ERROR_NO_SOCKET;
Bongjun 6:e2ab76b2be07 280 }
Bongjun 6:e2ab76b2be07 281
Bongjun 6:e2ab76b2be07 282 w5500_socket *h = get_sock(sock_fd);
Bongjun 6:e2ab76b2be07 283
Bongjun 6:e2ab76b2be07 284 if (!h) {
Bongjun 6:e2ab76b2be07 285 return NSAPI_ERROR_NO_SOCKET;
Bongjun 6:e2ab76b2be07 286 }
Bongjun 6:e2ab76b2be07 287
Bongjun 6:e2ab76b2be07 288 h->proto = proto;
Bongjun 6:e2ab76b2be07 289 h->connected = false;
Bongjun 6:e2ab76b2be07 290 h->callback = NULL;
Bongjun 6:e2ab76b2be07 291 h->callback_data = NULL;
Bongjun 6:e2ab76b2be07 292
Bongjun 6:e2ab76b2be07 293 //new up an int to store the socket fd
Bongjun 6:e2ab76b2be07 294 *handle = h;
Bongjun 6:e2ab76b2be07 295 DBG("fd: %d\n", sock_fd);
Bongjun 6:e2ab76b2be07 296 return 0;
Bongjun 6:e2ab76b2be07 297 }
Bongjun 6:e2ab76b2be07 298
Bongjun 6:e2ab76b2be07 299 /*
Bongjun 6:e2ab76b2be07 300 void W5500Interface::signal_event(nsapi_socket_t handle)
Bongjun 6:e2ab76b2be07 301 {
Bongjun 6:e2ab76b2be07 302 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 303 if (SKT(handle)->callback != NULL) {
Bongjun 6:e2ab76b2be07 304 SKT(handle)->callback(SKT(handle)->callback_data);
Bongjun 6:e2ab76b2be07 305 }
Bongjun 6:e2ab76b2be07 306 }
Bongjun 6:e2ab76b2be07 307 */
Bongjun 6:e2ab76b2be07 308
Bongjun 6:e2ab76b2be07 309 nsapi_error_t W5500Interface::socket_close(nsapi_socket_t handle)
Bongjun 6:e2ab76b2be07 310 {
Bongjun 6:e2ab76b2be07 311 if (handle == NULL) return 0;
Bongjun 6:e2ab76b2be07 312 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 313 _w5500.close(SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 314
Bongjun 6:e2ab76b2be07 315 SKT(handle)->fd = -1;
Bongjun 6:e2ab76b2be07 316
Bongjun 6:e2ab76b2be07 317 return 0;
Bongjun 6:e2ab76b2be07 318 }
Bongjun 6:e2ab76b2be07 319
Bongjun 6:e2ab76b2be07 320 nsapi_error_t W5500Interface::socket_bind(nsapi_socket_t handle, const SocketAddress &address)
Bongjun 6:e2ab76b2be07 321 {
Bongjun 6:e2ab76b2be07 322 if (handle < 0) {
Bongjun 6:e2ab76b2be07 323 return NSAPI_ERROR_DEVICE_ERROR;
Bongjun 6:e2ab76b2be07 324 }
Bongjun 6:e2ab76b2be07 325 DBG("fd: %d, port: %d\n", SKT(handle)->fd, address.get_port());
Bongjun 6:e2ab76b2be07 326
Bongjun 6:e2ab76b2be07 327 switch (SKT(handle)->proto) {
Bongjun 6:e2ab76b2be07 328 case NSAPI_UDP:
Bongjun 6:e2ab76b2be07 329 // set local port
Bongjun 6:e2ab76b2be07 330 if (address.get_port() != 0) {
Bongjun 6:e2ab76b2be07 331 _w5500.setLocalPort( SKT(handle)->fd, address.get_port() );
Bongjun 6:e2ab76b2be07 332 } else {
Bongjun 6:e2ab76b2be07 333 udp_local_port++;
Bongjun 6:e2ab76b2be07 334 _w5500.setLocalPort( SKT(handle)->fd, udp_local_port );
Bongjun 6:e2ab76b2be07 335 }
Bongjun 6:e2ab76b2be07 336 // set udp protocol
Bongjun 6:e2ab76b2be07 337 _w5500.setProtocol(SKT(handle)->fd, UDP);
Bongjun 6:e2ab76b2be07 338 _w5500.scmd(SKT(handle)->fd, OPEN);
Bongjun 16:380b4a629c4f 339 /*
Bongjun 16:380b4a629c4f 340 uint8_t tmpSn_SR;
Bongjun 16:380b4a629c4f 341 tmpSn_SR = _w5500.sreg<uint8_t>(SKT(handle)->fd, Sn_SR);
Bongjun 16:380b4a629c4f 342 DBG("open socket status: %2x\n", tmpSn_SR);
Bongjun 16:380b4a629c4f 343 */
Bongjun 6:e2ab76b2be07 344 return 0;
Bongjun 6:e2ab76b2be07 345 case NSAPI_TCP:
Bongjun 6:e2ab76b2be07 346 listen_port = address.get_port();
Bongjun 6:e2ab76b2be07 347 // set TCP protocol
Bongjun 6:e2ab76b2be07 348 _w5500.setProtocol(SKT(handle)->fd, TCP);
Bongjun 6:e2ab76b2be07 349 // set local port
Bongjun 16:380b4a629c4f 350 _w5500.setLocalPort( SKT(handle)->fd, address.get_port() );
Bongjun 6:e2ab76b2be07 351 // connect the network
Bongjun 6:e2ab76b2be07 352 _w5500.scmd(SKT(handle)->fd, OPEN);
Bongjun 6:e2ab76b2be07 353 return 0;
Bongjun 6:e2ab76b2be07 354 }
Bongjun 6:e2ab76b2be07 355
Bongjun 6:e2ab76b2be07 356 return NSAPI_ERROR_DEVICE_ERROR;
Bongjun 6:e2ab76b2be07 357 }
Bongjun 6:e2ab76b2be07 358
Bongjun 6:e2ab76b2be07 359 nsapi_error_t W5500Interface::socket_listen(nsapi_socket_t handle, int backlog)
Bongjun 6:e2ab76b2be07 360 {
Bongjun 6:e2ab76b2be07 361 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 362 if (SKT(handle)->fd < 0) {
Bongjun 6:e2ab76b2be07 363 return NSAPI_ERROR_NO_SOCKET;
Bongjun 6:e2ab76b2be07 364 }
Bongjun 16:380b4a629c4f 365 /* if (backlog != 1) {
Bongjun 16:380b4a629c4f 366 return NSAPI_ERROR_NO_SOCKET;
Bongjun 16:380b4a629c4f 367 }
Bongjun 16:380b4a629c4f 368 */
Bongjun 6:e2ab76b2be07 369 _w5500.scmd(SKT(handle)->fd, LISTEN);
Bongjun 6:e2ab76b2be07 370 return 0;
Bongjun 6:e2ab76b2be07 371 }
Bongjun 6:e2ab76b2be07 372
Bongjun 6:e2ab76b2be07 373 nsapi_size_or_error_t W5500Interface::socket_connect(nsapi_socket_t handle, const SocketAddress &address)
Bongjun 6:e2ab76b2be07 374 {
Bongjun 6:e2ab76b2be07 375 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 376 //check for a valid socket
Bongjun 6:e2ab76b2be07 377 if (SKT(handle)->fd < 0) {
Bongjun 6:e2ab76b2be07 378 return NSAPI_ERROR_NO_SOCKET;
Bongjun 6:e2ab76b2be07 379 }
Bongjun 6:e2ab76b2be07 380
Bongjun 6:e2ab76b2be07 381 //before we attempt to connect, we are not connected
Bongjun 6:e2ab76b2be07 382 SKT(handle)->connected = false;
Bongjun 6:e2ab76b2be07 383
Bongjun 6:e2ab76b2be07 384 //try to connect
Bongjun 11:5118c2bff025 385 if (!_w5500.connect(SKT(handle)->fd, address.get_ip_address(), address.get_port(), w5500_WAIT_TIMEOUT)) {
Bongjun 6:e2ab76b2be07 386 return -1;
Bongjun 6:e2ab76b2be07 387 }
Bongjun 6:e2ab76b2be07 388
Bongjun 6:e2ab76b2be07 389 //we are now connected
Bongjun 6:e2ab76b2be07 390 SKT(handle)->connected = true;
Bongjun 6:e2ab76b2be07 391
Bongjun 6:e2ab76b2be07 392 return 0;
Bongjun 6:e2ab76b2be07 393 }
Bongjun 6:e2ab76b2be07 394
Bongjun 6:e2ab76b2be07 395 nsapi_error_t W5500Interface::socket_accept(nsapi_socket_t server, nsapi_socket_t *handle, SocketAddress *address)
Bongjun 6:e2ab76b2be07 396 {
Bongjun 16:380b4a629c4f 397 SocketAddress _addr;
Bongjun 6:e2ab76b2be07 398
Bongjun 6:e2ab76b2be07 399 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 400 if (SKT(server)->fd < 0) {
Bongjun 6:e2ab76b2be07 401 return NSAPI_ERROR_NO_SOCKET;
Bongjun 6:e2ab76b2be07 402 }
Bongjun 6:e2ab76b2be07 403
Bongjun 6:e2ab76b2be07 404 SKT(server)->connected = false;
Bongjun 6:e2ab76b2be07 405
Bongjun 6:e2ab76b2be07 406 Timer t;
Bongjun 6:e2ab76b2be07 407 t.reset();
Bongjun 6:e2ab76b2be07 408 t.start();
Bongjun 6:e2ab76b2be07 409
Bongjun 6:e2ab76b2be07 410 while(1) {
Bongjun 6:e2ab76b2be07 411 if (t.read_ms() > w5500_ACCEPT_TIMEOUT) {
Bongjun 13:9e2a7c8da30c 412 DBG("W5500Interface::socket_accept, timed out\r\n");
Bongjun 6:e2ab76b2be07 413 return NSAPI_ERROR_WOULD_BLOCK;
Bongjun 6:e2ab76b2be07 414 }
Bongjun 6:e2ab76b2be07 415 if (_w5500.is_connected(SKT(server)->fd)) break;
Bongjun 6:e2ab76b2be07 416 }
Bongjun 6:e2ab76b2be07 417
Bongjun 6:e2ab76b2be07 418 //get socket for the connection
Bongjun 6:e2ab76b2be07 419 *handle = get_sock(SKT(server)->fd);
Bongjun 6:e2ab76b2be07 420
Bongjun 6:e2ab76b2be07 421 if (!(*handle)) {
Bongjun 6:e2ab76b2be07 422 error("No more sockets for binding");
Bongjun 6:e2ab76b2be07 423 return NSAPI_ERROR_NO_SOCKET;
Bongjun 6:e2ab76b2be07 424 }
Bongjun 6:e2ab76b2be07 425
Bongjun 6:e2ab76b2be07 426 //give it all of the socket info from the server
Bongjun 6:e2ab76b2be07 427 SKT(*handle)->proto = SKT(server)->proto;
Bongjun 6:e2ab76b2be07 428 SKT(*handle)->connected = true;
Bongjun 6:e2ab76b2be07 429
Bongjun 6:e2ab76b2be07 430 if (address) {
Bongjun 6:e2ab76b2be07 431 uint32_t ip = _w5500.sreg<uint32_t>(SKT(*handle)->fd, Sn_DIPR);
Bongjun 6:e2ab76b2be07 432 char host[17];
Bongjun 6:e2ab76b2be07 433 snprintf(host, sizeof(host), "%d.%d.%d.%d", (ip>>24)&0xff, (ip>>16)&0xff, (ip>>8)&0xff, ip&0xff);
Bongjun 6:e2ab76b2be07 434 int port = _w5500.sreg<uint16_t>(SKT(*handle)->fd, Sn_DPORT);
Bongjun 6:e2ab76b2be07 435
Bongjun 6:e2ab76b2be07 436 _addr.set_ip_address(host);
Bongjun 6:e2ab76b2be07 437 _addr.set_port(port);
Bongjun 6:e2ab76b2be07 438 *address = _addr;
Bongjun 6:e2ab76b2be07 439 }
Bongjun 16:380b4a629c4f 440
Bongjun 16:380b4a629c4f 441
Bongjun 6:e2ab76b2be07 442 //create a new tcp socket for the server
Bongjun 6:e2ab76b2be07 443 SKT(server)->fd = _w5500.new_socket();
Bongjun 6:e2ab76b2be07 444 if (SKT(server)->fd < 0) {
Bongjun 6:e2ab76b2be07 445 error("No more sockets for listening");
Bongjun 6:e2ab76b2be07 446 //return NSAPI_ERROR_NO_SOCKET;
Bongjun 16:380b4a629c4f 447 // already accepted socket, so return 0, but there is no listen socket anymore.
Bongjun 16:380b4a629c4f 448 return 0;
Bongjun 16:380b4a629c4f 449 }
Bongjun 6:e2ab76b2be07 450
Bongjun 16:380b4a629c4f 451 SKT(server)->proto = NSAPI_TCP;
Bongjun 16:380b4a629c4f 452 SKT(server)->connected = false;
Bongjun 6:e2ab76b2be07 453
Bongjun 16:380b4a629c4f 454 _addr.set_port(listen_port);
Bongjun 6:e2ab76b2be07 455
Bongjun 6:e2ab76b2be07 456 // and then, for the next connection, server socket should be assigned new one.
Bongjun 6:e2ab76b2be07 457 if (socket_bind(server, _addr) < 0) {
Bongjun 6:e2ab76b2be07 458 error("No more sockets for listening");
Bongjun 6:e2ab76b2be07 459 //return NSAPI_ERROR_NO_SOCKET;
Bongjun 16:380b4a629c4f 460 // already accepted socket, so return 0, but there is no listen socket anymore.
Bongjun 16:380b4a629c4f 461 return 0;
Bongjun 6:e2ab76b2be07 462 }
Bongjun 6:e2ab76b2be07 463
Bongjun 6:e2ab76b2be07 464 if (socket_listen(server, 1) < 0) {
Bongjun 6:e2ab76b2be07 465 error("No more sockets for listening");
Bongjun 16:380b4a629c4f 466 // already accepted socket, so return 0, but there is no listen socket anymore.
Bongjun 16:380b4a629c4f 467 return 0;
Bongjun 6:e2ab76b2be07 468 }
Bongjun 6:e2ab76b2be07 469
Bongjun 6:e2ab76b2be07 470 return 0;
Bongjun 6:e2ab76b2be07 471 }
Bongjun 6:e2ab76b2be07 472
Bongjun 6:e2ab76b2be07 473 nsapi_size_or_error_t W5500Interface::socket_send(nsapi_socket_t handle, const void *data, nsapi_size_t size)
Bongjun 6:e2ab76b2be07 474 {
Bongjun 6:e2ab76b2be07 475 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 476 int writtenLen = 0;
Bongjun 6:e2ab76b2be07 477 while (writtenLen < size) {
Bongjun 6:e2ab76b2be07 478 int _size = _w5500.wait_writeable(SKT(handle)->fd, w5500_WAIT_TIMEOUT);
Bongjun 6:e2ab76b2be07 479 if (_size < 0) {
Bongjun 6:e2ab76b2be07 480 return NSAPI_ERROR_WOULD_BLOCK;
Bongjun 6:e2ab76b2be07 481 }
Bongjun 6:e2ab76b2be07 482 if (_size > (size-writtenLen)) {
Bongjun 6:e2ab76b2be07 483 _size = (size-writtenLen);
Bongjun 6:e2ab76b2be07 484 }
Bongjun 6:e2ab76b2be07 485 int ret = _w5500.send(SKT(handle)->fd, (char*)data, (int)_size);
Bongjun 6:e2ab76b2be07 486 if (ret < 0) {
Bongjun 6:e2ab76b2be07 487 DBG("returning error -1\n");
Bongjun 6:e2ab76b2be07 488 return -1;
Bongjun 6:e2ab76b2be07 489 }
Bongjun 6:e2ab76b2be07 490 writtenLen += ret;
Bongjun 6:e2ab76b2be07 491 }
Bongjun 6:e2ab76b2be07 492 return writtenLen;
Bongjun 6:e2ab76b2be07 493 }
Bongjun 6:e2ab76b2be07 494
Bongjun 6:e2ab76b2be07 495 nsapi_size_or_error_t W5500Interface::socket_recv(nsapi_socket_t handle, void *data, nsapi_size_t size)
Bongjun 6:e2ab76b2be07 496 {
Bongjun 6:e2ab76b2be07 497 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 498 // add to cover exception.
Bongjun 6:e2ab76b2be07 499 if ((SKT(handle)->fd < 0) || !SKT(handle)->connected) {
Bongjun 6:e2ab76b2be07 500 return -1;
Bongjun 6:e2ab76b2be07 501 }
Bongjun 11:5118c2bff025 502 DBG("fd: connected is %d\n", SKT(handle)->connected);
Bongjun 6:e2ab76b2be07 503
Bongjun 6:e2ab76b2be07 504 int _size = _w5500.wait_readable(SKT(handle)->fd, w5500_WAIT_TIMEOUT);
Bongjun 11:5118c2bff025 505 DBG("fd: size is %d\n", _size);
Bongjun 6:e2ab76b2be07 506
Bongjun 6:e2ab76b2be07 507 if (_size < 0) {
Bongjun 6:e2ab76b2be07 508 return NSAPI_ERROR_WOULD_BLOCK;
Bongjun 6:e2ab76b2be07 509 }
Bongjun 6:e2ab76b2be07 510
Bongjun 6:e2ab76b2be07 511 if (_size > size) {
Bongjun 6:e2ab76b2be07 512 _size = size;
Bongjun 6:e2ab76b2be07 513 }
Bongjun 11:5118c2bff025 514
Bongjun 11:5118c2bff025 515 nsapi_size_or_error_t err = _w5500.recv(SKT(handle)->fd, (char*)data, (int)_size);
Bongjun 11:5118c2bff025 516 DBG("rv: %d\n", err);
Bongjun 11:5118c2bff025 517
Bongjun 11:5118c2bff025 518 #if w5500_INTF_DBG
Bongjun 11:5118c2bff025 519 if (err > 0) {
Bongjun 11:5118c2bff025 520 debug("[socket_recv] buffer:");
Bongjun 11:5118c2bff025 521 for(int i = 0; i < err; i++) {
Bongjun 11:5118c2bff025 522 if ((i%16) == 0) {
Bongjun 11:5118c2bff025 523 debug("\n");
Bongjun 11:5118c2bff025 524 }
Bongjun 11:5118c2bff025 525 debug(" %02x", ((uint8_t*)data)[i]);
Bongjun 11:5118c2bff025 526 }
Bongjun 11:5118c2bff025 527 if ((err-1%16) != 0) {
Bongjun 11:5118c2bff025 528 debug("\n");
Bongjun 11:5118c2bff025 529 }
Bongjun 11:5118c2bff025 530 }
Bongjun 11:5118c2bff025 531 #endif
Bongjun 11:5118c2bff025 532 return err;
Bongjun 6:e2ab76b2be07 533 }
Bongjun 6:e2ab76b2be07 534
Bongjun 6:e2ab76b2be07 535 nsapi_size_or_error_t W5500Interface::socket_sendto(nsapi_socket_t handle, const SocketAddress &address,
Bongjun 6:e2ab76b2be07 536 const void *data, nsapi_size_t size)
Bongjun 6:e2ab76b2be07 537 {
Bongjun 6:e2ab76b2be07 538 DBG("fd: %d, ip: %s:%d\n", SKT(handle)->fd, address.get_ip_address(), address.get_port());
Bongjun 6:e2ab76b2be07 539 if (_w5500.is_closed(SKT(handle)->fd)) {
Bongjun 6:e2ab76b2be07 540 nsapi_error_t err = socket_bind(handle, address);
Bongjun 6:e2ab76b2be07 541 if (err < 0 ) {
Bongjun 6:e2ab76b2be07 542 DBG("failed to bind socket: %d\n", err);
Bongjun 6:e2ab76b2be07 543 return err;
Bongjun 6:e2ab76b2be07 544 }
Bongjun 6:e2ab76b2be07 545 }
Bongjun 6:e2ab76b2be07 546 //compare with original: int size = eth->wait_writeable(_sock_fd, _blocking ? -1 : _timeout, length-1);
Bongjun 6:e2ab76b2be07 547 int len = _w5500.wait_writeable(SKT(handle)->fd, w5500_WAIT_TIMEOUT, size-1);
Bongjun 6:e2ab76b2be07 548 if (len < 0) {
Bongjun 6:e2ab76b2be07 549 DBG("error: NSAPI_ERROR_WOULD_BLOCK\n");
Bongjun 6:e2ab76b2be07 550 return NSAPI_ERROR_WOULD_BLOCK;;
Bongjun 6:e2ab76b2be07 551 }
Bongjun 6:e2ab76b2be07 552
Bongjun 6:e2ab76b2be07 553 // set remote host
Bongjun 6:e2ab76b2be07 554 _w5500.sreg_ip(SKT(handle)->fd, Sn_DIPR, address.get_ip_address());
Bongjun 6:e2ab76b2be07 555 // set remote port
Bongjun 6:e2ab76b2be07 556 _w5500.sreg<uint16_t>(SKT(handle)->fd, Sn_DPORT, address.get_port());
Bongjun 6:e2ab76b2be07 557
Bongjun 6:e2ab76b2be07 558 nsapi_size_or_error_t err = _w5500.send(SKT(handle)->fd, (const char*)data, size);
Bongjun 6:e2ab76b2be07 559 DBG("rv: %d, size: %d\n", err, size);
Bongjun 6:e2ab76b2be07 560
Bongjun 6:e2ab76b2be07 561 #if w5500_INTF_DBG
Bongjun 6:e2ab76b2be07 562 if (err > 0) {
Bongjun 6:e2ab76b2be07 563 debug("[socket_sendto] data: ");
Bongjun 6:e2ab76b2be07 564 for(int i = 0; i < err; i++) {
Bongjun 6:e2ab76b2be07 565 if ((i%16) == 0) {
Bongjun 6:e2ab76b2be07 566 debug("\n");
Bongjun 6:e2ab76b2be07 567 }
Bongjun 6:e2ab76b2be07 568 debug(" %02x", ((uint8_t*)data)[i]);
Bongjun 6:e2ab76b2be07 569 }
Bongjun 6:e2ab76b2be07 570 if ((err-1%16) != 0) {
Bongjun 6:e2ab76b2be07 571 debug("\n");
Bongjun 6:e2ab76b2be07 572 }
Bongjun 6:e2ab76b2be07 573 }
Bongjun 6:e2ab76b2be07 574 #endif
Bongjun 6:e2ab76b2be07 575 return err;
Bongjun 6:e2ab76b2be07 576 }
Bongjun 6:e2ab76b2be07 577
Bongjun 6:e2ab76b2be07 578 nsapi_size_or_error_t W5500Interface::socket_recvfrom(nsapi_socket_t handle, SocketAddress *address,
Bongjun 6:e2ab76b2be07 579 void *buffer, nsapi_size_t size)
Bongjun 6:e2ab76b2be07 580 {
Bongjun 6:e2ab76b2be07 581 DBG("fd: %d\n", SKT(handle)->fd);
Bongjun 6:e2ab76b2be07 582 //check for null pointers
Bongjun 6:e2ab76b2be07 583 if (buffer == NULL) {
Bongjun 6:e2ab76b2be07 584 DBG("buffer is NULL; receive is ABORTED\n");
Bongjun 6:e2ab76b2be07 585 return -1;
Bongjun 6:e2ab76b2be07 586 }
Bongjun 6:e2ab76b2be07 587
Bongjun 6:e2ab76b2be07 588 uint8_t info[8];
Bongjun 6:e2ab76b2be07 589 int len = _w5500.wait_readable(SKT(handle)->fd, w5500_WAIT_TIMEOUT, sizeof(info));
Bongjun 6:e2ab76b2be07 590 if (len < 0) {
Bongjun 6:e2ab76b2be07 591 DBG("error: NSAPI_ERROR_WOULD_BLOCK\n");
Bongjun 6:e2ab76b2be07 592 return NSAPI_ERROR_WOULD_BLOCK;
Bongjun 6:e2ab76b2be07 593 }
Bongjun 6:e2ab76b2be07 594
Bongjun 6:e2ab76b2be07 595 //receive endpoint information
Bongjun 6:e2ab76b2be07 596 _w5500.recv(SKT(handle)->fd, (char*)info, sizeof(info));
Bongjun 6:e2ab76b2be07 597
Bongjun 6:e2ab76b2be07 598 char addr[17];
Bongjun 6:e2ab76b2be07 599 snprintf(addr, sizeof(addr), "%d.%d.%d.%d", info[0], info[1], info[2], info[3]);
Bongjun 6:e2ab76b2be07 600 uint16_t port = info[4]<<8|info[5];
Bongjun 6:e2ab76b2be07 601 // original behavior was to terminate execution if address is NULL
Bongjun 6:e2ab76b2be07 602 if (address != NULL) {
Bongjun 6:e2ab76b2be07 603 //DBG("[socket_recvfrom] warn: addressis NULL");
Bongjun 6:e2ab76b2be07 604 address->set_ip_address(addr);
Bongjun 6:e2ab76b2be07 605 address->set_port(port);
Bongjun 6:e2ab76b2be07 606 }
Bongjun 6:e2ab76b2be07 607
Bongjun 6:e2ab76b2be07 608 int udp_size = info[6]<<8|info[7];
Bongjun 6:e2ab76b2be07 609
Bongjun 6:e2ab76b2be07 610 if (udp_size > (len-sizeof(info))) {
Bongjun 6:e2ab76b2be07 611 DBG("error: udp_size > (len-sizeof(info))\n");
Bongjun 6:e2ab76b2be07 612 return -1;
Bongjun 6:e2ab76b2be07 613 }
Bongjun 6:e2ab76b2be07 614
Bongjun 6:e2ab76b2be07 615 //receive from socket
Bongjun 6:e2ab76b2be07 616 nsapi_size_or_error_t err = _w5500.recv(SKT(handle)->fd, (char*)buffer, udp_size);
Bongjun 6:e2ab76b2be07 617 DBG("rv: %d\n", err);
Bongjun 11:5118c2bff025 618
Bongjun 6:e2ab76b2be07 619 #if w5500_INTF_DBG
Bongjun 6:e2ab76b2be07 620 if (err > 0) {
Bongjun 6:e2ab76b2be07 621 debug("[socket_recvfrom] buffer:");
Bongjun 6:e2ab76b2be07 622 for(int i = 0; i < err; i++) {
Bongjun 6:e2ab76b2be07 623 if ((i%16) == 0) {
Bongjun 6:e2ab76b2be07 624 debug("\n");
Bongjun 6:e2ab76b2be07 625 }
Bongjun 6:e2ab76b2be07 626 debug(" %02x", ((uint8_t*)buffer)[i]);
Bongjun 6:e2ab76b2be07 627 }
Bongjun 6:e2ab76b2be07 628 if ((err-1%16) != 0) {
Bongjun 6:e2ab76b2be07 629 debug("\n");
Bongjun 6:e2ab76b2be07 630 }
Bongjun 6:e2ab76b2be07 631 }
Bongjun 6:e2ab76b2be07 632 #endif
Bongjun 6:e2ab76b2be07 633 return err;
Bongjun 6:e2ab76b2be07 634 }
Bongjun 6:e2ab76b2be07 635
Bongjun 6:e2ab76b2be07 636 void W5500Interface::socket_attach(void *handle, void (*callback)(void *), void *data)
Bongjun 6:e2ab76b2be07 637 {
Bongjun 16:380b4a629c4f 638 /*
Bongjun 16:380b4a629c4f 639 if (handle == NULL) return;
Bongjun 16:380b4a629c4f 640 DBG("fd: %d, callback: %p\n", SKT(handle)->fd, callback);
Bongjun 16:380b4a629c4f 641 SKT(handle)->callback = callback;
Bongjun 16:380b4a629c4f 642 SKT(handle)->callback_data = data;
Bongjun 16:380b4a629c4f 643 */
Bongjun 6:e2ab76b2be07 644 if (handle == NULL) return;
Bongjun 6:e2ab76b2be07 645 w5500_socket *socket = (w5500_socket *)handle;
Bongjun 6:e2ab76b2be07 646 w5500_sockets[socket->fd].callback = callback;
Bongjun 6:e2ab76b2be07 647 w5500_sockets[socket->fd].callback_data = data;
Bongjun 6:e2ab76b2be07 648 }
Bongjun 6:e2ab76b2be07 649
Bongjun 6:e2ab76b2be07 650 /*
Bongjun 6:e2ab76b2be07 651 void W5500Interface::event()
Bongjun 6:e2ab76b2be07 652 {
Bongjun 6:e2ab76b2be07 653 for(int i=0; i<MAX_SOCK_NUM; i++){
Bongjun 6:e2ab76b2be07 654 if (w5500_sockets[i].callback) {
Bongjun 6:e2ab76b2be07 655 w5500_sockets[i].callback(w5500_sockets[i].data);
Bongjun 6:e2ab76b2be07 656 }
Bongjun 6:e2ab76b2be07 657 }
Bongjun 6:e2ab76b2be07 658 }
Bongjun 6:e2ab76b2be07 659 */
Bongjun 11:5118c2bff025 660
Bongjun 11:5118c2bff025 661
Bongjun 11:5118c2bff025 662 nsapi_error_t W5500Interface::gethostbyname(const char *host,
Bongjun 16:380b4a629c4f 663 SocketAddress *address, nsapi_version_t version)
Bongjun 11:5118c2bff025 664 {
Bongjun 16:380b4a629c4f 665 DBG("DNS process %s", host);
Bongjun 11:5118c2bff025 666 bool isOK = dns.lookup(host);
Bongjun 11:5118c2bff025 667 if (isOK) {
Bongjun 13:9e2a7c8da30c 668 DBG("is ok\n");
Bongjun 13:9e2a7c8da30c 669 DBG(" IP: %s\n", dns.get_ip_address());
Bongjun 11:5118c2bff025 670 } else {
Bongjun 13:9e2a7c8da30c 671 DBG(" IP is not ok\n");
Bongjun 11:5118c2bff025 672 return NSAPI_ERROR_DNS_FAILURE;
Bongjun 11:5118c2bff025 673 }
Bongjun 16:380b4a629c4f 674
Bongjun 16:380b4a629c4f 675 if ( !address->set_ip_address(dns.get_ip_address()) ) {
Bongjun 16:380b4a629c4f 676 return NSAPI_ERROR_DNS_FAILURE;
Bongjun 16:380b4a629c4f 677 }
Bongjun 16:380b4a629c4f 678 return NSAPI_ERROR_OK;
Bongjun 11:5118c2bff025 679 }