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