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
{ NEW_BUTTON_PRESS
, RESEND_TIME
};
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
;
45 e
.type
= NEW_BUTTON_PRESS
;
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_resend_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
, press_pile_t
*pp
) {
67 hardware_alarm_cancel(alarm
);
70 uint32_t now
= time_s();
71 int32_t act_time
= next_scheduled_send(pp
);
75 set_resend_alarm(alarm
, now
, act_time
);
78 pheap_node_id_t i
= ph_remove_head(pp
->sleeps_heap
, false);
79 press_t
*press
= &pp
->presses
[i
];
80 uint32_t ago
= now
- press
->timestamp
;
81 send_report_packet(press
->seq
, ago
);
83 if (press
->send_count
< config_resend_count
)
84 ph_insert_node(pp
->sleeps_heap
, i
);
86 ph_free_node(pp
->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 press_pile_t
*pp
= create_press_pile();
99 service_sleeps(alarm
, pp
);
102 queue_remove_blocking(&queue
, &e
);
104 case NEW_BUTTON_PRESS
: {
105 create_press(pp
, e
.buttonpress
.timestamp
, seq
++);
108 /* OK, we're awake. Cool. Thanks! (We actually do the sends in the
109 * service_sleeps() call at the top of the loop.) */
112 signal_error_by_blinking();
119 if (cyw43_arch_init_with_country(CYW43_COUNTRY_USA
))
120 signal_error_by_blinking();
121 cyw43_arch_enable_sta_mode();
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();
128 queue_init(&queue
, sizeof(event_t
), 99);
130 begin_listening_for_button_press(button_pressed
);