Skip to content
Snippets Groups Projects
Select Git revision
  • 4d7be7df9d41f769a4c783604dc15d88c7dcddaa
  • master default protected
  • patch-2
  • patch-1
  • add_menu_vibration
  • close_sensor_on_keyboard_interrupt
  • schneider/standby
  • genofire/ble-follow-py
  • plaetzchen/ios-workaround
  • blinkisync-as-preload
  • schneider/max30001-pycardium
  • schneider/max30001-epicaridum
  • schneider/max30001
  • schneider/stream-locks
  • schneider/fundamental-test
  • schneider/ble-buffers
  • schneider/maxim-sdk-update
  • ch3/splashscreen
  • koalo/bhi160-works-but-dirty
  • koalo/wip/i2c-for-python
  • renze/safe_mode
  • v1.10
  • v1.9
  • v1.8
  • v1.7
  • v1.6
  • v1.5
  • v1.4
  • v1.3
  • v1.2
  • v1.1
  • v1.0
  • release-1
  • bootloader-v1
  • v0.0
35 results

init.gdb

Blame
  • Forked from card10 / firmware
    Source project has a limited visibility.
    modsocket.c 15.49 KiB
    /*
     * This file is part of the Micro Python project, http://micropython.org/
     *
     * The MIT License (MIT)
     *
     * Copyright (c) 2013, 2014 Damien P. George
     * Copyright (c) 2014 Paul Sokolovsky
     *
     * Permission is hereby granted, free of charge, to any person obtaining a copy
     * of this software and associated documentation files (the "Software"), to deal
     * in the Software without restriction, including without limitation the rights
     * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
     * copies of the Software, and to permit persons to whom the Software is
     * furnished to do so, subject to the following conditions:
     *
     * The above copyright notice and this permission notice shall be included in
     * all copies or substantial portions of the Software.
     *
     * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
     * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
     * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
     * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
     * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
     * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
     * THE SOFTWARE.
     */
    
    #include <stdio.h>
    #include <assert.h>
    #include <string.h>
    #include <unistd.h>
    #include <fcntl.h>
    #include <sys/stat.h>
    #include <sys/types.h>
    #include <sys/socket.h>
    #include <netinet/in.h>
    #include <arpa/inet.h>
    #include <netdb.h>
    #include <errno.h>
    
    #include "mpconfig.h"
    #include "nlr.h"
    #include "misc.h"
    #include "qstr.h"
    #include "obj.h"
    #include "objtuple.h"
    #include "objarray.h"
    #include "runtime.h"
    #include "stream.h"
    #include "builtin.h"
    
    /*
      The idea of this module is to implement reasonable minimum of
      socket-related functions to write typical clients and servers.
      The module named "microsocket" on purpose, to allow to make
      Python-level module more (or fully) compatible with CPython
      "socket", e.g.:
      ---- socket.py ----
      from microsocket import *
      from socket_more_funcs import *
      from socket_more_funcs2 import *
      -------------------
      I.e. this module should stay lean, and more functions (if needed)
      should be add to seperate modules (C or Python level).
     */
    
    #define MICROPY_SOCKET_EXTRA (0)
    
    typedef struct _mp_obj_socket_t {
        mp_obj_base_t base;
        int fd;
    } mp_obj_socket_t;
    
    STATIC const mp_obj_type_t microsocket_type;
    
    // Helper functions
    #define RAISE_ERRNO(err_flag, error_val) \
        { if (err_flag == -1) \
            { nlr_raise(mp_obj_new_exception_arg1(&mp_type_OSError, MP_OBJ_NEW_SMALL_INT((machine_int_t)error_val))); } }
    
    STATIC mp_obj_socket_t *socket_new(int fd) {
        mp_obj_socket_t *o = m_new_obj(mp_obj_socket_t);
        o->base.type = &microsocket_type;
        o->fd = fd;
        return o;
    }
    
    
    STATIC void socket_print(void (*print)(void *env, const char *fmt, ...), void *env, mp_obj_t self_in, mp_print_kind_t kind) {
        mp_obj_socket_t *self = self_in;
        print(env, "<_socket %d>", self->fd);
    }
    
    STATIC machine_int_t socket_read(mp_obj_t o_in, void *buf, machine_uint_t size, int *errcode) {
        mp_obj_socket_t *o = o_in;
        machine_int_t r = read(o->fd, buf, size);
        if (r == -1) {
            *errcode = errno;
        }
        return r;
    }
    
    STATIC machine_int_t socket_write(mp_obj_t o_in, const void *buf, machine_uint_t size, int *errcode) {
        mp_obj_socket_t *o = o_in;
        machine_int_t r = write(o->fd, buf, size);
        if (r == -1) {
            *errcode = errno;
        }
        return r;
    }
    
    STATIC mp_obj_t socket_close(mp_obj_t self_in) {
        mp_obj_socket_t *self = self_in;
        close(self->fd);
        return mp_const_none;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_close_obj, socket_close);
    
    STATIC mp_obj_t socket_fileno(mp_obj_t self_in) {
        mp_obj_socket_t *self = self_in;
        return MP_OBJ_NEW_SMALL_INT((machine_int_t)self->fd);
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_fileno_obj, socket_fileno);
    
    STATIC mp_obj_t socket_connect(mp_obj_t self_in, mp_obj_t addr_in) {
        mp_obj_socket_t *self = self_in;
        mp_buffer_info_t bufinfo;
        mp_get_buffer_raise(addr_in, &bufinfo, MP_BUFFER_READ);
        int r = connect(self->fd, (const struct sockaddr *)bufinfo.buf, bufinfo.len);
        RAISE_ERRNO(r, errno);
        return mp_const_none;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_connect_obj, socket_connect);
    
    STATIC mp_obj_t socket_bind(mp_obj_t self_in, mp_obj_t addr_in) {
        mp_obj_socket_t *self = self_in;
        mp_buffer_info_t bufinfo;
        mp_get_buffer_raise(addr_in, &bufinfo, MP_BUFFER_READ);
        int r = bind(self->fd, (const struct sockaddr *)bufinfo.buf, bufinfo.len);
        RAISE_ERRNO(r, errno);
        return mp_const_none;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_bind_obj, socket_bind);
    
    STATIC mp_obj_t socket_listen(mp_obj_t self_in, mp_obj_t backlog_in) {
        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;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_2(socket_listen_obj, socket_listen);
    
    STATIC mp_obj_t socket_accept(mp_obj_t self_in) {
        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;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_1(socket_accept_obj, socket_accept);
    
    // Note: besides flag param, this differs from read() in that
    // this does not swallow blocking errors (EAGAIN, EWOULDBLOCK) -
    // these would be thrown as exceptions.
    STATIC mp_obj_t socket_recv(uint n_args, const mp_obj_t *args) {
        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]);
        }
    
        char *buf = m_new(char, sz);
        int out_sz = recv(self->fd, buf, sz, flags);
        RAISE_ERRNO(out_sz, errno);
    
        mp_obj_t ret = MP_OBJ_NEW_QSTR(qstr_from_strn(buf, out_sz));
        m_del(char, buf, sz);
        return ret;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_recv_obj, 2, 3, socket_recv);
    
    // Note: besides flag param, this differs from write() in that
    // this does not swallow blocking errors (EAGAIN, EWOULDBLOCK) -
    // these would be thrown as exceptions.
    STATIC mp_obj_t socket_send(uint n_args, const mp_obj_t *args) {
        mp_obj_socket_t *self = args[0];
        int flags = 0;
    
        if (n_args > 2) {
            flags = MP_OBJ_SMALL_INT_VALUE(args[2]);
        }
    
        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);
        RAISE_ERRNO(out_sz, errno);
    
        return MP_OBJ_NEW_SMALL_INT((machine_int_t)out_sz);
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_send_obj, 2, 3, socket_send);
    
    STATIC mp_obj_t socket_setsockopt(uint n_args, const mp_obj_t *args) {
        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 {
            mp_buffer_info_t bufinfo;
            mp_get_buffer_raise(args[3], &bufinfo, MP_BUFFER_READ);
            optval = bufinfo.buf;
            optlen = bufinfo.len;
        }
        int r = setsockopt(self->fd, level, option, optval, optlen);
        RAISE_ERRNO(r, errno);
        return mp_const_none;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_setsockopt_obj, 4, 4, socket_setsockopt);
    
    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);
    
    STATIC mp_obj_t socket_makefile(uint n_args, const mp_obj_t *args) {
        // TODO: CPython explicitly says that closing returned object doesn't close
        // the original socket (Python2 at all says that fd is dup()ed). But we
        // save on the bloat.
        mp_obj_socket_t *self = args[0];
        mp_obj_t *new_args = alloca(n_args * sizeof(mp_obj_t));
        memcpy(new_args + 1, args + 1, (n_args - 1) * sizeof(mp_obj_t));
        new_args[0] = MP_OBJ_NEW_SMALL_INT((machine_int_t)self->fd);
        return mp_builtin_open(n_args, new_args);
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(socket_makefile_obj, 1, 3, socket_makefile);
    
    STATIC mp_obj_t socket_make_new(mp_obj_t type_in, uint n_args, uint n_kw, const mp_obj_t *args) {
        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);
    }
    
    STATIC const mp_map_elem_t microsocket_locals_dict_table[] = {
        { MP_OBJ_NEW_QSTR(MP_QSTR_fileno), (mp_obj_t)&socket_fileno_obj },
        { MP_OBJ_NEW_QSTR(MP_QSTR_makefile), (mp_obj_t)&socket_makefile_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 },
        { MP_OBJ_NEW_QSTR(MP_QSTR_setblocking), (mp_obj_t)&socket_setblocking_obj },
        { MP_OBJ_NEW_QSTR(MP_QSTR_close), (mp_obj_t)&socket_close_obj },
    };
    
    STATIC MP_DEFINE_CONST_DICT(microsocket_locals_dict, microsocket_locals_dict_table);
    
    STATIC const mp_stream_p_t microsocket_stream_p = {
        .read = socket_read,
        .write = socket_write,
    };
    
    STATIC const mp_obj_type_t microsocket_type = {
        { &mp_type_type },
        .name = MP_QSTR_socket,
        .print = socket_print,
        .make_new = socket_make_new,
        .getiter = NULL,
        .iternext = NULL,
        .stream_p = &microsocket_stream_p,
        .locals_dict = (mp_obj_t)&microsocket_locals_dict,
    };
    
    #if MICROPY_SOCKET_EXTRA
    STATIC mp_obj_t mod_socket_htons(mp_obj_t arg) {
        return MP_OBJ_NEW_SMALL_INT((machine_int_t)htons(MP_OBJ_SMALL_INT_VALUE(arg)));
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_socket_htons_obj, mod_socket_htons);
    
    STATIC mp_obj_t mod_socket_inet_aton(mp_obj_t arg) {
        assert(MP_OBJ_IS_TYPE(arg, &mp_type_str));
        const char *s = mp_obj_str_get_str(arg);
        struct in_addr addr;
        if (!inet_aton(s, &addr)) {
            nlr_raise(mp_obj_new_exception_arg1(&mp_type_OSError, MP_OBJ_NEW_SMALL_INT(EINVAL)));
        }
    
        return mp_obj_new_int(addr.s_addr);
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_socket_inet_aton_obj, mod_socket_inet_aton);
    
    STATIC mp_obj_t mod_socket_gethostbyname(mp_obj_t arg) {
        assert(MP_OBJ_IS_TYPE(arg, &mp_type_str));
        const char *s = mp_obj_str_get_str(arg);
        struct hostent *h = gethostbyname(s);
        if (h == NULL) {
            // CPython: socket.herror
            nlr_raise(mp_obj_new_exception_arg1(&mp_type_OSError, MP_OBJ_NEW_SMALL_INT((machine_int_t)h_errno)));
        }
        assert(h->h_length == 4);
        return mp_obj_new_int(*(int*)*h->h_addr_list);
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_socket_gethostbyname_obj, mod_socket_gethostbyname);
    #endif // MICROPY_SOCKET_EXTRA
    
    STATIC mp_obj_t mod_socket_getaddrinfo(uint n_args, const mp_obj_t *args) {
        // TODO: Implement all args
        assert(n_args == 2);
        assert(MP_OBJ_IS_STR(args[0]));
    
        const char *host = mp_obj_str_get_str(args[0]);
        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])) {
            int port = (short)MP_OBJ_SMALL_INT_VALUE(args[1]);
            char buf[6];
            sprintf(buf, "%d", port);
            serv = buf;
        } else {
            serv = mp_obj_str_get_str(args[1]);
        }
    
        struct addrinfo hints;
        struct addrinfo *addr;
        memset(&hints, 0, sizeof(hints));
        int res = getaddrinfo(host, serv, NULL/*&hints*/, &addr);
    
        if (res != 0) {
            // CPython: socket.gaierror
            nlr_raise(mp_obj_new_exception_msg_varg(&mp_type_OSError, "[addrinfo error %d]", res));
        }
        assert(addr);
    
        mp_obj_t list = mp_obj_new_list(0, NULL);
        for (; addr; addr = addr->ai_next) {
            mp_obj_tuple_t *t = mp_obj_new_tuple(5, NULL);
            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);
            // "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) {
                t->items[3] = MP_OBJ_NEW_QSTR(qstr_from_str(addr->ai_canonname));
            } else {
                t->items[3] = mp_const_none;
            }
            t->items[4] = mp_obj_new_bytearray(addr->ai_addrlen, addr->ai_addr);
            mp_obj_list_append(list, t);
        }
        return list;
    }
    STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_socket_getaddrinfo_obj, 2, 6, mod_socket_getaddrinfo);
    
    extern mp_obj_type_t sockaddr_in_type;
    
    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
    
    #define C(name) { MP_OBJ_NEW_QSTR(MP_QSTR_ ## name), MP_OBJ_NEW_SMALL_INT(name) }
        C(AF_UNIX),
        C(AF_INET),
        C(AF_INET6),
        C(SOCK_STREAM),
        C(SOCK_DGRAM),
        C(SOCK_RAW),
    
        C(MSG_DONTROUTE),
        C(MSG_DONTWAIT),
    
        C(SOL_SOCKET),
        C(SO_BROADCAST),
        C(SO_ERROR),
        C(SO_KEEPALIVE),
        C(SO_LINGER),
        C(SO_REUSEADDR),
    #undef C
    };
    
    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,
            .used = ARRAY_SIZE(mp_module_socket_globals_table),
            .alloc = ARRAY_SIZE(mp_module_socket_globals_table),
            .table = (mp_map_elem_t*)mp_module_socket_globals_table,
        },
    };
    
    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,
    };