|
23 | 23 |
|
24 | 24 | static uint32_t channel_ids[CHANNEL_NUM] = {0}; //each pin will be given an id, if id is 0 the pin can be ignored.
|
25 | 25 | static uint8_t channel_enabled[CHANNEL_NUM] = {0};
|
26 |
| -static uint32_t portRISE= 0; |
27 |
| -static uint32_t portFALL= 0; |
| 26 | +static uint32_t portRISE = 0; |
| 27 | +static uint32_t portFALL = 0; |
28 | 28 | static gpio_irq_handler irq_handler;
|
29 | 29 |
|
30 | 30 | #ifdef __cplusplus
|
31 | 31 | extern "C" {
|
32 |
| -#endif |
33 |
| -void GPIOTE_IRQHandler(void){ |
34 |
| - volatile uint32_t newVal = NRF_GPIO->IN; |
35 |
| - |
36 |
| - if ( (NRF_GPIOTE->EVENTS_PORT != 0) && ( (NRF_GPIOTE->INTENSET & GPIOTE_INTENSET_PORT_Msk) != 0) ){ |
37 |
| - NRF_GPIOTE->EVENTS_PORT = 0; |
38 |
| - |
39 |
| - for(uint8_t i=0;i<31;i++){ |
40 |
| - if(channel_ids[i]>0){ |
41 |
| - if(channel_enabled[i]){ |
| 32 | +#endif |
| 33 | +void GPIOTE_IRQHandler(void) |
| 34 | +{ |
| 35 | + volatile uint32_t newVal = NRF_GPIO->IN; |
| 36 | + |
| 37 | + if ((NRF_GPIOTE->EVENTS_PORT != 0) && ((NRF_GPIOTE->INTENSET & GPIOTE_INTENSET_PORT_Msk) != 0)) { |
| 38 | + NRF_GPIOTE->EVENTS_PORT = 0; |
| 39 | + |
| 40 | + for (uint8_t i = 0; i<31; i++) { |
| 41 | + if (channel_ids[i]>0) { |
| 42 | + if (channel_enabled[i]) { |
42 | 43 | if( ((newVal>>i)&1) && ( ( (NRF_GPIO->PIN_CNF[i] >>GPIO_PIN_CNF_SENSE_Pos) & GPIO_PIN_CNF_SENSE_Low) != GPIO_PIN_CNF_SENSE_Low) && ( (portRISE>>i)&1) ){
|
43 |
| - irq_handler(channel_ids[i], IRQ_RISE); |
44 |
| - } |
45 |
| - else if( ( ((newVal>>i)&1) == 0) && ( ( (NRF_GPIO->PIN_CNF[i] >>GPIO_PIN_CNF_SENSE_Pos)&GPIO_PIN_CNF_SENSE_Low) == GPIO_PIN_CNF_SENSE_Low) && ( (portFALL>>i)&1) ){ |
46 |
| - irq_handler(channel_ids[i], IRQ_FALL); |
47 |
| - } |
| 44 | + irq_handler(channel_ids[i], IRQ_RISE); |
| 45 | + } else if ((((newVal >> i) & 1) == 0) && |
| 46 | + (((NRF_GPIO->PIN_CNF[i] >> GPIO_PIN_CNF_SENSE_Pos) & GPIO_PIN_CNF_SENSE_Low) == GPIO_PIN_CNF_SENSE_Low) && |
| 47 | + ((portFALL >> i) & 1)) { |
| 48 | + irq_handler(channel_ids[i], IRQ_FALL); |
| 49 | + } |
48 | 50 | }
|
49 |
| - |
50 |
| - if(NRF_GPIO->PIN_CNF[i] &GPIO_PIN_CNF_SENSE_Msk){ |
| 51 | + |
| 52 | + if (NRF_GPIO->PIN_CNF[i] & GPIO_PIN_CNF_SENSE_Msk) { |
51 | 53 | NRF_GPIO->PIN_CNF[i] &= ~(GPIO_PIN_CNF_SENSE_Msk);
|
52 |
| - |
53 |
| - if(newVal>>i &1){ |
54 |
| - NRF_GPIO->PIN_CNF[i] |= (GPIO_PIN_CNF_SENSE_Low << GPIO_PIN_CNF_SENSE_Pos) ; |
55 |
| - } |
56 |
| - else{ |
57 |
| - NRF_GPIO->PIN_CNF[i] |= (GPIO_PIN_CNF_SENSE_High << GPIO_PIN_CNF_SENSE_Pos) ; |
| 54 | + |
| 55 | + if (newVal >> i & 1) { |
| 56 | + NRF_GPIO->PIN_CNF[i] |= (GPIO_PIN_CNF_SENSE_Low << GPIO_PIN_CNF_SENSE_Pos); |
| 57 | + } else { |
| 58 | + NRF_GPIO->PIN_CNF[i] |= (GPIO_PIN_CNF_SENSE_High << GPIO_PIN_CNF_SENSE_Pos); |
58 | 59 | }
|
59 | 60 | }
|
60 | 61 | }
|
61 |
| - } |
| 62 | + } |
62 | 63 | }
|
63 | 64 | }
|
| 65 | + |
64 | 66 | #ifdef __cplusplus
|
65 | 67 | }
|
66 |
| -#endif |
| 68 | +#endif |
67 | 69 |
|
68 |
| -int gpio_irq_init(gpio_irq_t *obj, PinName pin, gpio_irq_handler handler, uint32_t id) { |
| 70 | +int gpio_irq_init(gpio_irq_t *obj, PinName pin, gpio_irq_handler handler, uint32_t id) |
| 71 | +{ |
69 | 72 | if (pin == NC) {
|
70 | 73 | return -1;
|
71 | 74 | }
|
72 |
| - |
73 |
| - irq_handler = handler; |
74 |
| - obj->ch = pin; |
75 |
| - NRF_GPIOTE->EVENTS_PORT = 0; |
76 |
| - channel_ids[pin] = id; |
77 |
| - channel_enabled[pin] = 1; |
78 |
| - NRF_GPIOTE->INTENSET = GPIOTE_INTENSET_PORT_Set<<GPIOTE_INTENSET_PORT_Pos; |
79 |
| - |
| 75 | + |
| 76 | + irq_handler = handler; |
| 77 | + obj->ch = pin; |
| 78 | + NRF_GPIOTE->EVENTS_PORT = 0; |
| 79 | + channel_ids[pin] = id; |
| 80 | + channel_enabled[pin] = 1; |
| 81 | + NRF_GPIOTE->INTENSET = GPIOTE_INTENSET_PORT_Set << GPIOTE_INTENSET_PORT_Pos; |
| 82 | + |
80 | 83 | NVIC_SetPriority(GPIOTE_IRQn, 3);
|
81 |
| - NVIC_EnableIRQ (GPIOTE_IRQn); |
| 84 | + NVIC_EnableIRQ (GPIOTE_IRQn); |
82 | 85 | return 0;
|
83 | 86 | }
|
84 | 87 |
|
85 |
| -void gpio_irq_free(gpio_irq_t *obj) { |
| 88 | +void gpio_irq_free(gpio_irq_t *obj) |
| 89 | +{ |
86 | 90 | channel_ids[obj->ch] = 0;
|
87 | 91 | }
|
88 | 92 |
|
89 |
| -void gpio_irq_set(gpio_irq_t *obj, gpio_irq_event event, uint32_t enable) { |
| 93 | +void gpio_irq_set(gpio_irq_t *obj, gpio_irq_event event, uint32_t enable) |
| 94 | +{ |
90 | 95 | NRF_GPIO->PIN_CNF[obj->ch] &= ~(GPIO_PIN_CNF_SENSE_Msk);
|
91 |
| - if(enable){ |
92 |
| - if(event == IRQ_RISE){ |
93 |
| - portRISE |= (1<<obj->ch); |
| 96 | + if (enable) { |
| 97 | + if (event == IRQ_RISE) { |
| 98 | + portRISE |= (1 << obj->ch); |
| 99 | + } else if (event == IRQ_FALL) { |
| 100 | + portFALL |= (1 << obj->ch); |
94 | 101 | }
|
95 |
| - else if(event == IRQ_FALL){ |
96 |
| - portFALL |= (1<<obj->ch); |
97 |
| - } |
98 |
| - } |
99 |
| - else{ |
100 |
| - if(event == IRQ_RISE){ |
101 |
| - portRISE &= ~(1<<obj->ch); |
| 102 | + } else { |
| 103 | + if (event == IRQ_RISE) { |
| 104 | + portRISE &= ~(1 << obj->ch); |
| 105 | + } else if (event == IRQ_FALL) { |
| 106 | + portFALL &= ~(1 << obj->ch); |
102 | 107 | }
|
103 |
| - else if(event == IRQ_FALL){ |
104 |
| - portFALL &= ~(1<<obj->ch); |
105 |
| - } |
106 |
| - |
107 |
| - } |
108 |
| - |
109 |
| - if( ( (portRISE>>obj->ch) & 1) || ( (portFALL>>obj->ch) & 1) ){ |
110 |
| - if((NRF_GPIO->IN>>obj->ch)&1){ |
111 |
| - NRF_GPIO->PIN_CNF[obj->ch] |= (GPIO_PIN_CNF_SENSE_Low << GPIO_PIN_CNF_SENSE_Pos);// | (GPIO_PIN_CNF_PULL_Disabled << GPIO_PIN_CNF_PULL_Pos); |
112 |
| - } |
113 |
| - else{ |
114 |
| - NRF_GPIO->PIN_CNF[obj->ch] |= (GPIO_PIN_CNF_SENSE_High << GPIO_PIN_CNF_SENSE_Pos) ;//| (GPIO_PIN_CNF_PULL_Disabled << GPIO_PIN_CNF_PULL_Pos); |
| 108 | + } |
| 109 | + |
| 110 | + if (((portRISE >> obj->ch) & 1) || ((portFALL >> obj->ch) & 1)) { |
| 111 | + if ((NRF_GPIO->IN >> obj->ch) & 1) { |
| 112 | + NRF_GPIO->PIN_CNF[obj->ch] |= (GPIO_PIN_CNF_SENSE_Low << GPIO_PIN_CNF_SENSE_Pos); // | (GPIO_PIN_CNF_PULL_Disabled << GPIO_PIN_CNF_PULL_Pos); |
| 113 | + } else { |
| 114 | + NRF_GPIO->PIN_CNF[obj->ch] |= (GPIO_PIN_CNF_SENSE_High << GPIO_PIN_CNF_SENSE_Pos); //| (GPIO_PIN_CNF_PULL_Disabled << GPIO_PIN_CNF_PULL_Pos); |
115 | 115 | }
|
116 | 116 | }
|
117 | 117 | }
|
118 | 118 |
|
119 |
| -void gpio_irq_enable(gpio_irq_t *obj) { |
| 119 | +void gpio_irq_enable(gpio_irq_t *obj) |
| 120 | +{ |
120 | 121 | channel_enabled[obj->ch] = 1;
|
121 | 122 | }
|
122 | 123 |
|
123 |
| -void gpio_irq_disable(gpio_irq_t *obj) { |
| 124 | +void gpio_irq_disable(gpio_irq_t *obj) |
| 125 | +{ |
124 | 126 | channel_enabled[obj->ch] = 0;
|
125 | 127 | }
|
0 commit comments