1 #include "pico/cyw43_arch.h"
2 #include "pico/stdlib.h"
3 #include "pico/util/pheap.h"
4 #include "pico/util/queue.h"
12 enum event_type
{ BUTTONPRESS
, SEND
};
24 uint32_t time_s() { return time_us_64() / 1000000ul; }
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
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
) {
37 static void button_pressed() {
38 /* This runs in interrupt context; don't linger. */
39 static uint64_t last_button_press_time
= 0;
40 uint32_t now
= time_s();
41 uint32_t time_since_last_press
= now
- last_button_press_time
;
42 if (time_since_last_press
>= config_minimum_seconds_between_button_presses
) {
43 last_button_press_time
= now
;
46 e
.buttonpress
.timestamp
= now
;
47 queue_try_add_ignoring_errors(&queue
, &e
);
51 static void time_to_send(uint _
) {
52 /* This runs in interrupt context; don't linger. */
55 queue_try_add_ignoring_errors(&queue
, &e
);
58 void service_sleeps(int alarm
, send_t
*sleeping_sends
, pheap_t
*sleeps_heap
) {
59 hardware_alarm_cancel(alarm
);
62 uint32_t now
= time_s();
63 pheap_node_id_t i
= ph_peek_head(sleeps_heap
);
66 send_t
*send
= &sleeping_sends
[i
];
67 if (next_send(send
) > now
) {
68 uint32_t sleep_duration
= next_send(send
) - now
;
69 if (hardware_alarm_set_target(
70 alarm
, make_timeout_time_ms(sleep_duration
* 1000)))
71 signal_error_by_blinking();
74 if (ph_remove_head(sleeps_heap
, false) != i
)
75 signal_error_by_blinking();
76 uint32_t ago
= now
- send
->timestamp
;
77 send_report(send
->seq
, ago
);
79 if (send
->send_count
< config_resend_count
)
80 ph_insert_node(sleeps_heap
, i
);
82 ph_free_node(sleeps_heap
, i
);
86 void service_queue() {
87 int alarm
= hardware_alarm_claim_unused(true);
89 signal_error_by_blinking();
90 hardware_alarm_set_callback(alarm
, time_to_send
);
92 send_t sleeping_sends
[PICO_PHEAP_MAX_ENTRIES
];
93 pheap_t
*sleeps_heap
=
94 ph_create(PICO_PHEAP_MAX_ENTRIES
, next_send_less_than
, sleeping_sends
);
97 service_sleeps(alarm
, sleeping_sends
, sleeps_heap
);
100 queue_remove_blocking(&queue
, &e
);
103 pheap_node_id_t i
= ph_new_node(sleeps_heap
);
105 /* TODO: Don't drop new presses just because sleeps_heap is full of old
109 sleeping_sends
[i
].timestamp
= e
.buttonpress
.timestamp
;
110 sleeping_sends
[i
].seq
= seq
++;
111 sleeping_sends
[i
].send_count
= 0;
112 ph_insert_node(sleeps_heap
, i
);
115 /* OK, we're awake. Cool. Thanks! (We actually do the sends in the
116 * service_sleeps() call at the top of the loop.) */
119 signal_error_by_blinking();
126 if (cyw43_arch_init_with_country(CYW43_COUNTRY_USA
))
127 signal_error_by_blinking();
128 cyw43_arch_enable_sta_mode();
130 if (cyw43_arch_wifi_connect_timeout_ms(config_wifi_ssid
, config_wifi_pass
,
131 CYW43_AUTH_WPA2_AES_PSK
, 90000))
132 signal_error_by_blinking();
135 queue_init(&queue
, sizeof(event_t
), 99);
137 begin_listening_for_button_press(button_pressed
);