Commit | Line | Data |
---|---|---|
dab4967f DJ |
1 | /* |
2 | * Copyright 2018 Jack Humbert <jack.humb@gmail.com> | |
3 | * Copyright 2019 Drashna Jaelre (Christopher Courtney) <drashna@live.com> | |
4 | * | |
5 | * This program is free software: you can redistribute it and/or modify | |
6 | * it under the terms of the GNU General Public License as published by | |
7 | * the Free Software Foundation, either version 2 of the License, or | |
8 | * (at your option) any later version. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
17 | */ | |
18 | ||
19 | #include "dip_switch.h" | |
20 | ||
21 | // for memcpy | |
22 | #include <string.h> | |
23 | ||
24 | ||
25 | #if !defined(DIP_SWITCH_PINS) | |
26 | # error "No DIP switch pads defined by DIP_SWITCH_PINS" | |
27 | #endif | |
28 | ||
29 | #define NUMBER_OF_DIP_SWITCHES (sizeof(dip_switch_pad)/sizeof(pin_t)) | |
30 | static pin_t dip_switch_pad[] = DIP_SWITCH_PINS; | |
31 | static bool dip_switch_state[NUMBER_OF_DIP_SWITCHES] = { 0 }; | |
32 | static bool last_dip_switch_state[NUMBER_OF_DIP_SWITCHES] = { 0 }; | |
33 | ||
34 | ||
35 | __attribute__((weak)) | |
36 | void dip_switch_update_user(uint8_t index, bool active) {} | |
37 | ||
38 | __attribute__((weak)) | |
39 | void dip_switch_update_kb(uint8_t index, bool active) { dip_switch_update_user(index, active); } | |
40 | ||
41 | __attribute__((weak)) | |
42 | void dip_switch_update_mask_user(uint32_t state) {} | |
43 | ||
44 | __attribute__((weak)) | |
45 | void dip_switch_update_mask_kb(uint32_t state) { dip_switch_update_mask_user(state); } | |
46 | ||
47 | void dip_switch_init(void) { | |
48 | for (uint8_t i = 0; i < NUMBER_OF_DIP_SWITCHES; i++) { | |
49 | setPinInputHigh(dip_switch_pad[i]); | |
50 | } | |
51 | dip_switch_read(true); | |
52 | } | |
53 | ||
54 | ||
55 | void dip_switch_read(bool forced) { | |
56 | bool has_dip_state_changed = false; | |
57 | uint32_t dip_switch_mask = 0; | |
58 | ||
59 | for (uint8_t i = 0; i < NUMBER_OF_DIP_SWITCHES; i++) { | |
60 | dip_switch_state[i] = !readPin(dip_switch_pad[i]); | |
61 | dip_switch_mask |= dip_switch_state[i] << i; | |
62 | if (last_dip_switch_state[i] ^ dip_switch_state[i] || forced) { | |
63 | has_dip_state_changed = true; | |
64 | dip_switch_update_kb(i, dip_switch_state[i]); | |
65 | } | |
66 | } | |
67 | if (has_dip_state_changed) { | |
68 | dip_switch_update_mask_kb(dip_switch_mask); | |
69 | } | |
70 | memcpy(last_dip_switch_state, dip_switch_state, sizeof(&dip_switch_state)); | |
71 | } |