]>
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" |
2dcbb2a0 | 10 | #include "sends.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 | ||
4db97133 SW |
66 | void service_sleeps(int alarm, send_t *sleeping_sends, pheap_t *sleeps_heap) { |
67 | hardware_alarm_cancel(alarm); | |
68 | ||
69 | while (1) { | |
70 | uint32_t now = time_s(); | |
b512ec26 SW |
71 | int32_t act_time = next_scheduled_send(sleeping_sends, sleeps_heap); |
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 | } | |
b512ec26 SW |
78 | pheap_node_id_t i = ph_remove_head(sleeps_heap, false); |
79 | send_t *send = &sleeping_sends[i]; | |
4db97133 | 80 | uint32_t ago = now - send->timestamp; |
adf355dc | 81 | send_report_packet(send->seq, ago); |
4db97133 SW |
82 | send->send_count++; |
83 | if (send->send_count < config_resend_count) | |
84 | ph_insert_node(sleeps_heap, i); | |
85 | else | |
86 | ph_free_node(sleeps_heap, i); | |
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 | ||
96 | send_t sleeping_sends[PICO_PHEAP_MAX_ENTRIES]; | |
97 | pheap_t *sleeps_heap = | |
98 | ph_create(PICO_PHEAP_MAX_ENTRIES, next_send_less_than, sleeping_sends); | |
1427141a SW |
99 | u16_t seq = 0; |
100 | while (1) { | |
4db97133 SW |
101 | service_sleeps(alarm, sleeping_sends, sleeps_heap); |
102 | ||
e8d047a0 SW |
103 | event_t e; |
104 | queue_remove_blocking(&queue, &e); | |
105 | switch (e.type) { | |
9d623c50 | 106 | case NEW_BUTTON_PRESS: { |
67001c93 | 107 | create_send(sleeping_sends, sleeps_heap, e.buttonpress.timestamp, seq++); |
64a38d74 | 108 | } break; |
9d623c50 | 109 | case RESEND_TIME: { |
4db97133 SW |
110 | /* OK, we're awake. Cool. Thanks! (We actually do the sends in the |
111 | * service_sleeps() call at the top of the loop.) */ | |
64a38d74 | 112 | } break; |
e8d047a0 SW |
113 | default: |
114 | signal_error_by_blinking(); | |
ff379463 | 115 | } |
1427141a | 116 | } |
75649fe3 | 117 | } |
ff999046 SW |
118 | |
119 | int main() { | |
120 | stdio_init_all(); | |
121 | if (cyw43_arch_init_with_country(CYW43_COUNTRY_USA)) | |
122 | signal_error_by_blinking(); | |
123 | cyw43_arch_enable_sta_mode(); | |
124 | signal(3, 100); | |
125 | if (cyw43_arch_wifi_connect_timeout_ms(config_wifi_ssid, config_wifi_pass, | |
126 | CYW43_AUTH_WPA2_AES_PSK, 90000)) | |
127 | signal_error_by_blinking(); | |
128 | signal(2, 300); | |
129 | ||
130 | queue_init(&queue, sizeof(event_t), 99); | |
131 | ||
132 | begin_listening_for_button_press(button_pressed); | |
133 | ||
134 | service_queue(); | |
135 | } |