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 set_send_alarm(int alarm
, uint32_t now
, uint32_t next_act_time
) {
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();
66 void service_sleeps(int alarm
, send_t
*sleeping_sends
, pheap_t
*sleeps_heap
) {
67 hardware_alarm_cancel(alarm
);
70 uint32_t now
= time_s();
71 int32_t act_time
= next_scheduled_send(sleeping_sends
, sleeps_heap
);
75 set_send_alarm(alarm
, now
, act_time
);
78 pheap_node_id_t i
= ph_remove_head(sleeps_heap
, false);
79 send_t
*send
= &sleeping_sends
[i
];
80 uint32_t ago
= now
- send
->timestamp
;
81 send_report(send
->seq
, ago
);
83 if (send
->send_count
< config_resend_count
)
84 ph_insert_node(sleeps_heap
, i
);
86 ph_free_node(sleeps_heap
, i
);
90 void service_queue() {
91 int alarm
= hardware_alarm_claim_unused(true);
93 signal_error_by_blinking();
94 hardware_alarm_set_callback(alarm
, time_to_send
);
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
);
101 service_sleeps(alarm
, sleeping_sends
, sleeps_heap
);
104 queue_remove_blocking(&queue
, &e
);
107 create_send(sleeping_sends
, sleeps_heap
, e
.buttonpress
.timestamp
, seq
++);
110 /* OK, we're awake. Cool. Thanks! (We actually do the sends in the
111 * service_sleeps() call at the top of the loop.) */
114 signal_error_by_blinking();
121 if (cyw43_arch_init_with_country(CYW43_COUNTRY_USA
))
122 signal_error_by_blinking();
123 cyw43_arch_enable_sta_mode();
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();
130 queue_init(&queue
, sizeof(event_t
), 99);
132 begin_listening_for_button_press(button_pressed
);