+ unsigned char param;
+
+ if (user_params_state == 0) {
+ if (button == 0)
+ toggle_dim_mode();
+ else
+ set_panic_mode();
+ return;
+ }
+
+ param = user_params_state-1;
+
+ if (button == 0) {
+ if (user_params[param])
+ user_params[param]--;
+ else
+ user_params[param] = user_params_max[param]-1;
+ } else {
+ user_params[param]++;
+
+ if (user_params[param] >= user_params_max[param])
+ user_params[param] = 0;
+ }
+ // FIXME: notify somebody about user_params change?
+
+ set_status_led(1, buttons_setup_status1_pattern_select());
+
+ user_params_starttime = jiffies;
+}
+
+static inline void long_press(unsigned char button)
+{
+ if (button == 0) {
+ power_down();
+ return;
+ }
+
+ // button 1 - cycle through states
+ user_params_state++;
+
+ if (user_params_state > MAX_USER_PARAMS)
+ user_params_state = 1;
+
+ set_status_led(0, buttons_setup_status0_pattern_select());
+ set_status_led(1, buttons_setup_status1_pattern_select());
+ user_params_starttime = jiffies;
+}
+
+void init_buttons()
+{
+ DDRA &= ~_BV(PA4); // set as input
+ DDRA |= _BV(PA3); // output
+ PORTA &= ~(_BV(PA3) | _BV(PA4)); // PA4 disable internal pull-up
+ // PA3 set to zero
+
+ GIMSK &= ~(_BV(PCIE0) | _BV(PCIE1)); // disable pin-change IRQs
+ PCMSK0 = 0; // disable pin-change IRQs on all pins of port A
+ PCMSK1 = 0; // disable pin-change IRQs on all pins of port B
+
+ button_start[0] = 0;
+ button_start[1] = 0;
+ button_start[2] = 0;
+
+ prev_state.all = 0;
+ button_state.all = 0;
+ user_params_state = 0;
+}
+
+void susp_buttons()
+{
+ DDRA &= ~(_BV(PA3) | _BV(PA4)); // set as input
+ PORTA |= _BV(PA4); // enable internal pull-up
+ PORTA &= ~_BV(PA3); // disable pull-up
+
+ GIMSK &= ~_BV(PCIE0);
+ GIMSK |= _BV(PCIE1);
+
+ PCMSK0 = _BV(PCINT4);
+ // disable pin-change IRQs on all pins except PA4
+ PCMSK1 = 0; // disable pin-change IRQs on all pins of port B
+}
+
+static void handle_button(unsigned char button, unsigned char cur,
+ unsigned char prev)
+{
+ if (cur && !prev) { // --- just pressed ---
+ button_start[button] = jiffies;
+ set_status_led(button, NULL);
+
+ } else if (cur && prev) { // --- is still pressed ---
+ uint16_t duration = jiffies - button_start[button];
+
+ if (duration > 160) {
+ set_status_led(button, on1_pattern);
+ // acknowledge long press
+ }
+ } else if (!cur && prev) { // --- just released ---
+ uint16_t duration = jiffies - button_start[button];
+
+ if (duration > 6 && duration < 60) {
+ short_press(button);
+ } else if (duration > 160) {
+ set_status_led(button, NULL);
+ long_press(button);
+ }
+ // ignore other button-press durations
+ }
+}
+
+static void handle_brake(unsigned char cur, unsigned char prev)
+{
+ if (cur && !prev) { // --- just pressed ---
+ button_start[2] = jiffies;
+ } else if (!cur && prev) { // --- just released ---
+ button_start[2] = jiffies;
+ } else { // --- no change ---
+ uint16_t duration = jiffies - button_start[2];
+
+ if (duration > 6) {
+ if (cur) {
+ if (button_state.brake_working
+ && !button_state.brake_reported) {
+ button_state.brake_reported = 1;
+ brake_on();
+ }
+ } else {
+ button_state.brake_working = 1;
+ if (button_state.brake_reported) {
+ button_state.brake_reported = 0;
+ brake_off();