adapter/haas510/machine_sw_timer.c

/*
 * This file is part of the MicroPython project, http://micropython.org/
 *
 * Development of the code in this file was sponsored by Microbric Pty Ltd
 *
 * The MIT License (MIT)
 *
 * Copyright (c) 2013-2015 Damien P. George
 * Copyright (c) 2016 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 <stdlib.h>
#include <string.h>

#include "k_api.h"
#include "py/builtin.h"
#include "py/mperrno.h"
#include "py/obj.h"
#include "py/runtime.h"
#include "py/gc.h"
#include "py/stackctrl.h"

#include "ulog/ulog.h"
#include "aos/kernel.h"

#define LOG_TAG "machine_sw_timer"

#define TIMER_MODE_ONE_SHOT (0)
#define TIMER_MODE_PERIODIC (AOS_TIMER_REPEAT)
#define TIMER_DEFAULT_PERIOD (1000000U)

typedef struct _machine_soft_timer_obj_t {
    mp_obj_base_t base;
    mp_uint_t port;
    mp_uint_t period;
    mp_uint_t reload_mode;
    void* arg;
    aos_timer_t timerId;
    mp_obj_t callback;
} machine_soft_timer_obj_t;

const mp_obj_type_t mp_machine_soft_timer_type;

STATIC void machine_soft_timer_print(const mp_print_t *print, mp_obj_t self_in,
                               mp_print_kind_t kind) {
    machine_soft_timer_obj_t *self = MP_OBJ_TO_PTR(self_in);
    mp_printf(print, "period=%d, ", self->period);
    mp_printf(print, "reload_mode=%d, ", self->reload_mode);
}

STATIC mp_obj_t machine_soft_timer_make_new(const mp_obj_type_t *type, size_t n_args,
                                       size_t n_kw, const mp_obj_t *args) {
    mp_arg_check_num(n_args, n_kw, 1, 1, false);
    mp_uint_t port = mp_obj_get_int(args[0]);

    machine_soft_timer_obj_t *swtimer_obj = m_new_obj(machine_soft_timer_obj_t);
    if (!swtimer_obj) {
        mp_raise_OSError(ENOMEM);
        return mp_const_none;
    }
    swtimer_obj->base.type = &mp_machine_soft_timer_type;
    swtimer_obj->port = port;
    swtimer_obj->timerId = NULL;
    swtimer_obj->callback = NULL;

    return MP_OBJ_FROM_PTR(swtimer_obj);
}

STATIC void machine_soft_timer_enable(machine_soft_timer_obj_t *self) {
    aos_timer_t tim = self->timerId;
    aos_timer_start(&tim);
}

STATIC void machine_soft_timer_disable(machine_soft_timer_obj_t *self) {
    aos_timer_t tim = self->timerId;
    aos_timer_stop(&tim);
}

STATIC void machine_soft_timer_isr(void *timer, void *self_in) {
    machine_soft_timer_obj_t *self = (machine_soft_timer_obj_t *)MP_OBJ_TO_PTR(self_in);
    mp_obj_t callback = self->callback;
    if (self->callback != mp_const_none) {
        callback_to_python(self->callback, self);
    }
}

STATIC mp_obj_t machine_soft_timer_init_helper(machine_soft_timer_obj_t *self,
                                          mp_uint_t n_args,
                                          const mp_obj_t *pos_args,
                                          mp_map_t *kw_args) {
    enum
    {
        ARG_index,
        ARG_mode,
        ARG_callback,
        ARG_period,
    };
    static const mp_arg_t allowed_args[] = {
        {MP_QSTR_index, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 0}},
        {MP_QSTR_mode, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = AOS_TIMER_REPEAT | AOS_TIMER_AUTORUN}},
        {MP_QSTR_callback, MP_ARG_KW_ONLY | MP_ARG_OBJ, {.u_obj = mp_const_none}},
        {MP_QSTR_period, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = TIMER_DEFAULT_PERIOD}},
    };

    machine_soft_timer_disable(self);

    mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
    mp_arg_parse_all(n_args, pos_args, kw_args, MP_ARRAY_SIZE(allowed_args),
                     allowed_args, args);

    if (self == NULL) {
        LOGD(LOG_TAG, "%s: machine_soft_timer_init_helper failed \n", __func__);
        return mp_const_none;
    }

    self->callback = args[ARG_callback].u_obj;
    self->port = (int8_t)args[ARG_index].u_int;
    self->reload_mode = args[ARG_mode].u_int;
    self->period = (uint32_t)args[ARG_period].u_int;
    self->arg = (void*)self;

    int32_t status = aos_timer_create(&self->timerId,
                                        machine_soft_timer_isr,
                                        self->arg,
                                        self->period,
                                        (self->reload_mode | AOS_TIMER_AUTORUN));
    if (status != 0) {
        LOGE(LOG_TAG, "%s, %d, aos_timer_create failed\n", __func__, __LINE__);
        return mp_const_none;
    }

    return mp_const_none;
}

STATIC mp_obj_t machine_soft_timer_deinit(mp_obj_t self_in) {
    machine_soft_timer_obj_t *self = (machine_soft_timer_obj_t *)MP_OBJ_TO_PTR(self_in);
    machine_soft_timer_disable(self);
    aos_timer_free(&self->timerId);
    return mp_const_none;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(machine_soft_timer_deinit_obj, machine_soft_timer_deinit);

STATIC mp_obj_t machine_soft_timer_init(size_t n_args, const mp_obj_t *args, mp_map_t *kw_args) {
    return machine_soft_timer_init_helper(args[0], n_args - 1, args + 1, kw_args);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_KW(machine_soft_timer_init_obj, 1, machine_soft_timer_init);

STATIC mp_obj_t machine_soft_timer_period(mp_obj_t self_in, mp_obj_t period) {
    machine_soft_timer_obj_t *self = (machine_soft_timer_obj_t *)MP_OBJ_TO_PTR(self_in);
    if(self_in == NULL) {
        mp_raise_OSError(ENOENT);
        return mp_const_none;
    } else {
        self->period = mp_obj_get_int(period);
    }

    int32_t ret = aos_timer_change(&self->timerId, self->period);
    return MP_OBJ_NEW_SMALL_INT(ret);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_2(machine_soft_timer_period_obj, machine_soft_timer_period);

STATIC mp_obj_t machine_soft_timer_start(mp_obj_t self_in) {
    machine_soft_timer_obj_t *self = (machine_soft_timer_obj_t *)MP_OBJ_TO_PTR(self_in);
    int32_t ret = aos_timer_start(&self->timerId);
    return MP_OBJ_NEW_SMALL_INT(ret);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(machine_soft_timer_start_obj, machine_soft_timer_start);

STATIC mp_obj_t machine_soft_timer_stop(mp_obj_t self_in) {
    machine_soft_timer_obj_t *self = (machine_soft_timer_obj_t *)MP_OBJ_TO_PTR(self_in);
    aos_timer_stop(&self->timerId);
    return mp_const_none;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(machine_soft_timer_stop_obj, machine_soft_timer_stop);

STATIC mp_obj_t machine_soft_timer_value(mp_obj_t self_in) {
    machine_soft_timer_obj_t *self = (machine_soft_timer_obj_t *)MP_OBJ_TO_PTR(self_in);

    uint64_t time_ns[4] = {0};
    aos_timer_gettime(&self->timerId, time_ns);

    return MP_OBJ_NEW_SMALL_INT((mp_uint_t)(time_ns[0] * 1000 + time_ns[1] / 10000000));  // value in ms
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(machine_soft_timer_value_obj, machine_soft_timer_value);

STATIC const mp_rom_map_elem_t machine_soft_timer_locals_dict_table[] = {
    {MP_ROM_QSTR(MP_QSTR___del__), MP_ROM_PTR(&machine_soft_timer_deinit_obj)},
    {MP_ROM_QSTR(MP_QSTR_init), MP_ROM_PTR(&machine_soft_timer_init_obj)},
    {MP_ROM_QSTR(MP_QSTR_deinit), MP_ROM_PTR(&machine_soft_timer_deinit_obj)},
    {MP_ROM_QSTR(MP_QSTR_start), MP_ROM_PTR(&machine_soft_timer_start_obj)},
    {MP_ROM_QSTR(MP_QSTR_stop), MP_ROM_PTR(&machine_soft_timer_stop_obj)},
    {MP_ROM_QSTR(MP_QSTR_period), MP_ROM_PTR(&machine_soft_timer_period_obj)},
    {MP_ROM_QSTR(MP_QSTR_value), MP_ROM_PTR(&machine_soft_timer_value_obj)},

    {MP_ROM_QSTR(MP_QSTR_ONE_SHOT), MP_ROM_INT(TIMER_MODE_ONE_SHOT)},
    {MP_ROM_QSTR(MP_QSTR_PERIODIC), MP_ROM_INT(TIMER_MODE_PERIODIC)},
};
STATIC MP_DEFINE_CONST_DICT(machine_soft_timer_locals_dict, machine_soft_timer_locals_dict_table);

const mp_obj_type_t mp_machine_soft_timer_type = {
    {&mp_type_type},
    .name = MP_QSTR_SoftTimer,
    .print = machine_soft_timer_print,
    .make_new = machine_soft_timer_make_new,
    .locals_dict = (mp_obj_t)&machine_soft_timer_locals_dict,
};