]>
Commit | Line | Data |
---|---|---|
e2173399 | 1 | #include "pico/cyw43_arch.h" |
5ec2b60a | 2 | #include "pico/stdlib.h" |
4db97133 | 3 | #include "pico/util/pheap.h" |
1427141a | 4 | #include "pico/util/queue.h" |
5ec2b60a | 5 | |
dae35db7 | 6 | #include "blink.h" |
d1521eda | 7 | #include "button.h" |
fbc57595 | 8 | #include "config.h" |
1e0a316e | 9 | #include "net.h" |
00ca9fa6 | 10 | #include "press.h" |
4db97133 | 11 | |
9d623c50 | 12 | enum event_type { NEW_BUTTON_PRESS, RESEND_TIME }; |
e8d047a0 SW |
13 | typedef struct { |
14 | enum event_type type; | |
15 | union { | |
16 | struct { | |
17 | uint32_t timestamp; | |
18 | } buttonpress; | |
19 | }; | |
20 | } event_t; | |
21 | ||
1427141a | 22 | queue_t queue; |
d1521eda | 23 | |
de14b62c SW |
24 | uint32_t time_s() { return time_us_64() / 1000000ul; } |
25 | ||
07b39467 SW |
26 | /* Often we don't bother checking for failure (full queue) because |
27 | * 1. The best thing to do in this unfortunate situation is to blithely | |
28 | * continue, dropping some events; continuing is better than stopping. | |
29 | * 2. Neither interrupt context nor queue-processing context can block | |
30 | * until space is available, or even sit around & blink the LED to | |
31 | * signal a problem. | |
32 | * (We also get a bit of type safety by taking event_t* rather than void*.) */ | |
33 | static void queue_try_add_ignoring_errors(queue_t *q, event_t *e) { | |
34 | queue_try_add(q, e); | |
35 | } | |
36 | ||
d1521eda | 37 | static void button_pressed() { |
1427141a | 38 | /* This runs in interrupt context; don't linger. */ |
2f7a1e89 | 39 | static uint64_t last_button_press_time = 0; |
de14b62c SW |
40 | uint32_t now = time_s(); |
41 | uint32_t time_since_last_press = now - last_button_press_time; | |
d7789e5b | 42 | if (time_since_last_press >= config_minimum_seconds_between_button_presses) { |
2f7a1e89 | 43 | last_button_press_time = now; |
e8d047a0 | 44 | event_t e; |
9d623c50 | 45 | e.type = NEW_BUTTON_PRESS; |
e8d047a0 | 46 | e.buttonpress.timestamp = now; |
07b39467 | 47 | queue_try_add_ignoring_errors(&queue, &e); |
2f7a1e89 | 48 | } |
d1521eda SW |
49 | } |
50 | ||
4db97133 SW |
51 | static void time_to_send(uint _) { |
52 | /* This runs in interrupt context; don't linger. */ | |
53 | event_t e; | |
9d623c50 | 54 | e.type = RESEND_TIME; |
4db97133 SW |
55 | queue_try_add_ignoring_errors(&queue, &e); |
56 | } | |
57 | ||
42b14805 | 58 | void set_resend_alarm(int alarm, uint32_t now, uint32_t next_act_time) { |
f523aaab SW |
59 | uint32_t sleep_duration = next_act_time - now; |
60 | if (hardware_alarm_set_target(alarm, | |
61 | make_timeout_time_ms(sleep_duration * 1000))) | |
62 | signal_error_by_blinking(); | |
63 | return; | |
64 | } | |
65 | ||
e3ff9e0d | 66 | void service_sleeps(int alarm, press_pile_t *pp) { |
4db97133 SW |
67 | hardware_alarm_cancel(alarm); |
68 | ||
69 | while (1) { | |
70 | uint32_t now = time_s(); | |
e3ff9e0d | 71 | int32_t act_time = next_scheduled_send(pp); |
b512ec26 | 72 | if (act_time == -1) |
4db97133 | 73 | return; |
b512ec26 | 74 | if (act_time > now) { |
42b14805 | 75 | set_resend_alarm(alarm, now, act_time); |
4db97133 SW |
76 | return; |
77 | } | |
e3ff9e0d SW |
78 | pheap_node_id_t i = ph_remove_head(pp->sleeps_heap, false); |
79 | press_t *press = &pp->presses[i]; | |
17461dec SW |
80 | uint32_t ago = now - press->timestamp; |
81 | send_report_packet(press->seq, ago); | |
82 | press->send_count++; | |
83 | if (press->send_count < config_resend_count) | |
e3ff9e0d | 84 | ph_insert_node(pp->sleeps_heap, i); |
4db97133 | 85 | else |
e3ff9e0d | 86 | ph_free_node(pp->sleeps_heap, i); |
4db97133 SW |
87 | } |
88 | } | |
89 | ||
ff999046 | 90 | void service_queue() { |
4db97133 SW |
91 | int alarm = hardware_alarm_claim_unused(true); |
92 | if (alarm == -1) | |
93 | signal_error_by_blinking(); | |
94 | hardware_alarm_set_callback(alarm, time_to_send); | |
95 | ||
e3ff9e0d | 96 | press_pile_t *pp = create_press_pile(); |
1427141a SW |
97 | u16_t seq = 0; |
98 | while (1) { | |
e3ff9e0d | 99 | service_sleeps(alarm, pp); |
4db97133 | 100 | |
e8d047a0 SW |
101 | event_t e; |
102 | queue_remove_blocking(&queue, &e); | |
103 | switch (e.type) { | |
9d623c50 | 104 | case NEW_BUTTON_PRESS: { |
e3ff9e0d | 105 | create_press(pp, e.buttonpress.timestamp, seq++); |
64a38d74 | 106 | } break; |
9d623c50 | 107 | case RESEND_TIME: { |
4db97133 SW |
108 | /* OK, we're awake. Cool. Thanks! (We actually do the sends in the |
109 | * service_sleeps() call at the top of the loop.) */ | |
64a38d74 | 110 | } break; |
e8d047a0 SW |
111 | default: |
112 | signal_error_by_blinking(); | |
ff379463 | 113 | } |
1427141a | 114 | } |
75649fe3 | 115 | } |
ff999046 SW |
116 | |
117 | int main() { | |
118 | stdio_init_all(); | |
119 | if (cyw43_arch_init_with_country(CYW43_COUNTRY_USA)) | |
120 | signal_error_by_blinking(); | |
121 | cyw43_arch_enable_sta_mode(); | |
122 | signal(3, 100); | |
123 | if (cyw43_arch_wifi_connect_timeout_ms(config_wifi_ssid, config_wifi_pass, | |
124 | CYW43_AUTH_WPA2_AES_PSK, 90000)) | |
125 | signal_error_by_blinking(); | |
126 | signal(2, 300); | |
127 | ||
128 | queue_init(&queue, sizeof(event_t), 99); | |
129 | ||
130 | begin_listening_for_button_press(button_pressed); | |
131 | ||
132 | service_queue(); | |
133 | } |