|
1 | 1 | #include "gpio_async.h" |
2 | 2 |
|
3 | | -struct gpio_async_data { |
4 | | - bool fired; |
5 | | - bool value; |
6 | | - returncode_t ret; |
7 | | -}; |
8 | | - |
9 | | -static struct gpio_async_data result = { .fired = false }; |
| 3 | +#include "syscalls/gpio_async_syscalls.h" |
10 | 4 |
|
11 | | -static void gpio_async_callback_command(returncode_t ret, bool value) { |
12 | | - result.fired = true; |
13 | | - result.value = value; |
14 | | - result.ret = ret; |
15 | | -} |
16 | | - |
17 | | -static returncode_t gpio_async_op(uint32_t port, uint8_t pin, returncode_t (*op)(uint32_t, uint8_t, |
18 | | - libtock_gpio_async_callback_command)) { |
19 | | - returncode_t err; |
20 | | - result.fired = false; |
| 5 | +static returncode_t gpio_async_command(uint32_t port, uint8_t pin, returncode_t (*command_fn)(uint32_t, uint8_t)) { |
| 6 | + returncode_t ret; |
21 | 7 |
|
22 | | - err = op(port, pin, gpio_async_callback_command); |
23 | | - if (err != RETURNCODE_SUCCESS) return err; |
| 8 | + ret = command_fn(port, pin); |
| 9 | + if (ret != RETURNCODE_SUCCESS) return ret; |
24 | 10 |
|
25 | | - // Wait for the callback. |
26 | | - yield_for(&result.fired); |
27 | | - return result.ret; |
| 11 | + ret = libtocksync_gpio_async_yield_wait_for_generic_command(); |
| 12 | + return ret; |
28 | 13 | } |
29 | 14 |
|
30 | 15 | returncode_t libtocksync_gpio_async_make_output(uint32_t port, uint8_t pin) { |
31 | | - return gpio_async_op(port, pin, libtock_gpio_async_make_output); |
| 16 | + return gpio_async_command(port, pin, libtock_gpio_async_command_make_output); |
32 | 17 | } |
33 | 18 |
|
34 | 19 | returncode_t libtocksync_gpio_async_set(uint32_t port, uint8_t pin) { |
35 | | - return gpio_async_op(port, pin, libtock_gpio_async_set); |
| 20 | + return gpio_async_command(port, pin, libtock_gpio_async_command_set); |
36 | 21 | } |
37 | 22 |
|
38 | 23 | returncode_t libtocksync_gpio_async_clear(uint32_t port, uint8_t pin) { |
39 | | - return gpio_async_op(port, pin, libtock_gpio_async_clear); |
| 24 | + return gpio_async_command(port, pin, libtock_gpio_async_command_clear); |
40 | 25 | } |
41 | 26 |
|
42 | 27 | returncode_t libtocksync_gpio_async_toggle(uint32_t port, uint8_t pin) { |
43 | | - return gpio_async_op(port, pin, libtock_gpio_async_toggle); |
| 28 | + return gpio_async_command(port, pin, libtock_gpio_async_command_toggle); |
44 | 29 | } |
45 | 30 |
|
46 | 31 | returncode_t libtocksync_gpio_async_make_input(uint32_t port, uint8_t pin, libtock_gpio_input_mode_t pin_config) { |
47 | | - returncode_t err; |
48 | | - result.fired = false; |
| 32 | + returncode_t ret; |
49 | 33 |
|
50 | | - err = libtock_gpio_async_make_input(port, pin, pin_config, gpio_async_callback_command); |
51 | | - if (err != RETURNCODE_SUCCESS) return err; |
| 34 | + ret = libtock_gpio_async_command_make_input(port, pin, pin_config); |
| 35 | + if (ret != RETURNCODE_SUCCESS) return ret; |
52 | 36 |
|
53 | | - // Wait for the callback. |
54 | | - yield_for(&result.fired); |
55 | | - return result.ret; |
| 37 | + ret = libtocksync_gpio_async_yield_wait_for_generic_command(); |
| 38 | + return ret; |
56 | 39 | } |
57 | 40 |
|
58 | 41 | returncode_t libtocksync_gpio_async_read(uint32_t port, uint8_t pin, bool* value) { |
59 | | - returncode_t err; |
60 | | - result.fired = false; |
61 | | - |
62 | | - err = libtock_gpio_async_read(port, pin, gpio_async_callback_command); |
63 | | - if (err != RETURNCODE_SUCCESS) return err; |
| 42 | + returncode_t ret; |
64 | 43 |
|
65 | | - // Wait for the callback. |
66 | | - yield_for(&result.fired); |
67 | | - if (result.ret != RETURNCODE_SUCCESS) return result.ret; |
| 44 | + ret = libtock_gpio_async_command_read(port, pin); |
| 45 | + if (ret != RETURNCODE_SUCCESS) return ret; |
68 | 46 |
|
69 | | - *value = result.value; |
70 | | - return RETURNCODE_SUCCESS; |
| 47 | + ret = libtocksync_gpio_async_yield_wait_for_read(value); |
| 48 | + return ret; |
71 | 49 | } |
72 | 50 |
|
73 | 51 | returncode_t libtocksync_gpio_async_enable_interrupt(uint32_t port, uint8_t pin, |
74 | 52 | libtock_gpio_interrupt_mode_t irq_config) { |
75 | | - returncode_t err; |
76 | | - result.fired = false; |
| 53 | + returncode_t ret; |
77 | 54 |
|
78 | | - err = libtock_gpio_async_enable_interrupt(port, pin, irq_config, gpio_async_callback_command); |
79 | | - if (err != RETURNCODE_SUCCESS) return err; |
| 55 | + ret = libtock_gpio_async_command_enable_interrupt(port, pin, irq_config); |
| 56 | + if (ret != RETURNCODE_SUCCESS) return ret; |
80 | 57 |
|
81 | | - // Wait for the callback. |
82 | | - yield_for(&result.fired); |
83 | | - return result.ret; |
| 58 | + ret = libtocksync_gpio_async_yield_wait_for_generic_command(); |
| 59 | + return ret; |
84 | 60 | } |
85 | 61 |
|
86 | 62 | returncode_t libtocksync_gpio_async_disable_interrupt(uint32_t port, uint8_t pin) { |
87 | | - return gpio_async_op(port, pin, libtock_gpio_async_disable_interrupt); |
| 63 | + return gpio_async_command(port, pin, libtock_gpio_async_command_disable_interrupt); |
88 | 64 | } |
89 | 65 |
|
90 | 66 | returncode_t libtocksync_gpio_async_disable_sync(uint32_t port, uint8_t pin) { |
91 | | - return gpio_async_op(port, pin, libtock_gpio_async_disable); |
| 67 | + return gpio_async_command(port, pin, libtock_gpio_async_command_disable); |
92 | 68 | } |
0 commit comments