modsocket.c 12.9 KB
Newer Older
1
2
3
4
#include <stdio.h>
#include <assert.h>
#include <string.h>
#include <unistd.h>
5
#include <fcntl.h>
xbe's avatar
xbe committed
6
7
#include <sys/stat.h>
#include <sys/types.h>
8
#include <sys/socket.h>
xbe's avatar
xbe committed
9
#include <netinet/in.h>
10
11
12
13
#include <arpa/inet.h>
#include <netdb.h>
#include <errno.h>

14
#include "mpconfig.h"
15
16
#include "nlr.h"
#include "misc.h"
17
#include "qstr.h"
18
19
20
21
22
23
24
25
26
27
28
29
30
#include "obj.h"
#include "objtuple.h"
#include "objarray.h"
#include "runtime.h"
#include "stream.h"

#define MICROPY_SOCKET_EXTRA (0)

typedef struct _mp_obj_socket_t {
    mp_obj_base_t base;
    int fd;
} mp_obj_socket_t;

31
STATIC const mp_obj_type_t microsocket_type;
32
33
34
35

// Helper functions
#define RAISE_ERRNO(err_flag, error_val) \
    { if (err_flag == -1) \
36
        { nlr_raise(mp_obj_new_exception_arg1(&mp_type_OSError, MP_OBJ_NEW_SMALL_INT((machine_int_t)error_val))); } }
37

38
STATIC mp_obj_socket_t *socket_new(int fd) {
39
    mp_obj_socket_t *o = m_new_obj(mp_obj_socket_t);
40
    o->base.type = &microsocket_type;
41
42
43
44
45
    o->fd = fd;
    return o;
}


46
STATIC void socket_print(void (*print)(void *env, const char *fmt, ...), void *env, mp_obj_t self_in, mp_print_kind_t kind) {
47
48
49
50
    mp_obj_socket_t *self = self_in;
    print(env, "<_socket %d>", self->fd);
}

51
STATIC machine_int_t socket_read(mp_obj_t o_in, void *buf, machine_uint_t size, int *errcode) {
52
53
54
55
56
57
58
59
    mp_obj_socket_t *o = o_in;
    machine_int_t r = read(o->fd, buf, size);
    if (r == -1) {
        *errcode = errno;
    }
    return r;
}

60
STATIC machine_int_t socket_write(mp_obj_t o_in, const void *buf, machine_uint_t size, int *errcode) {
61
62
63
64
65
66
67
68
    mp_obj_socket_t *o = o_in;
    machine_int_t r = write(o->fd, buf, size);
    if (r == -1) {
        *errcode = errno;
    }
    return r;
}

69
STATIC mp_obj_t socket_close(mp_obj_t self_in) {
70
71
72
73
    mp_obj_socket_t *self = self_in;
    close(self->fd);
    return mp_const_none;
}
74
STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_close_obj, socket_close);
75

76
STATIC mp_obj_t socket_fileno(mp_obj_t self_in) {
77
    mp_obj_socket_t *self = self_in;
78
    return MP_OBJ_NEW_SMALL_INT((machine_int_t)self->fd);
79
}
80
STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_fileno_obj, socket_fileno);
81

82
STATIC mp_obj_t socket_connect(mp_obj_t self_in, mp_obj_t addr_in) {
83
    mp_obj_socket_t *self = self_in;
84
    mp_buffer_info_t bufinfo;
85
    mp_get_buffer_raise(addr_in, &bufinfo, MP_BUFFER_READ);
86
87
88
89
    int r = connect(self->fd, (const struct sockaddr *)bufinfo.buf, bufinfo.len);
    RAISE_ERRNO(r, errno);
    return mp_const_none;
}
90
STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_connect_obj, socket_connect);
91

92
STATIC mp_obj_t socket_bind(mp_obj_t self_in, mp_obj_t addr_in) {
93
    mp_obj_socket_t *self = self_in;
94
    mp_buffer_info_t bufinfo;
95
    mp_get_buffer_raise(addr_in, &bufinfo, MP_BUFFER_READ);
96
97
98
99
    int r = bind(self->fd, (const struct sockaddr *)bufinfo.buf, bufinfo.len);
    RAISE_ERRNO(r, errno);
    return mp_const_none;
}
100
STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_bind_obj, socket_bind);
101

102
STATIC mp_obj_t socket_listen(mp_obj_t self_in, mp_obj_t backlog_in) {
103
104
105
106
107
    mp_obj_socket_t *self = self_in;
    int r = listen(self->fd, MP_OBJ_SMALL_INT_VALUE(backlog_in));
    RAISE_ERRNO(r, errno);
    return mp_const_none;
}
108
STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_listen_obj, socket_listen);
109

110
STATIC mp_obj_t socket_accept(mp_obj_t self_in) {
111
112
113
114
115
116
117
118
119
120
121
122
    mp_obj_socket_t *self = self_in;
    struct sockaddr addr;
    socklen_t addr_len = sizeof(addr);
    int fd = accept(self->fd, &addr, &addr_len);
    RAISE_ERRNO(fd, errno);

    mp_obj_tuple_t *t = mp_obj_new_tuple(2, NULL);
    t->items[0] = socket_new(fd);
    t->items[1] = mp_obj_new_bytearray(addr_len, &addr);

    return t;
}
123
STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_accept_obj, socket_accept);
124

125
STATIC mp_obj_t socket_recv(uint n_args, const mp_obj_t *args) {
126
127
128
129
130
131
132
133
    mp_obj_socket_t *self = args[0];
    int sz = MP_OBJ_SMALL_INT_VALUE(args[1]);
    int flags = 0;

    if (n_args > 2) {
        flags = MP_OBJ_SMALL_INT_VALUE(args[2]);
    }

134
    char *buf = m_new(char, sz);
135
136
137
    int out_sz = recv(self->fd, buf, sz, flags);
    RAISE_ERRNO(out_sz, errno);

138
139
    buf = m_realloc(buf, sz, out_sz);
    return MP_OBJ_NEW_QSTR(qstr_from_strn_take(buf, out_sz, out_sz));
140
}
141
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_recv_obj, 2, 3, socket_recv);
142

143
STATIC mp_obj_t socket_send(uint n_args, const mp_obj_t *args) {
144
145
146
147
148
149
150
    mp_obj_socket_t *self = args[0];
    int flags = 0;

    if (n_args > 2) {
        flags = MP_OBJ_SMALL_INT_VALUE(args[2]);
    }

151
152
153
    mp_buffer_info_t bufinfo;
    mp_get_buffer_raise(args[1], &bufinfo, MP_BUFFER_READ);
    int out_sz = send(self->fd, bufinfo.buf, bufinfo.len, flags);
154
155
    RAISE_ERRNO(out_sz, errno);

156
    return MP_OBJ_NEW_SMALL_INT((machine_int_t)out_sz);
157
}
158
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_send_obj, 2, 3, socket_send);
159

160
STATIC mp_obj_t socket_setsockopt(uint n_args, const mp_obj_t *args) {
161
162
163
164
165
166
167
168
169
170
171
    mp_obj_socket_t *self = args[0];
    int level = MP_OBJ_SMALL_INT_VALUE(args[1]);
    int option = mp_obj_get_int(args[2]);

    const void *optval;
    socklen_t optlen;
    if (MP_OBJ_IS_INT(args[3])) {
        int val = mp_obj_int_get(args[3]);
        optval = &val;
        optlen = sizeof(val);
    } else {
172
        mp_buffer_info_t bufinfo;
173
        mp_get_buffer_raise(args[3], &bufinfo, MP_BUFFER_READ);
174
175
176
177
178
179
180
        optval = bufinfo.buf;
        optlen = bufinfo.len;
    }
    int r = setsockopt(self->fd, level, option, optval, optlen);
    RAISE_ERRNO(r, errno);
    return mp_const_none;
}
181
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_setsockopt_obj, 4, 4, socket_setsockopt);
182

183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
STATIC mp_obj_t socket_setblocking(mp_obj_t self_in, mp_obj_t flag_in) {
    mp_obj_socket_t *self = self_in;
    int val = mp_obj_is_true(flag_in);
    int flags = fcntl(self->fd, F_GETFL, 0);
    RAISE_ERRNO(flags, errno);
    if (val) {
        flags &= ~O_NONBLOCK;
    } else {
        flags |= O_NONBLOCK;
    }
    flags = fcntl(self->fd, F_SETFL, flags);
    RAISE_ERRNO(flags, errno);
    return mp_const_none;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_setblocking_obj, socket_setblocking);

199
STATIC mp_obj_t socket_make_new(mp_obj_t type_in, uint n_args, uint n_kw, const mp_obj_t *args) {
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
    int family = AF_INET;
    int type = SOCK_STREAM;
    int proto = 0;

    if (n_args > 0) {
        assert(MP_OBJ_IS_SMALL_INT(args[0]));
        family = MP_OBJ_SMALL_INT_VALUE(args[0]);
        if (n_args > 1) {
            assert(MP_OBJ_IS_SMALL_INT(args[1]));
            type = MP_OBJ_SMALL_INT_VALUE(args[1]);
            if (n_args > 2) {
                assert(MP_OBJ_IS_SMALL_INT(args[2]));
                proto = MP_OBJ_SMALL_INT_VALUE(args[2]);
            }
        }
    }

    int fd = socket(family, type, proto);
    RAISE_ERRNO(fd, errno);
    return socket_new(fd);
}

222
STATIC const mp_map_elem_t microsocket_locals_dict_table[] = {
223
224
225
226
227
228
229
230
231
232
233
234
235
    { MP_OBJ_NEW_QSTR(MP_QSTR_fileno), (mp_obj_t)&socket_fileno_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_makefile), (mp_obj_t)&mp_identity_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_read), (mp_obj_t)&mp_stream_read_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_readall), (mp_obj_t)&mp_stream_readall_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_readline), (mp_obj_t)&mp_stream_unbuffered_readline_obj},
    { MP_OBJ_NEW_QSTR(MP_QSTR_write), (mp_obj_t)&mp_stream_write_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_connect), (mp_obj_t)&socket_connect_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_bind), (mp_obj_t)&socket_bind_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_listen), (mp_obj_t)&socket_listen_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_accept), (mp_obj_t)&socket_accept_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_recv), (mp_obj_t)&socket_recv_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_send), (mp_obj_t)&socket_send_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_setsockopt), (mp_obj_t)&socket_setsockopt_obj },
236
    { MP_OBJ_NEW_QSTR(MP_QSTR_setblocking), (mp_obj_t)&socket_setblocking_obj },
237
    { MP_OBJ_NEW_QSTR(MP_QSTR_close), (mp_obj_t)&socket_close_obj },
238
#if MICROPY_SOCKET_EXTRA
239
240
    { MP_OBJ_NEW_QSTR(MP_QSTR_recv), (mp_obj_t)&mp_stream_read_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_send), (mp_obj_t)&mp_stream_write_obj },
241
242
243
#endif
};

244
245
STATIC MP_DEFINE_CONST_DICT(microsocket_locals_dict, microsocket_locals_dict_table);

246
247
248
249
250
STATIC const mp_stream_p_t microsocket_stream_p = {
    .read = socket_read,
    .write = socket_write,
};

251
STATIC const mp_obj_type_t microsocket_type = {
252
    { &mp_type_type },
253
    .name = MP_QSTR_socket,
254
255
256
257
    .print = socket_print,
    .make_new = socket_make_new,
    .getiter = NULL,
    .iternext = NULL,
258
    .stream_p = &microsocket_stream_p,
259
    .locals_dict = (mp_obj_t)&microsocket_locals_dict,
260
261
};

262
STATIC mp_obj_t mod_socket_htons(mp_obj_t arg) {
263
    return MP_OBJ_NEW_SMALL_INT((machine_int_t)htons(MP_OBJ_SMALL_INT_VALUE(arg)));
264
}
265
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_socket_htons_obj, mod_socket_htons);
266

267
STATIC mp_obj_t mod_socket_inet_aton(mp_obj_t arg) {
268
    assert(MP_OBJ_IS_TYPE(arg, &mp_type_str));
269
    const char *s = mp_obj_str_get_str(arg);
270
271
    struct in_addr addr;
    if (!inet_aton(s, &addr)) {
272
        nlr_raise(mp_obj_new_exception_arg1(&mp_type_OSError, MP_OBJ_NEW_SMALL_INT(EINVAL)));
273
274
275
276
    }

    return mp_obj_new_int(addr.s_addr);
}
277
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_socket_inet_aton_obj, mod_socket_inet_aton);
278
279

#if MICROPY_SOCKET_EXTRA
280
STATIC mp_obj_t mod_socket_gethostbyname(mp_obj_t arg) {
281
    assert(MP_OBJ_IS_TYPE(arg, &mp_type_str));
282
    const char *s = mp_obj_str_get_str(arg);
283
284
    struct hostent *h = gethostbyname(s);
    if (h == NULL) {
285
        // CPython: socket.herror
286
        nlr_raise(mp_obj_new_exception_arg1(&mp_type_OSError, MP_OBJ_NEW_SMALL_INT((machine_int_t)h_errno)));
287
288
289
290
    }
    assert(h->h_length == 4);
    return mp_obj_new_int(*(int*)*h->h_addr_list);
}
291
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_socket_gethostbyname_obj, mod_socket_gethostbyname);
292
293
#endif

294
STATIC mp_obj_t mod_socket_getaddrinfo(uint n_args, const mp_obj_t *args) {
295
296
    // TODO: Implement all args
    assert(n_args == 2);
297
    assert(MP_OBJ_IS_STR(args[0]));
298

299
    const char *host = mp_obj_str_get_str(args[0]);
300
301
302
303
    const char *serv = NULL;
    // getaddrinfo accepts port in string notation, so however
    // it may seem stupid, we need to convert int to str
    if (MP_OBJ_IS_SMALL_INT(args[1])) {
304
305
        int port = (short)MP_OBJ_SMALL_INT_VALUE(args[1]);
        char buf[6];
306
307
308
        sprintf(buf, "%d", port);
        serv = buf;
    } else {
309
        serv = mp_obj_str_get_str(args[1]);
310
311
312
313
314
315
316
317
    }

    struct addrinfo hints;
    struct addrinfo *addr;
    memset(&hints, 0, sizeof(hints));
    int res = getaddrinfo(host, serv, NULL/*&hints*/, &addr);

    if (res != 0) {
318
        // CPython: socket.gaierror
319
        nlr_raise(mp_obj_new_exception_msg_varg(&mp_type_OSError, "[addrinfo error %d]", res));
320
321
322
    }
    assert(addr);

323
    mp_obj_t list = mp_obj_new_list(0, NULL);
324
325
    for (; addr; addr = addr->ai_next) {
        mp_obj_tuple_t *t = mp_obj_new_tuple(5, NULL);
326
327
328
        t->items[0] = MP_OBJ_NEW_SMALL_INT((machine_int_t)addr->ai_family);
        t->items[1] = MP_OBJ_NEW_SMALL_INT((machine_int_t)addr->ai_socktype);
        t->items[2] = MP_OBJ_NEW_SMALL_INT((machine_int_t)addr->ai_protocol);
329
330
331
        // "canonname will be a string representing the canonical name of the host
        // if AI_CANONNAME is part of the flags argument; else canonname will be empty." ??
        if (addr->ai_canonname) {
332
            t->items[3] = MP_OBJ_NEW_QSTR(qstr_from_str(addr->ai_canonname));
333
334
335
336
        } else {
            t->items[3] = mp_const_none;
        }
        t->items[4] = mp_obj_new_bytearray(addr->ai_addrlen, addr->ai_addr);
337
        mp_obj_list_append(list, t);
338
339
340
    }
    return list;
}
341
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_socket_getaddrinfo_obj, 2, 6, mod_socket_getaddrinfo);
342
343
344

extern mp_obj_type_t sockaddr_in_type;

345
346
347
348
349
350
351
352
353
354
STATIC const mp_map_elem_t mp_module_socket_globals_table[] = {
    { MP_OBJ_NEW_QSTR(MP_QSTR___name__), MP_OBJ_NEW_QSTR(MP_QSTR_microsocket) },
    { MP_OBJ_NEW_QSTR(MP_QSTR_socket), (mp_obj_t)&microsocket_type },
    { MP_OBJ_NEW_QSTR(MP_QSTR_getaddrinfo), (mp_obj_t)&mod_socket_getaddrinfo_obj },
#if MICROPY_SOCKET_EXTRA
    { MP_OBJ_NEW_QSTR(MP_QSTR_sockaddr_in), (mp_obj_t)&sockaddr_in_type },
    { MP_OBJ_NEW_QSTR(MP_QSTR_htons), (mp_obj_t)&mod_socket_htons_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_inet_aton), (mp_obj_t)&mod_socket_inet_aton_obj },
    { MP_OBJ_NEW_QSTR(MP_QSTR_gethostbyname), (mp_obj_t)&mod_socket_gethostbyname_obj },
#endif
355

356
#define C(name) { MP_OBJ_NEW_QSTR(MP_QSTR_ ## name), MP_OBJ_NEW_SMALL_INT(name) }
357
358
359
360
361
362
    C(AF_UNIX),
    C(AF_INET),
    C(AF_INET6),
    C(SOCK_STREAM),
    C(SOCK_DGRAM),
    C(SOCK_RAW),
363
364
365
366
367
368
369
370
371
372

    C(MSG_DONTROUTE),
    C(MSG_DONTWAIT),

    C(SOL_SOCKET),
    C(SO_BROADCAST),
    C(SO_ERROR),
    C(SO_KEEPALIVE),
    C(SO_LINGER),
    C(SO_REUSEADDR),
373
#undef C
374
375
};

376
377
378
379
380
STATIC const mp_obj_dict_t mp_module_socket_globals = {
    .base = {&mp_type_dict},
    .map = {
        .all_keys_are_qstrs = 1,
        .table_is_fixed_array = 1,
381
382
        .used = ARRAY_SIZE(mp_module_socket_globals_table),
        .alloc = ARRAY_SIZE(mp_module_socket_globals_table),
383
384
385
        .table = (mp_map_elem_t*)mp_module_socket_globals_table,
    },
};
386

387
388
389
390
391
const mp_obj_module_t mp_module_socket = {
    .base = { &mp_type_module },
    .name = MP_QSTR_microsocket,
    .globals = (mp_obj_dict_t*)&mp_module_socket_globals,
};