modsocket.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708
  1. /*
  2. * This file is part of the MicroPython project, http://micropython.org/
  3. *
  4. * Development of the code in this file was sponsored by Microbric Pty Ltd
  5. * and Mnemote Pty Ltd
  6. *
  7. * The MIT License (MIT)
  8. *
  9. * Copyright (c) 2016, 2017 Nick Moore @mnemote
  10. *
  11. * Based on extmod/modlwip.c
  12. * Copyright (c) 2013, 2014 Damien P. George
  13. * Copyright (c) 2015 Galen Hazelwood
  14. *
  15. * Permission is hereby granted, free of charge, to any person obtaining a copy
  16. * of this software and associated documentation files (the "Software"), to deal
  17. * in the Software without restriction, including without limitation the rights
  18. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  19. * copies of the Software, and to permit persons to whom the Software is
  20. * furnished to do so, subject to the following conditions:
  21. *
  22. * The above copyright notice and this permission notice shall be included in
  23. * all copies or substantial portions of the Software.
  24. *
  25. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  26. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  27. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  28. * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  29. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  30. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  31. * THE SOFTWARE.
  32. */
  33. #include <stdio.h>
  34. #include <stdint.h>
  35. #include <stdlib.h>
  36. #include <string.h>
  37. #include "py/runtime0.h"
  38. #include "py/nlr.h"
  39. #include "py/objlist.h"
  40. #include "py/objstr.h"
  41. #include "py/runtime.h"
  42. #include "py/mperrno.h"
  43. #include "py/mphal.h"
  44. #include "py/stream.h"
  45. #include "py/mperrno.h"
  46. #include "lib/netutils/netutils.h"
  47. #include "tcpip_adapter.h"
  48. #include "modnetwork.h"
  49. #include "lwip/sockets.h"
  50. #include "lwip/netdb.h"
  51. #include "lwip/ip4.h"
  52. #include "lwip/igmp.h"
  53. #include "esp_log.h"
  54. #define SOCKET_POLL_US (100000)
  55. typedef struct _socket_obj_t {
  56. mp_obj_base_t base;
  57. int fd;
  58. uint8_t domain;
  59. uint8_t type;
  60. uint8_t proto;
  61. bool peer_closed;
  62. unsigned int retries;
  63. #if MICROPY_PY_USOCKET_EVENTS
  64. mp_obj_t events_callback;
  65. struct _socket_obj_t *events_next;
  66. #endif
  67. } socket_obj_t;
  68. void _socket_settimeout(socket_obj_t *sock, uint64_t timeout_ms);
  69. #if MICROPY_PY_USOCKET_EVENTS
  70. // Support for callbacks on asynchronous socket events (when socket becomes readable)
  71. // This divisor is used to reduce the load on the system, so it doesn't poll sockets too often
  72. #define USOCKET_EVENTS_DIVISOR (8)
  73. STATIC uint8_t usocket_events_divisor;
  74. STATIC socket_obj_t *usocket_events_head;
  75. void usocket_events_deinit(void) {
  76. usocket_events_head = NULL;
  77. }
  78. // Assumes the socket is not already in the linked list, and adds it
  79. STATIC void usocket_events_add(socket_obj_t *sock) {
  80. sock->events_next = usocket_events_head;
  81. usocket_events_head = sock;
  82. }
  83. // Assumes the socket is already in the linked list, and removes it
  84. STATIC void usocket_events_remove(socket_obj_t *sock) {
  85. for (socket_obj_t **s = &usocket_events_head;; s = &(*s)->events_next) {
  86. if (*s == sock) {
  87. *s = (*s)->events_next;
  88. return;
  89. }
  90. }
  91. }
  92. // Polls all registered sockets for readability and calls their callback if they are readable
  93. void usocket_events_handler(void) {
  94. if (usocket_events_head == NULL) {
  95. return;
  96. }
  97. if (--usocket_events_divisor) {
  98. return;
  99. }
  100. usocket_events_divisor = USOCKET_EVENTS_DIVISOR;
  101. fd_set rfds;
  102. FD_ZERO(&rfds);
  103. int max_fd = 0;
  104. for (socket_obj_t *s = usocket_events_head; s != NULL; s = s->events_next) {
  105. FD_SET(s->fd, &rfds);
  106. max_fd = MAX(max_fd, s->fd);
  107. }
  108. // Poll the sockets
  109. struct timeval timeout = { .tv_sec = 0, .tv_usec = 0 };
  110. int r = select(max_fd + 1, &rfds, NULL, NULL, &timeout);
  111. if (r <= 0) {
  112. return;
  113. }
  114. // Call the callbacks
  115. for (socket_obj_t *s = usocket_events_head; s != NULL; s = s->events_next) {
  116. if (FD_ISSET(s->fd, &rfds)) {
  117. mp_call_function_1_protected(s->events_callback, s);
  118. }
  119. }
  120. }
  121. #endif // MICROPY_PY_USOCKET_EVENTS
  122. NORETURN static void exception_from_errno(int _errno) {
  123. // Here we need to convert from lwip errno values to MicroPython's standard ones
  124. if (_errno == EINPROGRESS) {
  125. _errno = MP_EINPROGRESS;
  126. }
  127. mp_raise_OSError(_errno);
  128. }
  129. static inline void check_for_exceptions(void) {
  130. mp_handle_pending();
  131. }
  132. static int _socket_getaddrinfo2(const mp_obj_t host, const mp_obj_t portx, struct addrinfo **resp) {
  133. const struct addrinfo hints = {
  134. .ai_family = AF_INET,
  135. .ai_socktype = SOCK_STREAM,
  136. };
  137. mp_obj_t port = portx;
  138. if (MP_OBJ_IS_SMALL_INT(port)) {
  139. // This is perverse, because lwip_getaddrinfo promptly converts it back to an int, but
  140. // that's the API we have to work with ...
  141. port = mp_obj_str_binary_op(MP_BINARY_OP_MODULO, mp_obj_new_str_via_qstr("%s", 2), port);
  142. }
  143. const char *host_str = mp_obj_str_get_str(host);
  144. const char *port_str = mp_obj_str_get_str(port);
  145. if (host_str[0] == '\0') {
  146. // a host of "" is equivalent to the default/all-local IP address
  147. host_str = "0.0.0.0";
  148. }
  149. MP_THREAD_GIL_EXIT();
  150. int res = lwip_getaddrinfo(host_str, port_str, &hints, resp);
  151. MP_THREAD_GIL_ENTER();
  152. return res;
  153. }
  154. int _socket_getaddrinfo(const mp_obj_t addrtuple, struct addrinfo **resp) {
  155. mp_uint_t len = 0;
  156. mp_obj_t *elem;
  157. mp_obj_get_array(addrtuple, &len, &elem);
  158. if (len != 2) return -1;
  159. return _socket_getaddrinfo2(elem[0], elem[1], resp);
  160. }
  161. STATIC mp_obj_t socket_bind(const mp_obj_t arg0, const mp_obj_t arg1) {
  162. socket_obj_t *self = MP_OBJ_TO_PTR(arg0);
  163. struct addrinfo *res;
  164. _socket_getaddrinfo(arg1, &res);
  165. int r = lwip_bind_r(self->fd, res->ai_addr, res->ai_addrlen);
  166. lwip_freeaddrinfo(res);
  167. if (r < 0) exception_from_errno(errno);
  168. return mp_const_none;
  169. }
  170. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_bind_obj, socket_bind);
  171. STATIC mp_obj_t socket_listen(const mp_obj_t arg0, const mp_obj_t arg1) {
  172. socket_obj_t *self = MP_OBJ_TO_PTR(arg0);
  173. int backlog = mp_obj_get_int(arg1);
  174. int r = lwip_listen_r(self->fd, backlog);
  175. if (r < 0) exception_from_errno(errno);
  176. return mp_const_none;
  177. }
  178. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_listen_obj, socket_listen);
  179. STATIC mp_obj_t socket_accept(const mp_obj_t arg0) {
  180. socket_obj_t *self = MP_OBJ_TO_PTR(arg0);
  181. struct sockaddr addr;
  182. socklen_t addr_len = sizeof(addr);
  183. int new_fd = -1;
  184. for (int i=0; i<=self->retries; i++) {
  185. MP_THREAD_GIL_EXIT();
  186. new_fd = lwip_accept_r(self->fd, &addr, &addr_len);
  187. MP_THREAD_GIL_ENTER();
  188. if (new_fd >= 0) break;
  189. if (errno != EAGAIN) exception_from_errno(errno);
  190. check_for_exceptions();
  191. }
  192. if (new_fd < 0) mp_raise_OSError(MP_ETIMEDOUT);
  193. // create new socket object
  194. socket_obj_t *sock = m_new_obj_with_finaliser(socket_obj_t);
  195. sock->base.type = self->base.type;
  196. sock->fd = new_fd;
  197. sock->domain = self->domain;
  198. sock->type = self->type;
  199. sock->proto = self->proto;
  200. sock->peer_closed = false;
  201. _socket_settimeout(sock, UINT64_MAX);
  202. // make the return value
  203. uint8_t *ip = (uint8_t*)&((struct sockaddr_in*)&addr)->sin_addr;
  204. mp_uint_t port = lwip_ntohs(((struct sockaddr_in*)&addr)->sin_port);
  205. mp_obj_tuple_t *client = mp_obj_new_tuple(2, NULL);
  206. client->items[0] = sock;
  207. client->items[1] = netutils_format_inet_addr(ip, port, NETUTILS_BIG);
  208. return client;
  209. }
  210. STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_accept_obj, socket_accept);
  211. STATIC mp_obj_t socket_connect(const mp_obj_t arg0, const mp_obj_t arg1) {
  212. socket_obj_t *self = MP_OBJ_TO_PTR(arg0);
  213. struct addrinfo *res;
  214. _socket_getaddrinfo(arg1, &res);
  215. MP_THREAD_GIL_EXIT();
  216. int r = lwip_connect_r(self->fd, res->ai_addr, res->ai_addrlen);
  217. MP_THREAD_GIL_ENTER();
  218. lwip_freeaddrinfo(res);
  219. if (r != 0) {
  220. exception_from_errno(errno);
  221. }
  222. return mp_const_none;
  223. }
  224. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_connect_obj, socket_connect);
  225. STATIC mp_obj_t socket_setsockopt(size_t n_args, const mp_obj_t *args) {
  226. (void)n_args; // always 4
  227. socket_obj_t *self = MP_OBJ_TO_PTR(args[0]);
  228. int opt = mp_obj_get_int(args[2]);
  229. switch (opt) {
  230. // level: SOL_SOCKET
  231. case SO_REUSEADDR: {
  232. int val = mp_obj_get_int(args[3]);
  233. int ret = lwip_setsockopt_r(self->fd, SOL_SOCKET, opt, &val, sizeof(int));
  234. if (ret != 0) {
  235. exception_from_errno(errno);
  236. }
  237. break;
  238. }
  239. #if MICROPY_PY_USOCKET_EVENTS
  240. // level: SOL_SOCKET
  241. // special "register callback" option
  242. case 20: {
  243. if (args[3] == mp_const_none) {
  244. if (self->events_callback != MP_OBJ_NULL) {
  245. usocket_events_remove(self);
  246. self->events_callback = MP_OBJ_NULL;
  247. }
  248. } else {
  249. if (self->events_callback == MP_OBJ_NULL) {
  250. usocket_events_add(self);
  251. }
  252. self->events_callback = args[3];
  253. }
  254. break;
  255. }
  256. #endif
  257. // level: IPPROTO_IP
  258. case IP_ADD_MEMBERSHIP: {
  259. mp_buffer_info_t bufinfo;
  260. mp_get_buffer_raise(args[3], &bufinfo, MP_BUFFER_READ);
  261. if (bufinfo.len != sizeof(ip4_addr_t) * 2) {
  262. mp_raise_ValueError(NULL);
  263. }
  264. // POSIX setsockopt has order: group addr, if addr, lwIP has it vice-versa
  265. err_t err = igmp_joingroup((const ip4_addr_t*)bufinfo.buf + 1, bufinfo.buf);
  266. if (err != ERR_OK) {
  267. mp_raise_OSError(-err);
  268. }
  269. break;
  270. }
  271. default:
  272. mp_printf(&mp_plat_print, "Warning: lwip.setsockopt() option not implemented\n");
  273. }
  274. return mp_const_none;
  275. }
  276. STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_setsockopt_obj, 4, 4, socket_setsockopt);
  277. void _socket_settimeout(socket_obj_t *sock, uint64_t timeout_ms) {
  278. // Rather than waiting for the entire timeout specified, we wait sock->retries times
  279. // for SOCKET_POLL_US each, checking for a MicroPython interrupt between timeouts.
  280. // with SOCKET_POLL_MS == 100ms, sock->retries allows for timeouts up to 13 years.
  281. // if timeout_ms == UINT64_MAX, wait forever.
  282. sock->retries = (timeout_ms == UINT64_MAX) ? UINT_MAX : timeout_ms * 1000 / SOCKET_POLL_US;
  283. struct timeval timeout = {
  284. .tv_sec = 0,
  285. .tv_usec = timeout_ms ? SOCKET_POLL_US : 0
  286. };
  287. lwip_setsockopt_r(sock->fd, SOL_SOCKET, SO_SNDTIMEO, (const void *)&timeout, sizeof(timeout));
  288. lwip_setsockopt_r(sock->fd, SOL_SOCKET, SO_RCVTIMEO, (const void *)&timeout, sizeof(timeout));
  289. lwip_fcntl_r(sock->fd, F_SETFL, timeout_ms ? 0 : O_NONBLOCK);
  290. }
  291. STATIC mp_obj_t socket_settimeout(const mp_obj_t arg0, const mp_obj_t arg1) {
  292. socket_obj_t *self = MP_OBJ_TO_PTR(arg0);
  293. if (arg1 == mp_const_none) _socket_settimeout(self, UINT64_MAX);
  294. else {
  295. #if MICROPY_PY_BUILTINS_FLOAT
  296. _socket_settimeout(self, mp_obj_get_float(arg1) * 1000L);
  297. #else
  298. _socket_settimeout(self, mp_obj_get_int(arg1) * 1000);
  299. #endif
  300. }
  301. return mp_const_none;
  302. }
  303. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_settimeout_obj, socket_settimeout);
  304. STATIC mp_obj_t socket_setblocking(const mp_obj_t arg0, const mp_obj_t arg1) {
  305. socket_obj_t *self = MP_OBJ_TO_PTR(arg0);
  306. if (mp_obj_is_true(arg1)) _socket_settimeout(self, UINT64_MAX);
  307. else _socket_settimeout(self, 0);
  308. return mp_const_none;
  309. }
  310. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_setblocking_obj, socket_setblocking);
  311. // XXX this can end up waiting a very long time if the content is dribbled in one character
  312. // at a time, as the timeout resets each time a recvfrom succeeds ... this is probably not
  313. // good behaviour.
  314. STATIC mp_uint_t _socket_read_data(mp_obj_t self_in, void *buf, size_t size,
  315. struct sockaddr *from, socklen_t *from_len, int *errcode) {
  316. socket_obj_t *sock = MP_OBJ_TO_PTR(self_in);
  317. // If the peer closed the connection then the lwIP socket API will only return "0" once
  318. // from lwip_recvfrom_r and then block on subsequent calls. To emulate POSIX behaviour,
  319. // which continues to return "0" for each call on a closed socket, we set a flag when
  320. // the peer closed the socket.
  321. if (sock->peer_closed) {
  322. return 0;
  323. }
  324. // XXX Would be nicer to use RTC to handle timeouts
  325. for (int i = 0; i <= sock->retries; ++i) {
  326. MP_THREAD_GIL_EXIT();
  327. int r = lwip_recvfrom_r(sock->fd, buf, size, 0, from, from_len);
  328. MP_THREAD_GIL_ENTER();
  329. if (r == 0) {
  330. sock->peer_closed = true;
  331. }
  332. if (r >= 0) {
  333. return r;
  334. }
  335. if (errno != EWOULDBLOCK) {
  336. *errcode = errno;
  337. return MP_STREAM_ERROR;
  338. }
  339. check_for_exceptions();
  340. }
  341. *errcode = sock->retries == 0 ? MP_EWOULDBLOCK : MP_ETIMEDOUT;
  342. return MP_STREAM_ERROR;
  343. }
  344. mp_obj_t _socket_recvfrom(mp_obj_t self_in, mp_obj_t len_in,
  345. struct sockaddr *from, socklen_t *from_len) {
  346. size_t len = mp_obj_get_int(len_in);
  347. vstr_t vstr;
  348. vstr_init_len(&vstr, len);
  349. int errcode;
  350. mp_uint_t ret = _socket_read_data(self_in, vstr.buf, len, from, from_len, &errcode);
  351. if (ret == MP_STREAM_ERROR) {
  352. exception_from_errno(errcode);
  353. }
  354. vstr.len = ret;
  355. return mp_obj_new_str_from_vstr(&mp_type_bytes, &vstr);
  356. }
  357. STATIC mp_obj_t socket_recv(mp_obj_t self_in, mp_obj_t len_in) {
  358. return _socket_recvfrom(self_in, len_in, NULL, NULL);
  359. }
  360. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_recv_obj, socket_recv);
  361. STATIC mp_obj_t socket_recvfrom(mp_obj_t self_in, mp_obj_t len_in) {
  362. struct sockaddr from;
  363. socklen_t fromlen = sizeof(from);
  364. mp_obj_t tuple[2];
  365. tuple[0] = _socket_recvfrom(self_in, len_in, &from, &fromlen);
  366. uint8_t *ip = (uint8_t*)&((struct sockaddr_in*)&from)->sin_addr;
  367. mp_uint_t port = lwip_ntohs(((struct sockaddr_in*)&from)->sin_port);
  368. tuple[1] = netutils_format_inet_addr(ip, port, NETUTILS_BIG);
  369. return mp_obj_new_tuple(2, tuple);
  370. }
  371. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_recvfrom_obj, socket_recvfrom);
  372. int _socket_send(socket_obj_t *sock, const char *data, size_t datalen) {
  373. int sentlen = 0;
  374. for (int i=0; i<=sock->retries && sentlen < datalen; i++) {
  375. MP_THREAD_GIL_EXIT();
  376. int r = lwip_write_r(sock->fd, data+sentlen, datalen-sentlen);
  377. MP_THREAD_GIL_ENTER();
  378. if (r < 0 && errno != EWOULDBLOCK) exception_from_errno(errno);
  379. if (r > 0) sentlen += r;
  380. check_for_exceptions();
  381. }
  382. if (sentlen == 0) mp_raise_OSError(MP_ETIMEDOUT);
  383. return sentlen;
  384. }
  385. STATIC mp_obj_t socket_send(const mp_obj_t arg0, const mp_obj_t arg1) {
  386. socket_obj_t *sock = MP_OBJ_TO_PTR(arg0);
  387. mp_uint_t datalen;
  388. const char *data = mp_obj_str_get_data(arg1, &datalen);
  389. int r = _socket_send(sock, data, datalen);
  390. return mp_obj_new_int(r);
  391. }
  392. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_send_obj, socket_send);
  393. STATIC mp_obj_t socket_sendall(const mp_obj_t arg0, const mp_obj_t arg1) {
  394. // XXX behaviour when nonblocking (see extmod/modlwip.c)
  395. // XXX also timeout behaviour.
  396. socket_obj_t *sock = MP_OBJ_TO_PTR(arg0);
  397. mp_buffer_info_t bufinfo;
  398. mp_get_buffer_raise(arg1, &bufinfo, MP_BUFFER_READ);
  399. int r = _socket_send(sock, bufinfo.buf, bufinfo.len);
  400. if (r < bufinfo.len) mp_raise_OSError(MP_ETIMEDOUT);
  401. return mp_const_none;
  402. }
  403. STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_sendall_obj, socket_sendall);
  404. STATIC mp_obj_t socket_sendto(mp_obj_t self_in, mp_obj_t data_in, mp_obj_t addr_in) {
  405. socket_obj_t *self = MP_OBJ_TO_PTR(self_in);
  406. // get the buffer to send
  407. mp_buffer_info_t bufinfo;
  408. mp_get_buffer_raise(data_in, &bufinfo, MP_BUFFER_READ);
  409. // create the destination address
  410. struct sockaddr_in to;
  411. to.sin_len = sizeof(to);
  412. to.sin_family = AF_INET;
  413. to.sin_port = lwip_htons(netutils_parse_inet_addr(addr_in, (uint8_t*)&to.sin_addr, NETUTILS_BIG));
  414. // send the data
  415. for (int i=0; i<=self->retries; i++) {
  416. MP_THREAD_GIL_EXIT();
  417. int ret = lwip_sendto_r(self->fd, bufinfo.buf, bufinfo.len, 0, (struct sockaddr*)&to, sizeof(to));
  418. MP_THREAD_GIL_ENTER();
  419. if (ret > 0) return mp_obj_new_int_from_uint(ret);
  420. if (ret == -1 && errno != EWOULDBLOCK) {
  421. exception_from_errno(errno);
  422. }
  423. check_for_exceptions();
  424. }
  425. mp_raise_OSError(MP_ETIMEDOUT);
  426. }
  427. STATIC MP_DEFINE_CONST_FUN_OBJ_3(socket_sendto_obj, socket_sendto);
  428. STATIC mp_obj_t socket_fileno(const mp_obj_t arg0) {
  429. socket_obj_t *self = MP_OBJ_TO_PTR(arg0);
  430. return mp_obj_new_int(self->fd);
  431. }
  432. STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_fileno_obj, socket_fileno);
  433. STATIC mp_obj_t socket_makefile(size_t n_args, const mp_obj_t *args) {
  434. (void)n_args;
  435. return args[0];
  436. }
  437. STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_makefile_obj, 1, 3, socket_makefile);
  438. STATIC mp_uint_t socket_stream_read(mp_obj_t self_in, void *buf, mp_uint_t size, int *errcode) {
  439. return _socket_read_data(self_in, buf, size, NULL, NULL, errcode);
  440. }
  441. STATIC mp_uint_t socket_stream_write(mp_obj_t self_in, const void *buf, mp_uint_t size, int *errcode) {
  442. socket_obj_t *sock = self_in;
  443. for (int i=0; i<=sock->retries; i++) {
  444. MP_THREAD_GIL_EXIT();
  445. int r = lwip_write_r(sock->fd, buf, size);
  446. MP_THREAD_GIL_ENTER();
  447. if (r > 0) return r;
  448. if (r < 0 && errno != EWOULDBLOCK) { *errcode = errno; return MP_STREAM_ERROR; }
  449. check_for_exceptions();
  450. }
  451. *errcode = sock->retries == 0 ? MP_EWOULDBLOCK : MP_ETIMEDOUT;
  452. return MP_STREAM_ERROR;
  453. }
  454. STATIC mp_uint_t socket_stream_ioctl(mp_obj_t self_in, mp_uint_t request, uintptr_t arg, int *errcode) {
  455. socket_obj_t * socket = self_in;
  456. if (request == MP_STREAM_POLL) {
  457. fd_set rfds; FD_ZERO(&rfds);
  458. fd_set wfds; FD_ZERO(&wfds);
  459. fd_set efds; FD_ZERO(&efds);
  460. struct timeval timeout = { .tv_sec = 0, .tv_usec = 0 };
  461. if (arg & MP_STREAM_POLL_RD) FD_SET(socket->fd, &rfds);
  462. if (arg & MP_STREAM_POLL_WR) FD_SET(socket->fd, &wfds);
  463. if (arg & MP_STREAM_POLL_HUP) FD_SET(socket->fd, &efds);
  464. int r = select((socket->fd)+1, &rfds, &wfds, &efds, &timeout);
  465. if (r < 0) {
  466. *errcode = MP_EIO;
  467. return MP_STREAM_ERROR;
  468. }
  469. mp_uint_t ret = 0;
  470. if (FD_ISSET(socket->fd, &rfds)) ret |= MP_STREAM_POLL_RD;
  471. if (FD_ISSET(socket->fd, &wfds)) ret |= MP_STREAM_POLL_WR;
  472. if (FD_ISSET(socket->fd, &efds)) ret |= MP_STREAM_POLL_HUP;
  473. return ret;
  474. } else if (request == MP_STREAM_CLOSE) {
  475. if (socket->fd >= 0) {
  476. #if MICROPY_PY_USOCKET_EVENTS
  477. if (socket->events_callback != MP_OBJ_NULL) {
  478. usocket_events_remove(socket);
  479. socket->events_callback = MP_OBJ_NULL;
  480. }
  481. #endif
  482. int ret = lwip_close_r(socket->fd);
  483. if (ret != 0) {
  484. *errcode = errno;
  485. return MP_STREAM_ERROR;
  486. }
  487. socket->fd = -1;
  488. }
  489. return 0;
  490. }
  491. *errcode = MP_EINVAL;
  492. return MP_STREAM_ERROR;
  493. }
  494. STATIC const mp_rom_map_elem_t socket_locals_dict_table[] = {
  495. { MP_ROM_QSTR(MP_QSTR___del__), MP_ROM_PTR(&mp_stream_close_obj) },
  496. { MP_ROM_QSTR(MP_QSTR_close), MP_ROM_PTR(&mp_stream_close_obj) },
  497. { MP_ROM_QSTR(MP_QSTR_bind), MP_ROM_PTR(&socket_bind_obj) },
  498. { MP_ROM_QSTR(MP_QSTR_listen), MP_ROM_PTR(&socket_listen_obj) },
  499. { MP_ROM_QSTR(MP_QSTR_accept), MP_ROM_PTR(&socket_accept_obj) },
  500. { MP_ROM_QSTR(MP_QSTR_connect), MP_ROM_PTR(&socket_connect_obj) },
  501. { MP_ROM_QSTR(MP_QSTR_send), MP_ROM_PTR(&socket_send_obj) },
  502. { MP_ROM_QSTR(MP_QSTR_sendall), MP_ROM_PTR(&socket_sendall_obj) },
  503. { MP_ROM_QSTR(MP_QSTR_sendto), MP_ROM_PTR(&socket_sendto_obj) },
  504. { MP_ROM_QSTR(MP_QSTR_recv), MP_ROM_PTR(&socket_recv_obj) },
  505. { MP_ROM_QSTR(MP_QSTR_recvfrom), MP_ROM_PTR(&socket_recvfrom_obj) },
  506. { MP_ROM_QSTR(MP_QSTR_setsockopt), MP_ROM_PTR(&socket_setsockopt_obj) },
  507. { MP_ROM_QSTR(MP_QSTR_settimeout), MP_ROM_PTR(&socket_settimeout_obj) },
  508. { MP_ROM_QSTR(MP_QSTR_setblocking), MP_ROM_PTR(&socket_setblocking_obj) },
  509. { MP_ROM_QSTR(MP_QSTR_makefile), MP_ROM_PTR(&socket_makefile_obj) },
  510. { MP_ROM_QSTR(MP_QSTR_fileno), MP_ROM_PTR(&socket_fileno_obj) },
  511. { MP_ROM_QSTR(MP_QSTR_read), MP_ROM_PTR(&mp_stream_read_obj) },
  512. { MP_ROM_QSTR(MP_QSTR_readinto), MP_ROM_PTR(&mp_stream_readinto_obj) },
  513. { MP_ROM_QSTR(MP_QSTR_readline), MP_ROM_PTR(&mp_stream_unbuffered_readline_obj) },
  514. { MP_ROM_QSTR(MP_QSTR_write), MP_ROM_PTR(&mp_stream_write_obj) },
  515. };
  516. STATIC MP_DEFINE_CONST_DICT(socket_locals_dict, socket_locals_dict_table);
  517. STATIC const mp_stream_p_t socket_stream_p = {
  518. .read = socket_stream_read,
  519. .write = socket_stream_write,
  520. .ioctl = socket_stream_ioctl
  521. };
  522. STATIC const mp_obj_type_t socket_type = {
  523. { &mp_type_type },
  524. .name = MP_QSTR_socket,
  525. .protocol = &socket_stream_p,
  526. .locals_dict = (mp_obj_t)&socket_locals_dict,
  527. };
  528. STATIC mp_obj_t get_socket(size_t n_args, const mp_obj_t *args) {
  529. socket_obj_t *sock = m_new_obj_with_finaliser(socket_obj_t);
  530. sock->base.type = &socket_type;
  531. sock->domain = AF_INET;
  532. sock->type = SOCK_STREAM;
  533. sock->proto = 0;
  534. sock->peer_closed = false;
  535. if (n_args > 0) {
  536. sock->domain = mp_obj_get_int(args[0]);
  537. if (n_args > 1) {
  538. sock->type = mp_obj_get_int(args[1]);
  539. if (n_args > 2) {
  540. sock->proto = mp_obj_get_int(args[2]);
  541. }
  542. }
  543. }
  544. sock->fd = lwip_socket(sock->domain, sock->type, sock->proto);
  545. if (sock->fd < 0) {
  546. exception_from_errno(errno);
  547. }
  548. _socket_settimeout(sock, UINT64_MAX);
  549. return MP_OBJ_FROM_PTR(sock);
  550. }
  551. STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(get_socket_obj, 0, 3, get_socket);
  552. STATIC mp_obj_t esp_socket_getaddrinfo(size_t n_args, const mp_obj_t *args) {
  553. // TODO support additional args beyond the first two
  554. struct addrinfo *res = NULL;
  555. _socket_getaddrinfo2(args[0], args[1], &res);
  556. mp_obj_t ret_list = mp_obj_new_list(0, NULL);
  557. for (struct addrinfo *resi = res; resi; resi = resi->ai_next) {
  558. mp_obj_t addrinfo_objs[5] = {
  559. mp_obj_new_int(resi->ai_family),
  560. mp_obj_new_int(resi->ai_socktype),
  561. mp_obj_new_int(resi->ai_protocol),
  562. mp_obj_new_str(resi->ai_canonname, strlen(resi->ai_canonname)),
  563. mp_const_none
  564. };
  565. if (resi->ai_family == AF_INET) {
  566. struct sockaddr_in *addr = (struct sockaddr_in *)resi->ai_addr;
  567. // This looks odd, but it's really just a u32_t
  568. ip4_addr_t ip4_addr = { .addr = addr->sin_addr.s_addr };
  569. char buf[16];
  570. ip4addr_ntoa_r(&ip4_addr, buf, sizeof(buf));
  571. mp_obj_t inaddr_objs[2] = {
  572. mp_obj_new_str(buf, strlen(buf)),
  573. mp_obj_new_int(ntohs(addr->sin_port))
  574. };
  575. addrinfo_objs[4] = mp_obj_new_tuple(2, inaddr_objs);
  576. }
  577. mp_obj_list_append(ret_list, mp_obj_new_tuple(5, addrinfo_objs));
  578. }
  579. if (res) lwip_freeaddrinfo(res);
  580. return ret_list;
  581. }
  582. STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(esp_socket_getaddrinfo_obj, 2, 6, esp_socket_getaddrinfo);
  583. STATIC mp_obj_t esp_socket_initialize() {
  584. static int initialized = 0;
  585. if (!initialized) {
  586. ESP_LOGI("modsocket", "Initializing");
  587. tcpip_adapter_init();
  588. initialized = 1;
  589. }
  590. return mp_const_none;
  591. }
  592. STATIC MP_DEFINE_CONST_FUN_OBJ_0(esp_socket_initialize_obj, esp_socket_initialize);
  593. STATIC const mp_rom_map_elem_t mp_module_socket_globals_table[] = {
  594. { MP_ROM_QSTR(MP_QSTR___name__), MP_ROM_QSTR(MP_QSTR_usocket) },
  595. { MP_ROM_QSTR(MP_QSTR___init__), MP_ROM_PTR(&esp_socket_initialize_obj) },
  596. { MP_ROM_QSTR(MP_QSTR_socket), MP_ROM_PTR(&get_socket_obj) },
  597. { MP_ROM_QSTR(MP_QSTR_getaddrinfo), MP_ROM_PTR(&esp_socket_getaddrinfo_obj) },
  598. { MP_ROM_QSTR(MP_QSTR_AF_INET), MP_ROM_INT(AF_INET) },
  599. { MP_ROM_QSTR(MP_QSTR_AF_INET6), MP_ROM_INT(AF_INET6) },
  600. { MP_ROM_QSTR(MP_QSTR_SOCK_STREAM), MP_ROM_INT(SOCK_STREAM) },
  601. { MP_ROM_QSTR(MP_QSTR_SOCK_DGRAM), MP_ROM_INT(SOCK_DGRAM) },
  602. { MP_ROM_QSTR(MP_QSTR_SOCK_RAW), MP_ROM_INT(SOCK_RAW) },
  603. { MP_ROM_QSTR(MP_QSTR_IPPROTO_TCP), MP_ROM_INT(IPPROTO_TCP) },
  604. { MP_ROM_QSTR(MP_QSTR_IPPROTO_UDP), MP_ROM_INT(IPPROTO_UDP) },
  605. { MP_ROM_QSTR(MP_QSTR_IPPROTO_IP), MP_ROM_INT(IPPROTO_IP) },
  606. { MP_ROM_QSTR(MP_QSTR_SOL_SOCKET), MP_ROM_INT(SOL_SOCKET) },
  607. { MP_ROM_QSTR(MP_QSTR_SO_REUSEADDR), MP_ROM_INT(SO_REUSEADDR) },
  608. { MP_ROM_QSTR(MP_QSTR_IP_ADD_MEMBERSHIP), MP_ROM_INT(IP_ADD_MEMBERSHIP) },
  609. };
  610. STATIC MP_DEFINE_CONST_DICT(mp_module_socket_globals, mp_module_socket_globals_table);
  611. const mp_obj_module_t mp_module_usocket = {
  612. .base = { &mp_type_module },
  613. .globals = (mp_obj_dict_t*)&mp_module_socket_globals,
  614. };