Skip to content

Commit f1dd527

Browse files
danicamporaDaniel Campora
authored andcommitted
zephyr: Create machine.Timer class implementation.
Signed-off-by: danicampora <[email protected]>
1 parent 1034b17 commit f1dd527

File tree

5 files changed

+201
-0
lines changed

5 files changed

+201
-0
lines changed

ports/zephyr/CMakeLists.txt

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -40,6 +40,7 @@ set(MICROPY_SOURCE_PORT
4040
machine_i2c.c
4141
machine_spi.c
4242
machine_pin.c
43+
machine_timer.c
4344
modbluetooth_zephyr.c
4445
modsocket.c
4546
modzephyr.c

ports/zephyr/machine_timer.c

Lines changed: 197 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,197 @@
1+
/*
2+
* This file is part of the MicroPython project, http://micropython.org/
3+
*
4+
* The MIT License (MIT)
5+
*
6+
* Copyright (c) 2025 Daniel Campora on behalf of REMOTE TECH LTD
7+
*
8+
* Permission is hereby granted, free of charge, to any person obtaining a copy
9+
* of this software and associated documentation files (the "Software"), to deal
10+
* in the Software without restriction, including without limitation the rights
11+
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
12+
* copies of the Software, and to permit persons to whom the Software is
13+
* furnished to do so, subject to the following conditions:
14+
*
15+
* The above copyright notice and this permission notice shall be included in
16+
* all copies or substantial portions of the Software.
17+
*
18+
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
19+
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
20+
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
21+
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
22+
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
23+
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
24+
* THE SOFTWARE.
25+
*/
26+
27+
#include <stdint.h>
28+
#include <stdio.h>
29+
30+
#include "py/obj.h"
31+
#include "py/runtime.h"
32+
#include "modmachine.h"
33+
#include <zephyr/kernel.h>
34+
#include <zephyr/device.h>
35+
#include <zephyr/sys/printk.h>
36+
#include <stdbool.h>
37+
38+
#include "py/mperrno.h"
39+
40+
41+
#define TIMER_MS_PER_TICK 1000
42+
43+
44+
typedef enum _machine_timer_mode_t {
45+
TIMER_MODE_ONE_SHOT = 0,
46+
TIMER_MODE_PERIODIC
47+
} machine_timer_mode_t;
48+
49+
typedef struct _machine_timer_obj_t {
50+
mp_obj_base_t base;
51+
52+
struct k_timer my_timer;
53+
54+
machine_timer_mode_t mode;
55+
uint32_t period_ms;
56+
57+
mp_obj_t callback;
58+
59+
struct _machine_timer_obj_t *next;
60+
} machine_timer_obj_t;
61+
62+
const mp_obj_type_t machine_timer_type;
63+
64+
static mp_obj_t machine_timer_init_helper(machine_timer_obj_t *self, mp_uint_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args);
65+
66+
void machine_timer_deinit_all(void) {
67+
// Disable, deallocate and remove all timers from list
68+
machine_timer_obj_t **t = &MP_STATE_PORT(machine_timer_obj_head);
69+
while (*t != NULL) {
70+
k_timer_stop(&((*t)->my_timer));
71+
machine_timer_obj_t *next = (*t)->next;
72+
m_del_obj(machine_timer_obj_t, *t);
73+
*t = next;
74+
}
75+
}
76+
77+
static void machine_timer_callback(struct k_timer *timer) {
78+
machine_timer_obj_t *self = (machine_timer_obj_t *)k_timer_user_data_get(timer);
79+
if (self->mode == TIMER_MODE_ONE_SHOT) {
80+
k_timer_stop(&self->my_timer);
81+
}
82+
if (self->callback != mp_const_none) {
83+
mp_sched_schedule(self->callback, MP_OBJ_FROM_PTR(self));
84+
}
85+
}
86+
87+
static void machine_timer_print(const mp_print_t *print, mp_obj_t self_in, mp_print_kind_t kind) {
88+
machine_timer_obj_t *self = self_in;
89+
qstr mode_str = (self->mode == TIMER_MODE_PERIODIC) ? MP_QSTR_PERIODIC : MP_QSTR_ONE_SHOT;
90+
mp_printf(print, "Timer(-1, mode=%q, period=%lu ms)", mode_str, self->period_ms);
91+
}
92+
93+
static mp_obj_t machine_timer_make_new(const mp_obj_type_t *type, size_t n_args, size_t n_kw, const mp_obj_t *args) {
94+
mp_arg_check_num(n_args, n_kw, 1, MP_OBJ_FUN_ARGS_MAX, true);
95+
96+
if (mp_obj_get_int(args[0]) != -1) {
97+
mp_raise_ValueError(MP_ERROR_TEXT("only virtual timers are supported"));
98+
}
99+
100+
// Create the new timer.
101+
machine_timer_obj_t *self = mp_obj_malloc(machine_timer_obj_t, &machine_timer_type);
102+
103+
// Add the timer to the linked-list of timers
104+
self->next = MP_STATE_PORT(machine_timer_obj_head);
105+
MP_STATE_PORT(machine_timer_obj_head) = self;
106+
107+
if (n_args > 1 || n_kw > 0) {
108+
mp_map_t kw_args;
109+
mp_map_init_fixed_table(&kw_args, n_kw, args + n_args);
110+
machine_timer_init_helper(self, n_args - 1, args + 1, &kw_args);
111+
}
112+
return self;
113+
}
114+
115+
static mp_obj_t machine_timer_init_helper(machine_timer_obj_t *self, mp_uint_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args) {
116+
enum {
117+
ARG_mode,
118+
ARG_callback,
119+
ARG_period,
120+
ARG_freq,
121+
};
122+
static const mp_arg_t allowed_args[] = {
123+
{ MP_QSTR_mode, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = TIMER_MODE_PERIODIC} },
124+
{ MP_QSTR_callback, MP_ARG_KW_ONLY | MP_ARG_OBJ, {.u_obj = mp_const_none} },
125+
{ MP_QSTR_period, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 0xffffffff} },
126+
#if MICROPY_PY_BUILTINS_FLOAT
127+
{ MP_QSTR_freq, MP_ARG_KW_ONLY | MP_ARG_OBJ, {.u_obj = mp_const_none} },
128+
#else
129+
{ MP_QSTR_freq, MP_ARG_KW_ONLY | MP_ARG_INT, {.u_int = 0xffffffff} },
130+
#endif
131+
};
132+
133+
mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
134+
mp_arg_parse_all(n_args, pos_args, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);
135+
136+
#if MICROPY_PY_BUILTINS_FLOAT
137+
if (args[ARG_freq].u_obj != mp_const_none) {
138+
self->period_ms = (uint32_t)(TIMER_MS_PER_TICK / mp_obj_get_float(args[ARG_freq].u_obj));
139+
}
140+
#else
141+
if (args[ARG_freq].u_int != 0xffffffff) {
142+
self->period_ms = TIMER_MS_PER_TICK / ((uint64_t)args[ARG_freq].u_int);
143+
}
144+
#endif
145+
else {
146+
self->period_ms = args[ARG_period].u_int;
147+
}
148+
149+
self->mode = args[ARG_mode].u_int;
150+
self->callback = args[ARG_callback].u_obj;
151+
152+
k_timer_init(&self->my_timer, machine_timer_callback, NULL);
153+
k_timer_user_data_set(&self->my_timer, self);
154+
k_timer_start(&self->my_timer, K_MSEC(self->period_ms), K_MSEC(self->period_ms));
155+
156+
return mp_const_none;
157+
}
158+
159+
static mp_obj_t machine_timer_deinit(mp_obj_t self_in) {
160+
machine_timer_obj_t *self = self_in;
161+
k_timer_stop(&self->my_timer);
162+
return mp_const_none;
163+
}
164+
static MP_DEFINE_CONST_FUN_OBJ_1(machine_timer_deinit_obj, machine_timer_deinit);
165+
166+
static mp_obj_t machine_timer_init(size_t n_args, const mp_obj_t *args, mp_map_t *kw_args) {
167+
return machine_timer_init_helper(args[0], n_args - 1, args + 1, kw_args);
168+
}
169+
static MP_DEFINE_CONST_FUN_OBJ_KW(machine_timer_init_obj, 1, machine_timer_init);
170+
171+
static mp_obj_t machine_timer_value(mp_obj_t self_in) {
172+
machine_timer_obj_t *self = self_in;
173+
k_ticks_t ticks = k_timer_remaining_ticks(&self->my_timer);
174+
return MP_OBJ_NEW_SMALL_INT(k_ticks_to_ms_near32(ticks));
175+
}
176+
static MP_DEFINE_CONST_FUN_OBJ_1(machine_timer_value_obj, machine_timer_value);
177+
178+
static const mp_rom_map_elem_t machine_timer_locals_dict_table[] = {
179+
{ MP_ROM_QSTR(MP_QSTR___del__), MP_ROM_PTR(&machine_timer_deinit_obj) },
180+
{ MP_ROM_QSTR(MP_QSTR_deinit), MP_ROM_PTR(&machine_timer_deinit_obj) },
181+
{ MP_ROM_QSTR(MP_QSTR_init), MP_ROM_PTR(&machine_timer_init_obj) },
182+
{ MP_ROM_QSTR(MP_QSTR_value), MP_ROM_PTR(&machine_timer_value_obj) },
183+
{ MP_ROM_QSTR(MP_QSTR_ONE_SHOT), MP_ROM_INT(TIMER_MODE_ONE_SHOT) },
184+
{ MP_ROM_QSTR(MP_QSTR_PERIODIC), MP_ROM_INT(TIMER_MODE_PERIODIC) },
185+
};
186+
static MP_DEFINE_CONST_DICT(machine_timer_locals_dict, machine_timer_locals_dict_table);
187+
188+
MP_DEFINE_CONST_OBJ_TYPE(
189+
machine_timer_type,
190+
MP_QSTR_Timer,
191+
MP_TYPE_FLAG_NONE,
192+
make_new, machine_timer_make_new,
193+
print, machine_timer_print,
194+
locals_dict, &machine_timer_locals_dict
195+
);
196+
197+
MP_REGISTER_ROOT_POINTER(struct _machine_timer_obj_t *machine_timer_obj_head);

ports/zephyr/main.c

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -165,6 +165,7 @@ int real_main(void) {
165165
#endif
166166
#if MICROPY_PY_MACHINE
167167
machine_pin_deinit();
168+
machine_timer_deinit_all();
168169
#endif
169170

170171
#if MICROPY_PY_THREAD

ports/zephyr/modmachine.c

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -44,6 +44,7 @@
4444
MICROPY_PY_MACHINE_RESET_ENTRY \
4545
{ MP_ROM_QSTR(MP_QSTR_reset_cause), MP_ROM_PTR(&machine_reset_cause_obj) }, \
4646
{ MP_ROM_QSTR(MP_QSTR_Pin), MP_ROM_PTR(&machine_pin_type) }, \
47+
{ MP_ROM_QSTR(MP_QSTR_Timer), MP_ROM_PTR(&machine_timer_type) }, \
4748

4849
static mp_obj_t machine_reset(void) {
4950
sys_reboot(SYS_REBOOT_COLD);

ports/zephyr/modmachine.h

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -11,5 +11,6 @@ typedef struct _machine_pin_obj_t {
1111
} machine_pin_obj_t;
1212

1313
void machine_pin_deinit(void);
14+
void machine_timer_deinit_all(void);
1415

1516
#endif // MICROPY_INCLUDED_ZEPHYR_MODMACHINE_H

0 commit comments

Comments
 (0)