Rev 66 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 66 | Rev 71 | ||
|---|---|---|---|
| Line 4... | Line 4... | ||
| 4 | #include "main.h" |
4 | #include "main.h" |
| 5 | 5 | ||
| 6 | const int SHIFT = 1; |
6 | const int SHIFT = 1; |
| 7 | typedef enum |
7 | typedef enum |
| 8 | { |
8 | { |
| - | 9 | PH_00 = 0, |
|
| - | 10 | PH_10 = 2, |
|
| - | 11 | PH_11 = 3, |
|
| 9 | PH_00 = 0, PH_10 = 2, PH_11 = 3, PH_01 = 1, |
12 | PH_01 = 1, |
| 10 | } eGreyCode; |
13 | } eGreyCode; |
| 11 | 14 | ||
| 12 | typedef struct |
15 | typedef struct |
| 13 | { |
16 | { |
| 14 | GPIO_TypeDef *GPIO; |
17 | GPIO_TypeDef *GPIO; |
| 15 | uint16_t Pin; |
18 | uint16_t Pin; |
| 16 | uint16_t Debounce; |
19 | uint16_t Debounce; |
| 17 | } sGPIOPin; |
20 | } sGPIOPin; |
| 18 | 21 | ||
| 19 | volatile int push_pos[MAX_PUSHBUTTONS]; |
22 | volatile int push_pos[MAX_PUSHBUTTONS]; |
| 20 | volatile int sw_count[MAX_PUSHBUTTONS]; //< debounced switch state |
23 | volatile int sw_count[MAX_PUSHBUTTONS]; //< debounced switch state |
| 21 | volatile int sw_newstate[MAX_PUSHBUTTONS]; //< debounced switch state |
24 | volatile int sw_newstate[MAX_PUSHBUTTONS]; //< debounced switch state |
| 22 | 25 | ||
| 23 | volatile int dial_count[MAX_DIALS]; |
26 | volatile int dial_count[MAX_DIALS]; |
| 24 | volatile int dial_pos[MAX_DIALS]; |
27 | volatile int dial_pos[MAX_DIALS]; |
| 25 | volatile int dial_last[MAX_DIALS]; // previous debounced switch position |
28 | volatile int dial_last[MAX_DIALS]; // previous debounced switch position |
| 26 | 29 | ||
| 27 | static const sGPIOPin sw_arr[MAX_PUSHBUTTONS] = |
30 | static const sGPIOPin sw_arr[MAX_PUSHBUTTONS] = |
| 28 | { |
31 | { |
| 29 | { SW1_PUSH_GPIO_Port, SW1_PUSH_Pin, 10 }, // two debounced switches |
32 | {SW1_PUSH_GPIO_Port, SW1_PUSH_Pin, 10}, // two debounced switches |
| 30 | { SW2_PUSH_GPIO_Port, SW2_PUSH_Pin, 10 }, }; |
33 | {SW2_PUSH_GPIO_Port, SW2_PUSH_Pin, 10}, |
| - | 34 | }; |
|
| 31 | 35 | ||
| 32 | // call this to setup switch states |
36 | // call this to setup switch states |
| 33 | void |
- | |
| 34 | InitSwitches (void) |
37 | void InitSwitches(void) |
| 35 | { |
38 | { |
| 36 | int i; |
39 | int i; |
| 37 | 40 | ||
| 38 | for (i = 0; i < MAX_PUSHBUTTONS; i++) |
41 | for (i = 0; i < MAX_PUSHBUTTONS; i++) |
| 39 | { |
42 | { |
| 40 | sw_newstate[i] = 0; |
43 | sw_newstate[i] = 0; |
| 41 | sw_count[i] = 0; |
44 | sw_count[i] = 0; |
| 42 | push_pos[i] = 0; |
45 | push_pos[i] = 0; |
| 43 | } |
46 | } |
| 44 | // reset the dial positions |
47 | // reset the dial positions |
| 45 | for (i = 0; i < MAX_DIALS; i++) |
48 | for (i = 0; i < MAX_DIALS; i++) |
| 46 | { |
49 | { |
| 47 | dial_pos[i] = 0; |
50 | dial_pos[i] = 0; |
| - | 51 | dial_last[i] = 0; |
|
| 48 | } |
52 | } |
| 49 | dial_count[0] = __HAL_TIM_GET_COUNTER(&htim9) >> SHIFT; |
53 | dial_count[0] = __HAL_TIM_GET_COUNTER(&htim9) >> SHIFT; |
| 50 | dial_count[1] = __HAL_TIM_GET_COUNTER(&htim3) >> SHIFT; |
54 | dial_count[1] = __HAL_TIM_GET_COUNTER(&htim3) >> SHIFT; |
| 51 | } |
55 | } |
| 52 | 56 | ||
| 53 | // this is the interrupt handler , dealling with the switches |
57 | // this is the interrupt handler , dealling with the switches |
| 54 | void |
- | |
| 55 | HandleSwitches (void) |
58 | void HandleSwitches(void) |
| 56 | { |
59 | { |
| 57 | 60 | ||
| 58 | int i; |
61 | int i; |
| 59 | 62 | ||
| 60 | for (i = 0; i < MAX_PUSHBUTTONS; i++) |
63 | for (i = 0; i < MAX_PUSHBUTTONS; i++) |
| 61 | { |
64 | { |
| 62 | 65 | ||
| 63 | int sw = HAL_GPIO_ReadPin (sw_arr[i].GPIO, sw_arr[i].Pin) |
66 | int sw = HAL_GPIO_ReadPin(sw_arr[i].GPIO, sw_arr[i].Pin) == GPIO_PIN_RESET; |
| 64 | == GPIO_PIN_RESET; |
- | |
| 65 | 67 | ||
| 66 | // bouncing, reset counter |
68 | // bouncing, reset counter |
| 67 | if (sw == sw_newstate[i]) |
69 | if (sw == sw_newstate[i]) |
| 68 | { |
- | |
| 69 | sw_count[i] = 0; |
- | |
| 70 | } |
- | |
| 71 | else |
- | |
| 72 | { |
- | |
| 73 | // count up to debounce time |
- | |
| 74 | if (sw_count[i] < sw_arr[i].Debounce) |
- | |
| 75 | { |
70 | { |
| 76 | sw_count[i]++; |
71 | sw_count[i] = 0; |
| 77 | - | ||
| 78 | if (sw_count[i] == sw_arr[i].Debounce) |
- | |
| 79 | { |
- | |
| 80 | sw_newstate[i] = sw; |
- | |
| 81 | } |
- | |
| 82 | } |
- | |
| 83 | } |
- | |
| 84 | } |
72 | } |
| - | 73 | else |
|
| - | 74 | { |
|
| - | 75 | // count up to debounce time |
|
| - | 76 | if (sw_count[i] < sw_arr[i].Debounce) |
|
| - | 77 | { |
|
| - | 78 | sw_count[i]++; |
|
| - | 79 | ||
| - | 80 | if (sw_count[i] == sw_arr[i].Debounce) |
|
| - | 81 | { |
|
| - | 82 | sw_newstate[i] = sw; |
|
| - | 83 | } |
|
| - | 84 | } |
|
| - | 85 | } |
|
| - | 86 | } |
|
| 85 | push_pos[0] = sw_newstate[0]; |
87 | push_pos[0] = sw_newstate[0]; |
| 86 | push_pos[1] = sw_newstate[1]; |
88 | push_pos[1] = sw_newstate[1]; |
| 87 | 89 | ||
| 88 | // use the modulus counters from the timer counters |
90 | // use the modulus counters from the timer counters |
| 89 | int cnt0 = __HAL_TIM_GET_COUNTER(&htim9) >> SHIFT; // counts 4 per step |
91 | int cnt0 = __HAL_TIM_GET_COUNTER(&htim9) >> SHIFT; // counts 4 per step |
| 90 | int cnt1 = __HAL_TIM_GET_COUNTER(&htim3) >> SHIFT; // counts 4 per step |
92 | int cnt1 = __HAL_TIM_GET_COUNTER(&htim3) >> SHIFT; // counts 4 per step |
| 91 | 93 | ||
| 92 | // always count up, or count down to zero but dont wrap |
94 | // always count up, or count down to zero but dont wrap |
| 93 | 95 | ||
| 94 | //if ((dial_pos[0] != 0) || (cnt0 > dial_count[0])) |
96 | // if ((dial_pos[0] != 0) || (cnt0 > dial_count[0])) |
| 95 | dial_pos[0] += cnt0 - dial_count[0]; |
97 | dial_pos[0] += cnt0 - dial_count[0]; |
| 96 | dial_count[0] = cnt0; |
98 | dial_count[0] = cnt0; |
| 97 | 99 | ||
| 98 | // if ((dial_pos[1] != 0) || (cnt1 > dial_count[1])) |
100 | // if ((dial_pos[1] != 0) || (cnt1 > dial_count[1])) |
| 99 | dial_pos[1] += cnt1 - dial_count[1]; |
101 | dial_pos[1] += cnt1 - dial_count[1]; |
| 100 | dial_count[1] = cnt1; |
102 | dial_count[1] = cnt1; |
| 101 | - | ||
| 102 | } |
103 | } |
| 103 | 104 | ||
| - | 105 | get_dial_diff(int dial) |
|
| - | 106 | { |
|
| - | 107 | if (dial > MAX_DIALS || dial < 0) |
|
| - | 108 | return 0; |
|
| - | 109 | // read value once |
|
| - | 110 | int pos = dial_pos[dial]; |
|
| - | 111 | int diff = pos - dial_last[dial]; |
|
| - | 112 | dial_last[dial] = pos; |
|
| - | 113 | return diff; |
|
| - | 114 | } |
|