modlwip.c 50 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463
  1. /*
  2. * This file is part of the MicroPython project, http://micropython.org/
  3. *
  4. * The MIT License (MIT)
  5. *
  6. * Copyright (c) 2013, 2014 Damien P. George
  7. * Copyright (c) 2015 Galen Hazelwood
  8. * Copyright (c) 2015-2017 Paul Sokolovsky
  9. *
  10. * Permission is hereby granted, free of charge, to any person obtaining a copy
  11. * of this software and associated documentation files (the "Software"), to deal
  12. * in the Software without restriction, including without limitation the rights
  13. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  14. * copies of the Software, and to permit persons to whom the Software is
  15. * furnished to do so, subject to the following conditions:
  16. *
  17. * The above copyright notice and this permission notice shall be included in
  18. * all copies or substantial portions of the Software.
  19. *
  20. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  21. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  22. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  23. * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  24. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  25. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  26. * THE SOFTWARE.
  27. */
  28. #include <string.h>
  29. #include <stdio.h>
  30. #include "py/objlist.h"
  31. #include "py/runtime.h"
  32. #include "py/stream.h"
  33. #include "py/mperrno.h"
  34. #include "py/mphal.h"
  35. #include "lib/netutils/netutils.h"
  36. #include "lwip/init.h"
  37. #include "lwip/tcp.h"
  38. #include "lwip/udp.h"
  39. //#include "lwip/raw.h"
  40. #include "lwip/dns.h"
  41. #include "lwip/igmp.h"
  42. #if LWIP_VERSION_MAJOR < 2
  43. #include "lwip/timers.h"
  44. #include "lwip/tcp_impl.h"
  45. #else
  46. #include "lwip/timeouts.h"
  47. #include "lwip/priv/tcp_priv.h"
  48. #endif
  49. #if 0 // print debugging info
  50. #define DEBUG_printf DEBUG_printf
  51. #else // don't print debugging info
  52. #define DEBUG_printf(...) (void)0
  53. #endif
  54. // All socket options should be globally distinct,
  55. // because we ignore option levels for efficiency.
  56. #define IP_ADD_MEMBERSHIP 0x400
  57. // For compatibilily with older lwIP versions.
  58. #ifndef ip_set_option
  59. #define ip_set_option(pcb, opt) ((pcb)->so_options |= (opt))
  60. #endif
  61. #ifndef ip_reset_option
  62. #define ip_reset_option(pcb, opt) ((pcb)->so_options &= ~(opt))
  63. #endif
  64. #ifdef MICROPY_PY_LWIP_SLIP
  65. #include "netif/slipif.h"
  66. #include "lwip/sio.h"
  67. #endif
  68. #ifdef MICROPY_PY_LWIP_SLIP
  69. /******************************************************************************/
  70. // Slip object for modlwip. Requires a serial driver for the port that supports
  71. // the lwip serial callback functions.
  72. typedef struct _lwip_slip_obj_t {
  73. mp_obj_base_t base;
  74. struct netif lwip_netif;
  75. } lwip_slip_obj_t;
  76. // Slip object is unique for now. Possibly can fix this later. FIXME
  77. STATIC lwip_slip_obj_t lwip_slip_obj;
  78. // Declare these early.
  79. void mod_lwip_register_poll(void (*poll)(void *arg), void *poll_arg);
  80. void mod_lwip_deregister_poll(void (*poll)(void *arg), void *poll_arg);
  81. STATIC void slip_lwip_poll(void *netif) {
  82. slipif_poll((struct netif*)netif);
  83. }
  84. STATIC const mp_obj_type_t lwip_slip_type;
  85. // lwIP SLIP callback functions
  86. sio_fd_t sio_open(u8_t dvnum) {
  87. // We support singleton SLIP interface, so just return any truish value.
  88. return (sio_fd_t)1;
  89. }
  90. void sio_send(u8_t c, sio_fd_t fd) {
  91. mp_obj_type_t *type = mp_obj_get_type(MP_STATE_VM(lwip_slip_stream));
  92. int error;
  93. type->stream_p->write(MP_STATE_VM(lwip_slip_stream), &c, 1, &error);
  94. }
  95. u32_t sio_tryread(sio_fd_t fd, u8_t *data, u32_t len) {
  96. mp_obj_type_t *type = mp_obj_get_type(MP_STATE_VM(lwip_slip_stream));
  97. int error;
  98. mp_uint_t out_sz = type->stream_p->read(MP_STATE_VM(lwip_slip_stream), data, len, &error);
  99. if (out_sz == MP_STREAM_ERROR) {
  100. if (mp_is_nonblocking_error(error)) {
  101. return 0;
  102. }
  103. // Can't do much else, can we?
  104. return 0;
  105. }
  106. return out_sz;
  107. }
  108. // constructor lwip.slip(device=integer, iplocal=string, ipremote=string)
  109. STATIC mp_obj_t lwip_slip_make_new(mp_obj_t type_in, size_t n_args, size_t n_kw, const mp_obj_t *args) {
  110. mp_arg_check_num(n_args, n_kw, 3, 3, false);
  111. lwip_slip_obj.base.type = &lwip_slip_type;
  112. MP_STATE_VM(lwip_slip_stream) = args[0];
  113. ip_addr_t iplocal, ipremote;
  114. if (!ipaddr_aton(mp_obj_str_get_str(args[1]), &iplocal)) {
  115. mp_raise_ValueError("not a valid local IP");
  116. }
  117. if (!ipaddr_aton(mp_obj_str_get_str(args[2]), &ipremote)) {
  118. mp_raise_ValueError("not a valid remote IP");
  119. }
  120. struct netif *n = &lwip_slip_obj.lwip_netif;
  121. if (netif_add(n, &iplocal, IP_ADDR_BROADCAST, &ipremote, NULL, slipif_init, ip_input) == NULL) {
  122. mp_raise_ValueError("out of memory");
  123. }
  124. netif_set_up(n);
  125. netif_set_default(n);
  126. mod_lwip_register_poll(slip_lwip_poll, n);
  127. return (mp_obj_t)&lwip_slip_obj;
  128. }
  129. STATIC mp_obj_t lwip_slip_status(mp_obj_t self_in) {
  130. // Null function for now.
  131. return mp_const_none;
  132. }
  133. STATIC MP_DEFINE_CONST_FUN_OBJ_1(lwip_slip_status_obj, lwip_slip_status);
  134. STATIC const mp_rom_map_elem_t lwip_slip_locals_dict_table[] = {
  135. { MP_ROM_QSTR(MP_QSTR_status), MP_ROM_PTR(&lwip_slip_status_obj) },
  136. };
  137. STATIC MP_DEFINE_CONST_DICT(lwip_slip_locals_dict, lwip_slip_locals_dict_table);
  138. STATIC const mp_obj_type_t lwip_slip_type = {
  139. { &mp_type_type },
  140. .name = MP_QSTR_slip,
  141. .make_new = lwip_slip_make_new,
  142. .locals_dict = (mp_obj_dict_t*)&lwip_slip_locals_dict,
  143. };
  144. #endif // MICROPY_PY_LWIP_SLIP
  145. /******************************************************************************/
  146. // Table to convert lwIP err_t codes to socket errno codes, from the lwIP
  147. // socket API.
  148. // lwIP 2 changed LWIP_VERSION and it can no longer be used in macros,
  149. // so we define our own equivalent version that can.
  150. #define LWIP_VERSION_MACRO (LWIP_VERSION_MAJOR << 24 | LWIP_VERSION_MINOR << 16 \
  151. | LWIP_VERSION_REVISION << 8 | LWIP_VERSION_RC)
  152. // Extension to lwIP error codes
  153. #define _ERR_BADF -16
  154. // TODO: We just know that change happened somewhere between 1.4.0 and 1.4.1,
  155. // investigate in more detail.
  156. #if LWIP_VERSION_MACRO < 0x01040100
  157. static const int error_lookup_table[] = {
  158. 0, /* ERR_OK 0 No error, everything OK. */
  159. MP_ENOMEM, /* ERR_MEM -1 Out of memory error. */
  160. MP_ENOBUFS, /* ERR_BUF -2 Buffer error. */
  161. MP_EWOULDBLOCK, /* ERR_TIMEOUT -3 Timeout */
  162. MP_EHOSTUNREACH, /* ERR_RTE -4 Routing problem. */
  163. MP_EINPROGRESS, /* ERR_INPROGRESS -5 Operation in progress */
  164. MP_EINVAL, /* ERR_VAL -6 Illegal value. */
  165. MP_EWOULDBLOCK, /* ERR_WOULDBLOCK -7 Operation would block. */
  166. MP_ECONNABORTED, /* ERR_ABRT -8 Connection aborted. */
  167. MP_ECONNRESET, /* ERR_RST -9 Connection reset. */
  168. MP_ENOTCONN, /* ERR_CLSD -10 Connection closed. */
  169. MP_ENOTCONN, /* ERR_CONN -11 Not connected. */
  170. MP_EIO, /* ERR_ARG -12 Illegal argument. */
  171. MP_EADDRINUSE, /* ERR_USE -13 Address in use. */
  172. -1, /* ERR_IF -14 Low-level netif error */
  173. MP_EALREADY, /* ERR_ISCONN -15 Already connected. */
  174. MP_EBADF, /* _ERR_BADF -16 Closed socket (null pcb) */
  175. };
  176. #elif LWIP_VERSION_MACRO < 0x02000000
  177. static const int error_lookup_table[] = {
  178. 0, /* ERR_OK 0 No error, everything OK. */
  179. MP_ENOMEM, /* ERR_MEM -1 Out of memory error. */
  180. MP_ENOBUFS, /* ERR_BUF -2 Buffer error. */
  181. MP_EWOULDBLOCK, /* ERR_TIMEOUT -3 Timeout */
  182. MP_EHOSTUNREACH, /* ERR_RTE -4 Routing problem. */
  183. MP_EINPROGRESS, /* ERR_INPROGRESS -5 Operation in progress */
  184. MP_EINVAL, /* ERR_VAL -6 Illegal value. */
  185. MP_EWOULDBLOCK, /* ERR_WOULDBLOCK -7 Operation would block. */
  186. MP_EADDRINUSE, /* ERR_USE -8 Address in use. */
  187. MP_EALREADY, /* ERR_ISCONN -9 Already connected. */
  188. MP_ECONNABORTED, /* ERR_ABRT -10 Connection aborted. */
  189. MP_ECONNRESET, /* ERR_RST -11 Connection reset. */
  190. MP_ENOTCONN, /* ERR_CLSD -12 Connection closed. */
  191. MP_ENOTCONN, /* ERR_CONN -13 Not connected. */
  192. MP_EIO, /* ERR_ARG -14 Illegal argument. */
  193. -1, /* ERR_IF -15 Low-level netif error */
  194. MP_EBADF, /* _ERR_BADF -16 Closed socket (null pcb) */
  195. };
  196. #else
  197. // Matches lwIP 2.0.3
  198. #undef _ERR_BADF
  199. #define _ERR_BADF -17
  200. static const int error_lookup_table[] = {
  201. 0, /* ERR_OK 0 No error, everything OK */
  202. MP_ENOMEM, /* ERR_MEM -1 Out of memory error */
  203. MP_ENOBUFS, /* ERR_BUF -2 Buffer error */
  204. MP_EWOULDBLOCK, /* ERR_TIMEOUT -3 Timeout */
  205. MP_EHOSTUNREACH, /* ERR_RTE -4 Routing problem */
  206. MP_EINPROGRESS, /* ERR_INPROGRESS -5 Operation in progress */
  207. MP_EINVAL, /* ERR_VAL -6 Illegal value */
  208. MP_EWOULDBLOCK, /* ERR_WOULDBLOCK -7 Operation would block */
  209. MP_EADDRINUSE, /* ERR_USE -8 Address in use */
  210. MP_EALREADY, /* ERR_ALREADY -9 Already connecting */
  211. MP_EALREADY, /* ERR_ISCONN -10 Conn already established */
  212. MP_ENOTCONN, /* ERR_CONN -11 Not connected */
  213. -1, /* ERR_IF -12 Low-level netif error */
  214. MP_ECONNABORTED, /* ERR_ABRT -13 Connection aborted */
  215. MP_ECONNRESET, /* ERR_RST -14 Connection reset */
  216. MP_ENOTCONN, /* ERR_CLSD -15 Connection closed */
  217. MP_EIO, /* ERR_ARG -16 Illegal argument. */
  218. MP_EBADF, /* _ERR_BADF -17 Closed socket (null pcb) */
  219. };
  220. #endif
  221. /*******************************************************************************/
  222. // The socket object provided by lwip.socket.
  223. #define MOD_NETWORK_AF_INET (2)
  224. #define MOD_NETWORK_AF_INET6 (10)
  225. #define MOD_NETWORK_SOCK_STREAM (1)
  226. #define MOD_NETWORK_SOCK_DGRAM (2)
  227. #define MOD_NETWORK_SOCK_RAW (3)
  228. typedef struct _lwip_socket_obj_t {
  229. mp_obj_base_t base;
  230. volatile union {
  231. struct tcp_pcb *tcp;
  232. struct udp_pcb *udp;
  233. } pcb;
  234. volatile union {
  235. struct pbuf *pbuf;
  236. struct tcp_pcb *connection;
  237. } incoming;
  238. mp_obj_t callback;
  239. byte peer[4];
  240. mp_uint_t peer_port;
  241. mp_uint_t timeout;
  242. uint16_t recv_offset;
  243. uint8_t domain;
  244. uint8_t type;
  245. #define STATE_NEW 0
  246. #define STATE_CONNECTING 1
  247. #define STATE_CONNECTED 2
  248. #define STATE_PEER_CLOSED 3
  249. // Negative value is lwIP error
  250. int8_t state;
  251. } lwip_socket_obj_t;
  252. static inline void poll_sockets(void) {
  253. #ifdef MICROPY_EVENT_POLL_HOOK
  254. MICROPY_EVENT_POLL_HOOK;
  255. #else
  256. mp_hal_delay_ms(1);
  257. #endif
  258. }
  259. /*******************************************************************************/
  260. // Callback functions for the lwIP raw API.
  261. static inline void exec_user_callback(lwip_socket_obj_t *socket) {
  262. if (socket->callback != MP_OBJ_NULL) {
  263. mp_call_function_1_protected(socket->callback, MP_OBJ_FROM_PTR(socket));
  264. }
  265. }
  266. // Callback for incoming UDP packets. We simply stash the packet and the source address,
  267. // in case we need it for recvfrom.
  268. #if LWIP_VERSION_MAJOR < 2
  269. STATIC void _lwip_udp_incoming(void *arg, struct udp_pcb *upcb, struct pbuf *p, ip_addr_t *addr, u16_t port)
  270. #else
  271. STATIC void _lwip_udp_incoming(void *arg, struct udp_pcb *upcb, struct pbuf *p, const ip_addr_t *addr, u16_t port)
  272. #endif
  273. {
  274. lwip_socket_obj_t *socket = (lwip_socket_obj_t*)arg;
  275. if (socket->incoming.pbuf != NULL) {
  276. // That's why they call it "unreliable". No room in the inn, drop the packet.
  277. pbuf_free(p);
  278. } else {
  279. socket->incoming.pbuf = p;
  280. socket->peer_port = (mp_uint_t)port;
  281. memcpy(&socket->peer, addr, sizeof(socket->peer));
  282. }
  283. }
  284. // Callback for general tcp errors.
  285. STATIC void _lwip_tcp_error(void *arg, err_t err) {
  286. lwip_socket_obj_t *socket = (lwip_socket_obj_t*)arg;
  287. // Pass the error code back via the connection variable.
  288. socket->state = err;
  289. // If we got here, the lwIP stack either has deallocated or will deallocate the pcb.
  290. socket->pcb.tcp = NULL;
  291. }
  292. // Callback for tcp connection requests. Error code err is unused. (See tcp.h)
  293. STATIC err_t _lwip_tcp_connected(void *arg, struct tcp_pcb *tpcb, err_t err) {
  294. lwip_socket_obj_t *socket = (lwip_socket_obj_t*)arg;
  295. socket->state = STATE_CONNECTED;
  296. return ERR_OK;
  297. }
  298. // By default, a child socket of listen socket is created with recv
  299. // handler which discards incoming pbuf's. We don't want to do that,
  300. // so set this handler which requests lwIP to keep pbuf's and deliver
  301. // them later. We cannot cache pbufs in child socket on Python side,
  302. // until it is created in accept().
  303. STATIC err_t _lwip_tcp_recv_unaccepted(void *arg, struct tcp_pcb *pcb, struct pbuf *p, err_t err) {
  304. return ERR_BUF;
  305. }
  306. // "Poll" (idle) callback to be called ASAP after accept callback
  307. // to execute Python callback function, as it can't be executed
  308. // from accept callback itself.
  309. STATIC err_t _lwip_tcp_accept_finished(void *arg, struct tcp_pcb *pcb)
  310. {
  311. lwip_socket_obj_t *socket = (lwip_socket_obj_t*)arg;
  312. tcp_poll(pcb, NULL, 0);
  313. exec_user_callback(socket);
  314. return ERR_OK;
  315. }
  316. // Callback for incoming tcp connections.
  317. STATIC err_t _lwip_tcp_accept(void *arg, struct tcp_pcb *newpcb, err_t err) {
  318. lwip_socket_obj_t *socket = (lwip_socket_obj_t*)arg;
  319. tcp_recv(newpcb, _lwip_tcp_recv_unaccepted);
  320. if (socket->incoming.connection != NULL) {
  321. DEBUG_printf("_lwip_tcp_accept: Tried to queue >1 pcb waiting for accept\n");
  322. // We need to handle this better. This single-level structure makes the
  323. // backlog setting kind of pointless. FIXME
  324. return ERR_BUF;
  325. } else {
  326. socket->incoming.connection = newpcb;
  327. if (socket->callback != MP_OBJ_NULL) {
  328. // Schedule accept callback to be called when lwIP is done
  329. // with processing this incoming connection on its side and
  330. // is idle.
  331. tcp_poll(newpcb, _lwip_tcp_accept_finished, 1);
  332. }
  333. return ERR_OK;
  334. }
  335. }
  336. // Callback for inbound tcp packets.
  337. STATIC err_t _lwip_tcp_recv(void *arg, struct tcp_pcb *tcpb, struct pbuf *p, err_t err) {
  338. lwip_socket_obj_t *socket = (lwip_socket_obj_t*)arg;
  339. if (p == NULL) {
  340. // Other side has closed connection.
  341. DEBUG_printf("_lwip_tcp_recv[%p]: other side closed connection\n", socket);
  342. socket->state = STATE_PEER_CLOSED;
  343. exec_user_callback(socket);
  344. return ERR_OK;
  345. }
  346. if (socket->incoming.pbuf == NULL) {
  347. socket->incoming.pbuf = p;
  348. } else {
  349. #ifdef SOCKET_SINGLE_PBUF
  350. return ERR_BUF;
  351. #else
  352. pbuf_cat(socket->incoming.pbuf, p);
  353. #endif
  354. }
  355. exec_user_callback(socket);
  356. return ERR_OK;
  357. }
  358. /*******************************************************************************/
  359. // Functions for socket send/receive operations. Socket send/recv and friends call
  360. // these to do the work.
  361. // Helper function for send/sendto to handle UDP packets.
  362. STATIC mp_uint_t lwip_udp_send(lwip_socket_obj_t *socket, const byte *buf, mp_uint_t len, byte *ip, mp_uint_t port, int *_errno) {
  363. if (len > 0xffff) {
  364. // Any packet that big is probably going to fail the pbuf_alloc anyway, but may as well try
  365. len = 0xffff;
  366. }
  367. // FIXME: maybe PBUF_ROM?
  368. struct pbuf *p = pbuf_alloc(PBUF_TRANSPORT, len, PBUF_RAM);
  369. if (p == NULL) {
  370. *_errno = MP_ENOMEM;
  371. return -1;
  372. }
  373. memcpy(p->payload, buf, len);
  374. err_t err;
  375. if (ip == NULL) {
  376. err = udp_send(socket->pcb.udp, p);
  377. } else {
  378. ip_addr_t dest;
  379. IP4_ADDR(&dest, ip[0], ip[1], ip[2], ip[3]);
  380. err = udp_sendto(socket->pcb.udp, p, &dest, port);
  381. }
  382. pbuf_free(p);
  383. // udp_sendto can return 1 on occasion for ESP8266 port. It's not known why
  384. // but it seems that the send actually goes through without error in this case.
  385. // So we treat such cases as a success until further investigation.
  386. if (err != ERR_OK && err != 1) {
  387. *_errno = error_lookup_table[-err];
  388. return -1;
  389. }
  390. return len;
  391. }
  392. // Helper function for recv/recvfrom to handle UDP packets
  393. STATIC mp_uint_t lwip_udp_receive(lwip_socket_obj_t *socket, byte *buf, mp_uint_t len, byte *ip, mp_uint_t *port, int *_errno) {
  394. if (socket->incoming.pbuf == NULL) {
  395. if (socket->timeout != -1) {
  396. for (mp_uint_t retries = socket->timeout / 100; retries--;) {
  397. mp_hal_delay_ms(100);
  398. if (socket->incoming.pbuf != NULL) break;
  399. }
  400. if (socket->incoming.pbuf == NULL) {
  401. *_errno = MP_ETIMEDOUT;
  402. return -1;
  403. }
  404. } else {
  405. while (socket->incoming.pbuf == NULL) {
  406. poll_sockets();
  407. }
  408. }
  409. }
  410. if (ip != NULL) {
  411. memcpy(ip, &socket->peer, sizeof(socket->peer));
  412. *port = socket->peer_port;
  413. }
  414. struct pbuf *p = socket->incoming.pbuf;
  415. u16_t result = pbuf_copy_partial(p, buf, ((p->tot_len > len) ? len : p->tot_len), 0);
  416. pbuf_free(p);
  417. socket->incoming.pbuf = NULL;
  418. return (mp_uint_t) result;
  419. }
  420. // For use in stream virtual methods
  421. #define STREAM_ERROR_CHECK(socket) \
  422. if (socket->state < 0) { \
  423. *_errno = error_lookup_table[-socket->state]; \
  424. return MP_STREAM_ERROR; \
  425. } \
  426. assert(socket->pcb.tcp);
  427. // Helper function for send/sendto to handle TCP packets
  428. STATIC mp_uint_t lwip_tcp_send(lwip_socket_obj_t *socket, const byte *buf, mp_uint_t len, int *_errno) {
  429. // Check for any pending errors
  430. STREAM_ERROR_CHECK(socket);
  431. u16_t available = tcp_sndbuf(socket->pcb.tcp);
  432. if (available == 0) {
  433. // Non-blocking socket
  434. if (socket->timeout == 0) {
  435. *_errno = MP_EAGAIN;
  436. return MP_STREAM_ERROR;
  437. }
  438. mp_uint_t start = mp_hal_ticks_ms();
  439. // Assume that STATE_PEER_CLOSED may mean half-closed connection, where peer closed it
  440. // sending direction, but not receiving. Consequently, check for both STATE_CONNECTED
  441. // and STATE_PEER_CLOSED as normal conditions and still waiting for buffers to be sent.
  442. // If peer fully closed socket, we would have socket->state set to ERR_RST (connection
  443. // reset) by error callback.
  444. // Avoid sending too small packets, so wait until at least 16 bytes available
  445. while (socket->state >= STATE_CONNECTED && (available = tcp_sndbuf(socket->pcb.tcp)) < 16) {
  446. if (socket->timeout != -1 && mp_hal_ticks_ms() - start > socket->timeout) {
  447. *_errno = MP_ETIMEDOUT;
  448. return MP_STREAM_ERROR;
  449. }
  450. poll_sockets();
  451. }
  452. // While we waited, something could happen
  453. STREAM_ERROR_CHECK(socket);
  454. }
  455. u16_t write_len = MIN(available, len);
  456. err_t err = tcp_write(socket->pcb.tcp, buf, write_len, TCP_WRITE_FLAG_COPY);
  457. // If the output buffer is getting full then send the data to the lower layers
  458. if (err == ERR_OK && tcp_sndbuf(socket->pcb.tcp) < TCP_SND_BUF / 4) {
  459. err = tcp_output(socket->pcb.tcp);
  460. }
  461. if (err != ERR_OK) {
  462. *_errno = error_lookup_table[-err];
  463. return MP_STREAM_ERROR;
  464. }
  465. return write_len;
  466. }
  467. // Helper function for recv/recvfrom to handle TCP packets
  468. STATIC mp_uint_t lwip_tcp_receive(lwip_socket_obj_t *socket, byte *buf, mp_uint_t len, int *_errno) {
  469. // Check for any pending errors
  470. STREAM_ERROR_CHECK(socket);
  471. if (socket->incoming.pbuf == NULL) {
  472. // Non-blocking socket
  473. if (socket->timeout == 0) {
  474. if (socket->state == STATE_PEER_CLOSED) {
  475. return 0;
  476. }
  477. *_errno = MP_EAGAIN;
  478. return -1;
  479. }
  480. mp_uint_t start = mp_hal_ticks_ms();
  481. while (socket->state == STATE_CONNECTED && socket->incoming.pbuf == NULL) {
  482. if (socket->timeout != -1 && mp_hal_ticks_ms() - start > socket->timeout) {
  483. *_errno = MP_ETIMEDOUT;
  484. return -1;
  485. }
  486. poll_sockets();
  487. }
  488. if (socket->state == STATE_PEER_CLOSED) {
  489. if (socket->incoming.pbuf == NULL) {
  490. // socket closed and no data left in buffer
  491. return 0;
  492. }
  493. } else if (socket->state != STATE_CONNECTED) {
  494. assert(socket->state < 0);
  495. *_errno = error_lookup_table[-socket->state];
  496. return -1;
  497. }
  498. }
  499. assert(socket->pcb.tcp != NULL);
  500. struct pbuf *p = socket->incoming.pbuf;
  501. mp_uint_t remaining = p->len - socket->recv_offset;
  502. if (len > remaining) {
  503. len = remaining;
  504. }
  505. memcpy(buf, (byte*)p->payload + socket->recv_offset, len);
  506. remaining -= len;
  507. if (remaining == 0) {
  508. socket->incoming.pbuf = p->next;
  509. // If we don't ref here, free() will free the entire chain,
  510. // if we ref, it does what we need: frees 1st buf, and decrements
  511. // next buf's refcount back to 1.
  512. pbuf_ref(p->next);
  513. pbuf_free(p);
  514. socket->recv_offset = 0;
  515. } else {
  516. socket->recv_offset += len;
  517. }
  518. tcp_recved(socket->pcb.tcp, len);
  519. return len;
  520. }
  521. /*******************************************************************************/
  522. // The socket functions provided by lwip.socket.
  523. STATIC const mp_obj_type_t lwip_socket_type;
  524. STATIC void lwip_socket_print(const mp_print_t *print, mp_obj_t self_in, mp_print_kind_t kind) {
  525. lwip_socket_obj_t *self = MP_OBJ_TO_PTR(self_in);
  526. mp_printf(print, "<socket state=%d timeout=%d incoming=%p off=%d>", self->state, self->timeout,
  527. self->incoming.pbuf, self->recv_offset);
  528. }
  529. // FIXME: Only supports two arguments at present
  530. STATIC mp_obj_t lwip_socket_make_new(const mp_obj_type_t *type, size_t n_args, size_t n_kw, const mp_obj_t *args) {
  531. mp_arg_check_num(n_args, n_kw, 0, 4, false);
  532. lwip_socket_obj_t *socket = m_new_obj_with_finaliser(lwip_socket_obj_t);
  533. socket->base.type = &lwip_socket_type;
  534. socket->domain = MOD_NETWORK_AF_INET;
  535. socket->type = MOD_NETWORK_SOCK_STREAM;
  536. socket->callback = MP_OBJ_NULL;
  537. if (n_args >= 1) {
  538. socket->domain = mp_obj_get_int(args[0]);
  539. if (n_args >= 2) {
  540. socket->type = mp_obj_get_int(args[1]);
  541. }
  542. }
  543. switch (socket->type) {
  544. case MOD_NETWORK_SOCK_STREAM: socket->pcb.tcp = tcp_new(); break;
  545. case MOD_NETWORK_SOCK_DGRAM: socket->pcb.udp = udp_new(); break;
  546. //case MOD_NETWORK_SOCK_RAW: socket->pcb.raw = raw_new(); break;
  547. default: mp_raise_OSError(MP_EINVAL);
  548. }
  549. if (socket->pcb.tcp == NULL) {
  550. mp_raise_OSError(MP_ENOMEM);
  551. }
  552. switch (socket->type) {
  553. case MOD_NETWORK_SOCK_STREAM: {
  554. // Register the socket object as our callback argument.
  555. tcp_arg(socket->pcb.tcp, (void*)socket);
  556. // Register our error callback.
  557. tcp_err(socket->pcb.tcp, _lwip_tcp_error);
  558. break;
  559. }
  560. case MOD_NETWORK_SOCK_DGRAM: {
  561. // Register our receive callback now. Since UDP sockets don't require binding or connection
  562. // before use, there's no other good time to do it.
  563. udp_recv(socket->pcb.udp, _lwip_udp_incoming, (void*)socket);
  564. break;
  565. }
  566. }
  567. socket->incoming.pbuf = NULL;
  568. socket->timeout = -1;
  569. socket->state = STATE_NEW;
  570. socket->recv_offset = 0;
  571. return MP_OBJ_FROM_PTR(socket);
  572. }
  573. STATIC mp_obj_t lwip_socket_bind(mp_obj_t self_in, mp_obj_t addr_in) {
  574. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  575. uint8_t ip[NETUTILS_IPV4ADDR_BUFSIZE];
  576. mp_uint_t port = netutils_parse_inet_addr(addr_in, ip, NETUTILS_BIG);
  577. ip_addr_t bind_addr;
  578. IP4_ADDR(&bind_addr, ip[0], ip[1], ip[2], ip[3]);
  579. err_t err = ERR_ARG;
  580. switch (socket->type) {
  581. case MOD_NETWORK_SOCK_STREAM: {
  582. err = tcp_bind(socket->pcb.tcp, &bind_addr, port);
  583. break;
  584. }
  585. case MOD_NETWORK_SOCK_DGRAM: {
  586. err = udp_bind(socket->pcb.udp, &bind_addr, port);
  587. break;
  588. }
  589. }
  590. if (err != ERR_OK) {
  591. mp_raise_OSError(error_lookup_table[-err]);
  592. }
  593. return mp_const_none;
  594. }
  595. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_bind_obj, lwip_socket_bind);
  596. STATIC mp_obj_t lwip_socket_listen(mp_obj_t self_in, mp_obj_t backlog_in) {
  597. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  598. mp_int_t backlog = mp_obj_get_int(backlog_in);
  599. if (socket->pcb.tcp == NULL) {
  600. mp_raise_OSError(MP_EBADF);
  601. }
  602. if (socket->type != MOD_NETWORK_SOCK_STREAM) {
  603. mp_raise_OSError(MP_EOPNOTSUPP);
  604. }
  605. struct tcp_pcb *new_pcb = tcp_listen_with_backlog(socket->pcb.tcp, (u8_t)backlog);
  606. if (new_pcb == NULL) {
  607. mp_raise_OSError(MP_ENOMEM);
  608. }
  609. socket->pcb.tcp = new_pcb;
  610. tcp_accept(new_pcb, _lwip_tcp_accept);
  611. // Socket is no longer considered "new" for purposes of polling
  612. socket->state = STATE_CONNECTING;
  613. return mp_const_none;
  614. }
  615. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_listen_obj, lwip_socket_listen);
  616. STATIC mp_obj_t lwip_socket_accept(mp_obj_t self_in) {
  617. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  618. if (socket->pcb.tcp == NULL) {
  619. mp_raise_OSError(MP_EBADF);
  620. }
  621. if (socket->type != MOD_NETWORK_SOCK_STREAM) {
  622. mp_raise_OSError(MP_EOPNOTSUPP);
  623. }
  624. // I need to do this because "tcp_accepted", later, is a macro.
  625. struct tcp_pcb *listener = socket->pcb.tcp;
  626. if (listener->state != LISTEN) {
  627. mp_raise_OSError(MP_EINVAL);
  628. }
  629. // accept incoming connection
  630. if (socket->incoming.connection == NULL) {
  631. if (socket->timeout == 0) {
  632. mp_raise_OSError(MP_EAGAIN);
  633. } else if (socket->timeout != -1) {
  634. for (mp_uint_t retries = socket->timeout / 100; retries--;) {
  635. mp_hal_delay_ms(100);
  636. if (socket->incoming.connection != NULL) break;
  637. }
  638. if (socket->incoming.connection == NULL) {
  639. mp_raise_OSError(MP_ETIMEDOUT);
  640. }
  641. } else {
  642. while (socket->incoming.connection == NULL) {
  643. poll_sockets();
  644. }
  645. }
  646. }
  647. // create new socket object
  648. lwip_socket_obj_t *socket2 = m_new_obj_with_finaliser(lwip_socket_obj_t);
  649. socket2->base.type = &lwip_socket_type;
  650. // We get a new pcb handle...
  651. socket2->pcb.tcp = socket->incoming.connection;
  652. socket->incoming.connection = NULL;
  653. // ...and set up the new socket for it.
  654. socket2->domain = MOD_NETWORK_AF_INET;
  655. socket2->type = MOD_NETWORK_SOCK_STREAM;
  656. socket2->incoming.pbuf = NULL;
  657. socket2->timeout = socket->timeout;
  658. socket2->state = STATE_CONNECTED;
  659. socket2->recv_offset = 0;
  660. socket2->callback = MP_OBJ_NULL;
  661. tcp_arg(socket2->pcb.tcp, (void*)socket2);
  662. tcp_err(socket2->pcb.tcp, _lwip_tcp_error);
  663. tcp_recv(socket2->pcb.tcp, _lwip_tcp_recv);
  664. tcp_accepted(listener);
  665. // make the return value
  666. uint8_t ip[NETUTILS_IPV4ADDR_BUFSIZE];
  667. memcpy(ip, &(socket2->pcb.tcp->remote_ip), sizeof(ip));
  668. mp_uint_t port = (mp_uint_t)socket2->pcb.tcp->remote_port;
  669. mp_obj_tuple_t *client = MP_OBJ_TO_PTR(mp_obj_new_tuple(2, NULL));
  670. client->items[0] = MP_OBJ_FROM_PTR(socket2);
  671. client->items[1] = netutils_format_inet_addr(ip, port, NETUTILS_BIG);
  672. return MP_OBJ_FROM_PTR(client);
  673. }
  674. STATIC MP_DEFINE_CONST_FUN_OBJ_1(lwip_socket_accept_obj, lwip_socket_accept);
  675. STATIC mp_obj_t lwip_socket_connect(mp_obj_t self_in, mp_obj_t addr_in) {
  676. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  677. if (socket->pcb.tcp == NULL) {
  678. mp_raise_OSError(MP_EBADF);
  679. }
  680. // get address
  681. uint8_t ip[NETUTILS_IPV4ADDR_BUFSIZE];
  682. mp_uint_t port = netutils_parse_inet_addr(addr_in, ip, NETUTILS_BIG);
  683. ip_addr_t dest;
  684. IP4_ADDR(&dest, ip[0], ip[1], ip[2], ip[3]);
  685. err_t err = ERR_ARG;
  686. switch (socket->type) {
  687. case MOD_NETWORK_SOCK_STREAM: {
  688. if (socket->state != STATE_NEW) {
  689. if (socket->state == STATE_CONNECTED) {
  690. mp_raise_OSError(MP_EISCONN);
  691. } else {
  692. mp_raise_OSError(MP_EALREADY);
  693. }
  694. }
  695. // Register our receive callback.
  696. tcp_recv(socket->pcb.tcp, _lwip_tcp_recv);
  697. socket->state = STATE_CONNECTING;
  698. err = tcp_connect(socket->pcb.tcp, &dest, port, _lwip_tcp_connected);
  699. if (err != ERR_OK) {
  700. socket->state = STATE_NEW;
  701. mp_raise_OSError(error_lookup_table[-err]);
  702. }
  703. socket->peer_port = (mp_uint_t)port;
  704. memcpy(socket->peer, &dest, sizeof(socket->peer));
  705. // And now we wait...
  706. if (socket->timeout != -1) {
  707. for (mp_uint_t retries = socket->timeout / 100; retries--;) {
  708. mp_hal_delay_ms(100);
  709. if (socket->state != STATE_CONNECTING) break;
  710. }
  711. if (socket->state == STATE_CONNECTING) {
  712. mp_raise_OSError(MP_EINPROGRESS);
  713. }
  714. } else {
  715. while (socket->state == STATE_CONNECTING) {
  716. poll_sockets();
  717. }
  718. }
  719. if (socket->state == STATE_CONNECTED) {
  720. err = ERR_OK;
  721. } else {
  722. err = socket->state;
  723. }
  724. break;
  725. }
  726. case MOD_NETWORK_SOCK_DGRAM: {
  727. err = udp_connect(socket->pcb.udp, &dest, port);
  728. break;
  729. }
  730. }
  731. if (err != ERR_OK) {
  732. mp_raise_OSError(error_lookup_table[-err]);
  733. }
  734. return mp_const_none;
  735. }
  736. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_connect_obj, lwip_socket_connect);
  737. STATIC void lwip_socket_check_connected(lwip_socket_obj_t *socket) {
  738. if (socket->pcb.tcp == NULL) {
  739. // not connected
  740. int _errno = error_lookup_table[-socket->state];
  741. socket->state = _ERR_BADF;
  742. mp_raise_OSError(_errno);
  743. }
  744. }
  745. STATIC mp_obj_t lwip_socket_send(mp_obj_t self_in, mp_obj_t buf_in) {
  746. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  747. int _errno;
  748. lwip_socket_check_connected(socket);
  749. mp_buffer_info_t bufinfo;
  750. mp_get_buffer_raise(buf_in, &bufinfo, MP_BUFFER_READ);
  751. mp_uint_t ret = 0;
  752. switch (socket->type) {
  753. case MOD_NETWORK_SOCK_STREAM: {
  754. ret = lwip_tcp_send(socket, bufinfo.buf, bufinfo.len, &_errno);
  755. break;
  756. }
  757. case MOD_NETWORK_SOCK_DGRAM: {
  758. ret = lwip_udp_send(socket, bufinfo.buf, bufinfo.len, NULL, 0, &_errno);
  759. break;
  760. }
  761. }
  762. if (ret == -1) {
  763. mp_raise_OSError(_errno);
  764. }
  765. return mp_obj_new_int_from_uint(ret);
  766. }
  767. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_send_obj, lwip_socket_send);
  768. STATIC mp_obj_t lwip_socket_recv(mp_obj_t self_in, mp_obj_t len_in) {
  769. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  770. int _errno;
  771. lwip_socket_check_connected(socket);
  772. mp_int_t len = mp_obj_get_int(len_in);
  773. vstr_t vstr;
  774. vstr_init_len(&vstr, len);
  775. mp_uint_t ret = 0;
  776. switch (socket->type) {
  777. case MOD_NETWORK_SOCK_STREAM: {
  778. ret = lwip_tcp_receive(socket, (byte*)vstr.buf, len, &_errno);
  779. break;
  780. }
  781. case MOD_NETWORK_SOCK_DGRAM: {
  782. ret = lwip_udp_receive(socket, (byte*)vstr.buf, len, NULL, NULL, &_errno);
  783. break;
  784. }
  785. }
  786. if (ret == -1) {
  787. mp_raise_OSError(_errno);
  788. }
  789. if (ret == 0) {
  790. return mp_const_empty_bytes;
  791. }
  792. vstr.len = ret;
  793. return mp_obj_new_str_from_vstr(&mp_type_bytes, &vstr);
  794. }
  795. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_recv_obj, lwip_socket_recv);
  796. STATIC mp_obj_t lwip_socket_sendto(mp_obj_t self_in, mp_obj_t data_in, mp_obj_t addr_in) {
  797. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  798. int _errno;
  799. lwip_socket_check_connected(socket);
  800. mp_buffer_info_t bufinfo;
  801. mp_get_buffer_raise(data_in, &bufinfo, MP_BUFFER_READ);
  802. uint8_t ip[NETUTILS_IPV4ADDR_BUFSIZE];
  803. mp_uint_t port = netutils_parse_inet_addr(addr_in, ip, NETUTILS_BIG);
  804. mp_uint_t ret = 0;
  805. switch (socket->type) {
  806. case MOD_NETWORK_SOCK_STREAM: {
  807. ret = lwip_tcp_send(socket, bufinfo.buf, bufinfo.len, &_errno);
  808. break;
  809. }
  810. case MOD_NETWORK_SOCK_DGRAM: {
  811. ret = lwip_udp_send(socket, bufinfo.buf, bufinfo.len, ip, port, &_errno);
  812. break;
  813. }
  814. }
  815. if (ret == -1) {
  816. mp_raise_OSError(_errno);
  817. }
  818. return mp_obj_new_int_from_uint(ret);
  819. }
  820. STATIC MP_DEFINE_CONST_FUN_OBJ_3(lwip_socket_sendto_obj, lwip_socket_sendto);
  821. STATIC mp_obj_t lwip_socket_recvfrom(mp_obj_t self_in, mp_obj_t len_in) {
  822. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  823. int _errno;
  824. lwip_socket_check_connected(socket);
  825. mp_int_t len = mp_obj_get_int(len_in);
  826. vstr_t vstr;
  827. vstr_init_len(&vstr, len);
  828. byte ip[4];
  829. mp_uint_t port;
  830. mp_uint_t ret = 0;
  831. switch (socket->type) {
  832. case MOD_NETWORK_SOCK_STREAM: {
  833. memcpy(ip, &socket->peer, sizeof(socket->peer));
  834. port = (mp_uint_t) socket->peer_port;
  835. ret = lwip_tcp_receive(socket, (byte*)vstr.buf, len, &_errno);
  836. break;
  837. }
  838. case MOD_NETWORK_SOCK_DGRAM: {
  839. ret = lwip_udp_receive(socket, (byte*)vstr.buf, len, ip, &port, &_errno);
  840. break;
  841. }
  842. }
  843. if (ret == -1) {
  844. mp_raise_OSError(_errno);
  845. }
  846. mp_obj_t tuple[2];
  847. if (ret == 0) {
  848. tuple[0] = mp_const_empty_bytes;
  849. } else {
  850. vstr.len = ret;
  851. tuple[0] = mp_obj_new_str_from_vstr(&mp_type_bytes, &vstr);
  852. }
  853. tuple[1] = netutils_format_inet_addr(ip, port, NETUTILS_BIG);
  854. return mp_obj_new_tuple(2, tuple);
  855. }
  856. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_recvfrom_obj, lwip_socket_recvfrom);
  857. STATIC mp_obj_t lwip_socket_sendall(mp_obj_t self_in, mp_obj_t buf_in) {
  858. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  859. lwip_socket_check_connected(socket);
  860. int _errno;
  861. mp_buffer_info_t bufinfo;
  862. mp_get_buffer_raise(buf_in, &bufinfo, MP_BUFFER_READ);
  863. mp_uint_t ret = 0;
  864. switch (socket->type) {
  865. case MOD_NETWORK_SOCK_STREAM: {
  866. if (socket->timeout == 0) {
  867. // Behavior of sendall() for non-blocking sockets isn't explicitly specified.
  868. // But it's specified that "On error, an exception is raised, there is no
  869. // way to determine how much data, if any, was successfully sent." Then, the
  870. // most useful behavior is: check whether we will be able to send all of input
  871. // data without EAGAIN, and if won't be, raise it without sending any.
  872. if (bufinfo.len > tcp_sndbuf(socket->pcb.tcp)) {
  873. mp_raise_OSError(MP_EAGAIN);
  874. }
  875. }
  876. // TODO: In CPython3.5, socket timeout should apply to the
  877. // entire sendall() operation, not to individual send() chunks.
  878. while (bufinfo.len != 0) {
  879. ret = lwip_tcp_send(socket, bufinfo.buf, bufinfo.len, &_errno);
  880. if (ret == -1) {
  881. mp_raise_OSError(_errno);
  882. }
  883. bufinfo.len -= ret;
  884. bufinfo.buf = (char*)bufinfo.buf + ret;
  885. }
  886. break;
  887. }
  888. case MOD_NETWORK_SOCK_DGRAM:
  889. mp_raise_NotImplementedError(NULL);
  890. break;
  891. }
  892. return mp_const_none;
  893. }
  894. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_sendall_obj, lwip_socket_sendall);
  895. STATIC mp_obj_t lwip_socket_settimeout(mp_obj_t self_in, mp_obj_t timeout_in) {
  896. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  897. mp_uint_t timeout;
  898. if (timeout_in == mp_const_none) {
  899. timeout = -1;
  900. } else {
  901. #if MICROPY_PY_BUILTINS_FLOAT
  902. timeout = 1000 * mp_obj_get_float(timeout_in);
  903. #else
  904. timeout = 1000 * mp_obj_get_int(timeout_in);
  905. #endif
  906. }
  907. socket->timeout = timeout;
  908. return mp_const_none;
  909. }
  910. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_settimeout_obj, lwip_socket_settimeout);
  911. STATIC mp_obj_t lwip_socket_setblocking(mp_obj_t self_in, mp_obj_t flag_in) {
  912. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  913. bool val = mp_obj_is_true(flag_in);
  914. if (val) {
  915. socket->timeout = -1;
  916. } else {
  917. socket->timeout = 0;
  918. }
  919. return mp_const_none;
  920. }
  921. STATIC MP_DEFINE_CONST_FUN_OBJ_2(lwip_socket_setblocking_obj, lwip_socket_setblocking);
  922. STATIC mp_obj_t lwip_socket_setsockopt(size_t n_args, const mp_obj_t *args) {
  923. (void)n_args; // always 4
  924. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(args[0]);
  925. int opt = mp_obj_get_int(args[2]);
  926. if (opt == 20) {
  927. if (args[3] == mp_const_none) {
  928. socket->callback = MP_OBJ_NULL;
  929. } else {
  930. socket->callback = args[3];
  931. }
  932. return mp_const_none;
  933. }
  934. switch (opt) {
  935. // level: SOL_SOCKET
  936. case SOF_REUSEADDR: {
  937. mp_int_t val = mp_obj_get_int(args[3]);
  938. // Options are common for UDP and TCP pcb's.
  939. if (val) {
  940. ip_set_option(socket->pcb.tcp, SOF_REUSEADDR);
  941. } else {
  942. ip_reset_option(socket->pcb.tcp, SOF_REUSEADDR);
  943. }
  944. break;
  945. }
  946. // level: IPPROTO_IP
  947. case IP_ADD_MEMBERSHIP: {
  948. mp_buffer_info_t bufinfo;
  949. mp_get_buffer_raise(args[3], &bufinfo, MP_BUFFER_READ);
  950. if (bufinfo.len != sizeof(ip_addr_t) * 2) {
  951. mp_raise_ValueError(NULL);
  952. }
  953. // POSIX setsockopt has order: group addr, if addr, lwIP has it vice-versa
  954. err_t err = igmp_joingroup((ip_addr_t*)bufinfo.buf + 1, bufinfo.buf);
  955. if (err != ERR_OK) {
  956. mp_raise_OSError(error_lookup_table[-err]);
  957. }
  958. break;
  959. }
  960. default:
  961. printf("Warning: lwip.setsockopt() not implemented\n");
  962. }
  963. return mp_const_none;
  964. }
  965. STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(lwip_socket_setsockopt_obj, 4, 4, lwip_socket_setsockopt);
  966. STATIC mp_obj_t lwip_socket_makefile(size_t n_args, const mp_obj_t *args) {
  967. (void)n_args;
  968. return args[0];
  969. }
  970. STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(lwip_socket_makefile_obj, 1, 3, lwip_socket_makefile);
  971. STATIC mp_uint_t lwip_socket_read(mp_obj_t self_in, void *buf, mp_uint_t size, int *errcode) {
  972. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  973. switch (socket->type) {
  974. case MOD_NETWORK_SOCK_STREAM:
  975. return lwip_tcp_receive(socket, buf, size, errcode);
  976. case MOD_NETWORK_SOCK_DGRAM:
  977. return lwip_udp_receive(socket, buf, size, NULL, NULL, errcode);
  978. }
  979. // Unreachable
  980. return MP_STREAM_ERROR;
  981. }
  982. STATIC mp_uint_t lwip_socket_write(mp_obj_t self_in, const void *buf, mp_uint_t size, int *errcode) {
  983. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  984. switch (socket->type) {
  985. case MOD_NETWORK_SOCK_STREAM:
  986. return lwip_tcp_send(socket, buf, size, errcode);
  987. case MOD_NETWORK_SOCK_DGRAM:
  988. return lwip_udp_send(socket, buf, size, NULL, 0, errcode);
  989. }
  990. // Unreachable
  991. return MP_STREAM_ERROR;
  992. }
  993. STATIC mp_uint_t lwip_socket_ioctl(mp_obj_t self_in, mp_uint_t request, uintptr_t arg, int *errcode) {
  994. lwip_socket_obj_t *socket = MP_OBJ_TO_PTR(self_in);
  995. mp_uint_t ret;
  996. if (request == MP_STREAM_POLL) {
  997. uintptr_t flags = arg;
  998. ret = 0;
  999. if (flags & MP_STREAM_POLL_RD && socket->incoming.pbuf != NULL) {
  1000. ret |= MP_STREAM_POLL_RD;
  1001. }
  1002. // Note: pcb.tcp==NULL if state<0, and in this case we can't call tcp_sndbuf
  1003. if (flags & MP_STREAM_POLL_WR && socket->pcb.tcp != NULL && tcp_sndbuf(socket->pcb.tcp) > 0) {
  1004. ret |= MP_STREAM_POLL_WR;
  1005. }
  1006. if (socket->state == STATE_NEW) {
  1007. // New sockets are not connected so set HUP
  1008. ret |= flags & MP_STREAM_POLL_HUP;
  1009. } else if (socket->state == STATE_PEER_CLOSED) {
  1010. // Peer-closed socket is both readable and writable: read will
  1011. // return EOF, write - error. Without this poll will hang on a
  1012. // socket which was closed by peer.
  1013. ret |= flags & (MP_STREAM_POLL_RD | MP_STREAM_POLL_WR);
  1014. } else if (socket->state == ERR_RST) {
  1015. // Socket was reset by peer, a write will return an error
  1016. ret |= flags & (MP_STREAM_POLL_WR | MP_STREAM_POLL_HUP);
  1017. } else if (socket->state < 0) {
  1018. // Socket in some other error state, use catch-all ERR flag
  1019. // TODO: may need to set other return flags here
  1020. ret |= flags & MP_STREAM_POLL_ERR;
  1021. }
  1022. } else if (request == MP_STREAM_CLOSE) {
  1023. bool socket_is_listener = false;
  1024. if (socket->pcb.tcp == NULL) {
  1025. return 0;
  1026. }
  1027. // Deregister callback (pcb.tcp is set to NULL below so must deregister now)
  1028. tcp_recv(socket->pcb.tcp, NULL);
  1029. switch (socket->type) {
  1030. case MOD_NETWORK_SOCK_STREAM: {
  1031. if (socket->pcb.tcp->state == LISTEN) {
  1032. socket_is_listener = true;
  1033. }
  1034. if (tcp_close(socket->pcb.tcp) != ERR_OK) {
  1035. DEBUG_printf("lwip_close: had to call tcp_abort()\n");
  1036. tcp_abort(socket->pcb.tcp);
  1037. }
  1038. break;
  1039. }
  1040. case MOD_NETWORK_SOCK_DGRAM: udp_remove(socket->pcb.udp); break;
  1041. //case MOD_NETWORK_SOCK_RAW: raw_remove(socket->pcb.raw); break;
  1042. }
  1043. socket->pcb.tcp = NULL;
  1044. socket->state = _ERR_BADF;
  1045. if (socket->incoming.pbuf != NULL) {
  1046. if (!socket_is_listener) {
  1047. pbuf_free(socket->incoming.pbuf);
  1048. } else {
  1049. // Deregister callback and abort
  1050. tcp_poll(socket->incoming.connection, NULL, 0);
  1051. tcp_abort(socket->incoming.connection);
  1052. }
  1053. socket->incoming.pbuf = NULL;
  1054. }
  1055. ret = 0;
  1056. } else {
  1057. *errcode = MP_EINVAL;
  1058. ret = MP_STREAM_ERROR;
  1059. }
  1060. return ret;
  1061. }
  1062. STATIC const mp_rom_map_elem_t lwip_socket_locals_dict_table[] = {
  1063. { MP_ROM_QSTR(MP_QSTR___del__), MP_ROM_PTR(&mp_stream_close_obj) },
  1064. { MP_ROM_QSTR(MP_QSTR_close), MP_ROM_PTR(&mp_stream_close_obj) },
  1065. { MP_ROM_QSTR(MP_QSTR_bind), MP_ROM_PTR(&lwip_socket_bind_obj) },
  1066. { MP_ROM_QSTR(MP_QSTR_listen), MP_ROM_PTR(&lwip_socket_listen_obj) },
  1067. { MP_ROM_QSTR(MP_QSTR_accept), MP_ROM_PTR(&lwip_socket_accept_obj) },
  1068. { MP_ROM_QSTR(MP_QSTR_connect), MP_ROM_PTR(&lwip_socket_connect_obj) },
  1069. { MP_ROM_QSTR(MP_QSTR_send), MP_ROM_PTR(&lwip_socket_send_obj) },
  1070. { MP_ROM_QSTR(MP_QSTR_recv), MP_ROM_PTR(&lwip_socket_recv_obj) },
  1071. { MP_ROM_QSTR(MP_QSTR_sendto), MP_ROM_PTR(&lwip_socket_sendto_obj) },
  1072. { MP_ROM_QSTR(MP_QSTR_recvfrom), MP_ROM_PTR(&lwip_socket_recvfrom_obj) },
  1073. { MP_ROM_QSTR(MP_QSTR_sendall), MP_ROM_PTR(&lwip_socket_sendall_obj) },
  1074. { MP_ROM_QSTR(MP_QSTR_settimeout), MP_ROM_PTR(&lwip_socket_settimeout_obj) },
  1075. { MP_ROM_QSTR(MP_QSTR_setblocking), MP_ROM_PTR(&lwip_socket_setblocking_obj) },
  1076. { MP_ROM_QSTR(MP_QSTR_setsockopt), MP_ROM_PTR(&lwip_socket_setsockopt_obj) },
  1077. { MP_ROM_QSTR(MP_QSTR_makefile), MP_ROM_PTR(&lwip_socket_makefile_obj) },
  1078. { MP_ROM_QSTR(MP_QSTR_read), MP_ROM_PTR(&mp_stream_read_obj) },
  1079. { MP_ROM_QSTR(MP_QSTR_readinto), MP_ROM_PTR(&mp_stream_readinto_obj) },
  1080. { MP_ROM_QSTR(MP_QSTR_readline), MP_ROM_PTR(&mp_stream_unbuffered_readline_obj) },
  1081. { MP_ROM_QSTR(MP_QSTR_write), MP_ROM_PTR(&mp_stream_write_obj) },
  1082. };
  1083. STATIC MP_DEFINE_CONST_DICT(lwip_socket_locals_dict, lwip_socket_locals_dict_table);
  1084. STATIC const mp_stream_p_t lwip_socket_stream_p = {
  1085. .read = lwip_socket_read,
  1086. .write = lwip_socket_write,
  1087. .ioctl = lwip_socket_ioctl,
  1088. };
  1089. STATIC const mp_obj_type_t lwip_socket_type = {
  1090. { &mp_type_type },
  1091. .name = MP_QSTR_socket,
  1092. .print = lwip_socket_print,
  1093. .make_new = lwip_socket_make_new,
  1094. .protocol = &lwip_socket_stream_p,
  1095. .locals_dict = (mp_obj_dict_t*)&lwip_socket_locals_dict,
  1096. };
  1097. /******************************************************************************/
  1098. // Support functions for memory protection. lwIP has its own memory management
  1099. // routines for its internal structures, and since they might be called in
  1100. // interrupt handlers, they need some protection.
  1101. sys_prot_t sys_arch_protect() {
  1102. return (sys_prot_t)MICROPY_BEGIN_ATOMIC_SECTION();
  1103. }
  1104. void sys_arch_unprotect(sys_prot_t state) {
  1105. MICROPY_END_ATOMIC_SECTION((mp_uint_t)state);
  1106. }
  1107. /******************************************************************************/
  1108. // Polling callbacks for the interfaces connected to lwIP. Right now it calls
  1109. // itself a "list" but isn't; we only support a single interface.
  1110. typedef struct nic_poll {
  1111. void (* poll)(void *arg);
  1112. void *poll_arg;
  1113. } nic_poll_t;
  1114. STATIC nic_poll_t lwip_poll_list;
  1115. void mod_lwip_register_poll(void (* poll)(void *arg), void *poll_arg) {
  1116. lwip_poll_list.poll = poll;
  1117. lwip_poll_list.poll_arg = poll_arg;
  1118. }
  1119. void mod_lwip_deregister_poll(void (* poll)(void *arg), void *poll_arg) {
  1120. lwip_poll_list.poll = NULL;
  1121. }
  1122. /******************************************************************************/
  1123. // The lwip global functions.
  1124. STATIC mp_obj_t mod_lwip_reset() {
  1125. lwip_init();
  1126. lwip_poll_list.poll = NULL;
  1127. return mp_const_none;
  1128. }
  1129. MP_DEFINE_CONST_FUN_OBJ_0(mod_lwip_reset_obj, mod_lwip_reset);
  1130. STATIC mp_obj_t mod_lwip_callback() {
  1131. if (lwip_poll_list.poll != NULL) {
  1132. lwip_poll_list.poll(lwip_poll_list.poll_arg);
  1133. }
  1134. sys_check_timeouts();
  1135. return mp_const_none;
  1136. }
  1137. MP_DEFINE_CONST_FUN_OBJ_0(mod_lwip_callback_obj, mod_lwip_callback);
  1138. typedef struct _getaddrinfo_state_t {
  1139. volatile int status;
  1140. volatile ip_addr_t ipaddr;
  1141. } getaddrinfo_state_t;
  1142. // Callback for incoming DNS requests.
  1143. #if LWIP_VERSION_MAJOR < 2
  1144. STATIC void lwip_getaddrinfo_cb(const char *name, ip_addr_t *ipaddr, void *arg)
  1145. #else
  1146. STATIC void lwip_getaddrinfo_cb(const char *name, const ip_addr_t *ipaddr, void *arg)
  1147. #endif
  1148. {
  1149. getaddrinfo_state_t *state = arg;
  1150. if (ipaddr != NULL) {
  1151. state->status = 1;
  1152. state->ipaddr = *ipaddr;
  1153. } else {
  1154. // error
  1155. state->status = -2;
  1156. }
  1157. }
  1158. // lwip.getaddrinfo
  1159. STATIC mp_obj_t lwip_getaddrinfo(size_t n_args, const mp_obj_t *args) {
  1160. mp_obj_t host_in = args[0], port_in = args[1];
  1161. const char *host = mp_obj_str_get_str(host_in);
  1162. mp_int_t port = mp_obj_get_int(port_in);
  1163. // If constraints were passed then check they are compatible with the supported params
  1164. if (n_args > 2) {
  1165. mp_int_t family = mp_obj_get_int(args[2]);
  1166. mp_int_t type = 0;
  1167. mp_int_t proto = 0;
  1168. mp_int_t flags = 0;
  1169. if (n_args > 3) {
  1170. type = mp_obj_get_int(args[3]);
  1171. if (n_args > 4) {
  1172. proto = mp_obj_get_int(args[4]);
  1173. if (n_args > 5) {
  1174. flags = mp_obj_get_int(args[5]);
  1175. }
  1176. }
  1177. }
  1178. if (!((family == 0 || family == MOD_NETWORK_AF_INET)
  1179. && (type == 0 || type == MOD_NETWORK_SOCK_STREAM)
  1180. && proto == 0
  1181. && flags == 0)) {
  1182. mp_warning("unsupported getaddrinfo constraints");
  1183. }
  1184. }
  1185. getaddrinfo_state_t state;
  1186. state.status = 0;
  1187. err_t ret = dns_gethostbyname(host, (ip_addr_t*)&state.ipaddr, lwip_getaddrinfo_cb, &state);
  1188. switch (ret) {
  1189. case ERR_OK:
  1190. // cached
  1191. state.status = 1;
  1192. break;
  1193. case ERR_INPROGRESS:
  1194. while (state.status == 0) {
  1195. poll_sockets();
  1196. }
  1197. break;
  1198. default:
  1199. state.status = ret;
  1200. }
  1201. if (state.status < 0) {
  1202. // TODO: CPython raises gaierror, we raise with native lwIP negative error
  1203. // values, to differentiate from normal errno's at least in such way.
  1204. mp_raise_OSError(state.status);
  1205. }
  1206. mp_obj_tuple_t *tuple = MP_OBJ_TO_PTR(mp_obj_new_tuple(5, NULL));
  1207. tuple->items[0] = MP_OBJ_NEW_SMALL_INT(MOD_NETWORK_AF_INET);
  1208. tuple->items[1] = MP_OBJ_NEW_SMALL_INT(MOD_NETWORK_SOCK_STREAM);
  1209. tuple->items[2] = MP_OBJ_NEW_SMALL_INT(0);
  1210. tuple->items[3] = MP_OBJ_NEW_QSTR(MP_QSTR_);
  1211. tuple->items[4] = netutils_format_inet_addr((uint8_t*)&state.ipaddr, port, NETUTILS_BIG);
  1212. return mp_obj_new_list(1, (mp_obj_t*)&tuple);
  1213. }
  1214. MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(lwip_getaddrinfo_obj, 2, 6, lwip_getaddrinfo);
  1215. // Debug functions
  1216. STATIC mp_obj_t lwip_print_pcbs() {
  1217. tcp_debug_print_pcbs();
  1218. return mp_const_none;
  1219. }
  1220. MP_DEFINE_CONST_FUN_OBJ_0(lwip_print_pcbs_obj, lwip_print_pcbs);
  1221. #ifdef MICROPY_PY_LWIP
  1222. STATIC const mp_rom_map_elem_t mp_module_lwip_globals_table[] = {
  1223. { MP_ROM_QSTR(MP_QSTR___name__), MP_ROM_QSTR(MP_QSTR_lwip) },
  1224. { MP_ROM_QSTR(MP_QSTR_reset), MP_ROM_PTR(&mod_lwip_reset_obj) },
  1225. { MP_ROM_QSTR(MP_QSTR_callback), MP_ROM_PTR(&mod_lwip_callback_obj) },
  1226. { MP_ROM_QSTR(MP_QSTR_getaddrinfo), MP_ROM_PTR(&lwip_getaddrinfo_obj) },
  1227. { MP_ROM_QSTR(MP_QSTR_print_pcbs), MP_ROM_PTR(&lwip_print_pcbs_obj) },
  1228. // objects
  1229. { MP_ROM_QSTR(MP_QSTR_socket), MP_ROM_PTR(&lwip_socket_type) },
  1230. #ifdef MICROPY_PY_LWIP_SLIP
  1231. { MP_ROM_QSTR(MP_QSTR_slip), MP_ROM_PTR(&lwip_slip_type) },
  1232. #endif
  1233. // class constants
  1234. { MP_ROM_QSTR(MP_QSTR_AF_INET), MP_ROM_INT(MOD_NETWORK_AF_INET) },
  1235. { MP_ROM_QSTR(MP_QSTR_AF_INET6), MP_ROM_INT(MOD_NETWORK_AF_INET6) },
  1236. { MP_ROM_QSTR(MP_QSTR_SOCK_STREAM), MP_ROM_INT(MOD_NETWORK_SOCK_STREAM) },
  1237. { MP_ROM_QSTR(MP_QSTR_SOCK_DGRAM), MP_ROM_INT(MOD_NETWORK_SOCK_DGRAM) },
  1238. { MP_ROM_QSTR(MP_QSTR_SOCK_RAW), MP_ROM_INT(MOD_NETWORK_SOCK_RAW) },
  1239. { MP_ROM_QSTR(MP_QSTR_SOL_SOCKET), MP_ROM_INT(1) },
  1240. { MP_ROM_QSTR(MP_QSTR_SO_REUSEADDR), MP_ROM_INT(SOF_REUSEADDR) },
  1241. { MP_ROM_QSTR(MP_QSTR_IPPROTO_IP), MP_ROM_INT(0) },
  1242. { MP_ROM_QSTR(MP_QSTR_IP_ADD_MEMBERSHIP), MP_ROM_INT(IP_ADD_MEMBERSHIP) },
  1243. };
  1244. STATIC MP_DEFINE_CONST_DICT(mp_module_lwip_globals, mp_module_lwip_globals_table);
  1245. const mp_obj_module_t mp_module_lwip = {
  1246. .base = { &mp_type_module },
  1247. .globals = (mp_obj_dict_t*)&mp_module_lwip_globals,
  1248. };
  1249. #endif // MICROPY_PY_LWIP