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 | ||
dab4967f | 24 | #if !defined(DIP_SWITCH_PINS) |
a91c0c47 | 25 | # error "No DIP switch pads defined by DIP_SWITCH_PINS" |
dab4967f DJ |
26 | #endif |
27 | ||
a91c0c47 | 28 | #define NUMBER_OF_DIP_SWITCHES (sizeof(dip_switch_pad) / sizeof(pin_t)) |
29 | static pin_t dip_switch_pad[] = DIP_SWITCH_PINS; | |
30 | static bool dip_switch_state[NUMBER_OF_DIP_SWITCHES] = {0}; | |
31 | static bool last_dip_switch_state[NUMBER_OF_DIP_SWITCHES] = {0}; | |
dab4967f | 32 | |
a91c0c47 | 33 | __attribute__((weak)) void dip_switch_update_user(uint8_t index, bool active) {} |
dab4967f | 34 | |
a91c0c47 | 35 | __attribute__((weak)) void dip_switch_update_kb(uint8_t index, bool active) { dip_switch_update_user(index, active); } |
dab4967f | 36 | |
a91c0c47 | 37 | __attribute__((weak)) void dip_switch_update_mask_user(uint32_t state) {} |
dab4967f | 38 | |
a91c0c47 | 39 | __attribute__((weak)) void dip_switch_update_mask_kb(uint32_t state) { dip_switch_update_mask_user(state); } |
dab4967f DJ |
40 | |
41 | void dip_switch_init(void) { | |
a91c0c47 | 42 | for (uint8_t i = 0; i < NUMBER_OF_DIP_SWITCHES; i++) { |
43 | setPinInputHigh(dip_switch_pad[i]); | |
44 | } | |
45 | dip_switch_read(true); | |
dab4967f DJ |
46 | } |
47 | ||
dab4967f | 48 | void dip_switch_read(bool forced) { |
a91c0c47 | 49 | bool has_dip_state_changed = false; |
50 | uint32_t dip_switch_mask = 0; | |
dab4967f DJ |
51 | |
52 | for (uint8_t i = 0; i < NUMBER_OF_DIP_SWITCHES; i++) { | |
53 | dip_switch_state[i] = !readPin(dip_switch_pad[i]); | |
54 | dip_switch_mask |= dip_switch_state[i] << i; | |
55 | if (last_dip_switch_state[i] ^ dip_switch_state[i] || forced) { | |
56 | has_dip_state_changed = true; | |
57 | dip_switch_update_kb(i, dip_switch_state[i]); | |
58 | } | |
59 | } | |
60 | if (has_dip_state_changed) { | |
61 | dip_switch_update_mask_kb(dip_switch_mask); | |
62 | } | |
63 | memcpy(last_dip_switch_state, dip_switch_state, sizeof(&dip_switch_state)); | |
64 | } |