xref: /openbmc/qemu/hw/gpio/aspeed_gpio.c (revision 735d0a6c)
1 /*
2  *  ASPEED GPIO Controller
3  *
4  *  Copyright (C) 2017-2019 IBM Corp.
5  *
6  * SPDX-License-Identifier: GPL-2.0-or-later
7  */
8 
9 #include "qemu/osdep.h"
10 #include "qemu/host-utils.h"
11 #include "qemu/log.h"
12 #include "hw/gpio/aspeed_gpio.h"
13 #include "hw/misc/aspeed_scu.h"
14 #include "qapi/error.h"
15 #include "qapi/visitor.h"
16 #include "hw/irq.h"
17 #include "migration/vmstate.h"
18 #include "trace.h"
19 #include "hw/registerfields.h"
20 
21 #define GPIOS_PER_GROUP 8
22 
23 /* GPIO Source Types */
24 #define ASPEED_CMD_SRC_MASK         0x01010101
25 #define ASPEED_SOURCE_ARM           0
26 #define ASPEED_SOURCE_LPC           1
27 #define ASPEED_SOURCE_COPROCESSOR   2
28 #define ASPEED_SOURCE_RESERVED      3
29 
30 /* GPIO Interrupt Triggers */
31 /*
32  *  For each set of gpios there are three sensitivity registers that control
33  *  the interrupt trigger mode.
34  *
35  *  | 2 | 1 | 0 | trigger mode
36  *  -----------------------------
37  *  | 0 | 0 | 0 | falling-edge
38  *  | 0 | 0 | 1 | rising-edge
39  *  | 0 | 1 | 0 | level-low
40  *  | 0 | 1 | 1 | level-high
41  *  | 1 | X | X | dual-edge
42  */
43 #define ASPEED_FALLING_EDGE 0
44 #define ASPEED_RISING_EDGE  1
45 #define ASPEED_LEVEL_LOW    2
46 #define ASPEED_LEVEL_HIGH   3
47 #define ASPEED_DUAL_EDGE    4
48 
49 /* GPIO Register Address Offsets */
50 #define GPIO_ABCD_DATA_VALUE       (0x000 >> 2)
51 #define GPIO_ABCD_DIRECTION        (0x004 >> 2)
52 #define GPIO_ABCD_INT_ENABLE       (0x008 >> 2)
53 #define GPIO_ABCD_INT_SENS_0       (0x00C >> 2)
54 #define GPIO_ABCD_INT_SENS_1       (0x010 >> 2)
55 #define GPIO_ABCD_INT_SENS_2       (0x014 >> 2)
56 #define GPIO_ABCD_INT_STATUS       (0x018 >> 2)
57 #define GPIO_ABCD_RESET_TOLERANT   (0x01C >> 2)
58 #define GPIO_EFGH_DATA_VALUE       (0x020 >> 2)
59 #define GPIO_EFGH_DIRECTION        (0x024 >> 2)
60 #define GPIO_EFGH_INT_ENABLE       (0x028 >> 2)
61 #define GPIO_EFGH_INT_SENS_0       (0x02C >> 2)
62 #define GPIO_EFGH_INT_SENS_1       (0x030 >> 2)
63 #define GPIO_EFGH_INT_SENS_2       (0x034 >> 2)
64 #define GPIO_EFGH_INT_STATUS       (0x038 >> 2)
65 #define GPIO_EFGH_RESET_TOLERANT   (0x03C >> 2)
66 #define GPIO_ABCD_DEBOUNCE_1       (0x040 >> 2)
67 #define GPIO_ABCD_DEBOUNCE_2       (0x044 >> 2)
68 #define GPIO_EFGH_DEBOUNCE_1       (0x048 >> 2)
69 #define GPIO_EFGH_DEBOUNCE_2       (0x04C >> 2)
70 #define GPIO_DEBOUNCE_TIME_1       (0x050 >> 2)
71 #define GPIO_DEBOUNCE_TIME_2       (0x054 >> 2)
72 #define GPIO_DEBOUNCE_TIME_3       (0x058 >> 2)
73 #define GPIO_ABCD_COMMAND_SRC_0    (0x060 >> 2)
74 #define GPIO_ABCD_COMMAND_SRC_1    (0x064 >> 2)
75 #define GPIO_EFGH_COMMAND_SRC_0    (0x068 >> 2)
76 #define GPIO_EFGH_COMMAND_SRC_1    (0x06C >> 2)
77 #define GPIO_IJKL_DATA_VALUE       (0x070 >> 2)
78 #define GPIO_IJKL_DIRECTION        (0x074 >> 2)
79 #define GPIO_MNOP_DATA_VALUE       (0x078 >> 2)
80 #define GPIO_MNOP_DIRECTION        (0x07C >> 2)
81 #define GPIO_QRST_DATA_VALUE       (0x080 >> 2)
82 #define GPIO_QRST_DIRECTION        (0x084 >> 2)
83 #define GPIO_UVWX_DATA_VALUE       (0x088 >> 2)
84 #define GPIO_UVWX_DIRECTION        (0x08C >> 2)
85 #define GPIO_IJKL_COMMAND_SRC_0    (0x090 >> 2)
86 #define GPIO_IJKL_COMMAND_SRC_1    (0x094 >> 2)
87 #define GPIO_IJKL_INT_ENABLE       (0x098 >> 2)
88 #define GPIO_IJKL_INT_SENS_0       (0x09C >> 2)
89 #define GPIO_IJKL_INT_SENS_1       (0x0A0 >> 2)
90 #define GPIO_IJKL_INT_SENS_2       (0x0A4 >> 2)
91 #define GPIO_IJKL_INT_STATUS       (0x0A8 >> 2)
92 #define GPIO_IJKL_RESET_TOLERANT   (0x0AC >> 2)
93 #define GPIO_IJKL_DEBOUNCE_1       (0x0B0 >> 2)
94 #define GPIO_IJKL_DEBOUNCE_2       (0x0B4 >> 2)
95 #define GPIO_IJKL_INPUT_MASK       (0x0B8 >> 2)
96 #define GPIO_ABCD_DATA_READ        (0x0C0 >> 2)
97 #define GPIO_EFGH_DATA_READ        (0x0C4 >> 2)
98 #define GPIO_IJKL_DATA_READ        (0x0C8 >> 2)
99 #define GPIO_MNOP_DATA_READ        (0x0CC >> 2)
100 #define GPIO_QRST_DATA_READ        (0x0D0 >> 2)
101 #define GPIO_UVWX_DATA_READ        (0x0D4 >> 2)
102 #define GPIO_YZAAAB_DATA_READ      (0x0D8 >> 2)
103 #define GPIO_AC_DATA_READ          (0x0DC >> 2)
104 #define GPIO_MNOP_COMMAND_SRC_0    (0x0E0 >> 2)
105 #define GPIO_MNOP_COMMAND_SRC_1    (0x0E4 >> 2)
106 #define GPIO_MNOP_INT_ENABLE       (0x0E8 >> 2)
107 #define GPIO_MNOP_INT_SENS_0       (0x0EC >> 2)
108 #define GPIO_MNOP_INT_SENS_1       (0x0F0 >> 2)
109 #define GPIO_MNOP_INT_SENS_2       (0x0F4 >> 2)
110 #define GPIO_MNOP_INT_STATUS       (0x0F8 >> 2)
111 #define GPIO_MNOP_RESET_TOLERANT   (0x0FC >> 2)
112 #define GPIO_MNOP_DEBOUNCE_1       (0x100 >> 2)
113 #define GPIO_MNOP_DEBOUNCE_2       (0x104 >> 2)
114 #define GPIO_MNOP_INPUT_MASK       (0x108 >> 2)
115 #define GPIO_QRST_COMMAND_SRC_0    (0x110 >> 2)
116 #define GPIO_QRST_COMMAND_SRC_1    (0x114 >> 2)
117 #define GPIO_QRST_INT_ENABLE       (0x118 >> 2)
118 #define GPIO_QRST_INT_SENS_0       (0x11C >> 2)
119 #define GPIO_QRST_INT_SENS_1       (0x120 >> 2)
120 #define GPIO_QRST_INT_SENS_2       (0x124 >> 2)
121 #define GPIO_QRST_INT_STATUS       (0x128 >> 2)
122 #define GPIO_QRST_RESET_TOLERANT   (0x12C >> 2)
123 #define GPIO_QRST_DEBOUNCE_1       (0x130 >> 2)
124 #define GPIO_QRST_DEBOUNCE_2       (0x134 >> 2)
125 #define GPIO_QRST_INPUT_MASK       (0x138 >> 2)
126 #define GPIO_UVWX_COMMAND_SRC_0    (0x140 >> 2)
127 #define GPIO_UVWX_COMMAND_SRC_1    (0x144 >> 2)
128 #define GPIO_UVWX_INT_ENABLE       (0x148 >> 2)
129 #define GPIO_UVWX_INT_SENS_0       (0x14C >> 2)
130 #define GPIO_UVWX_INT_SENS_1       (0x150 >> 2)
131 #define GPIO_UVWX_INT_SENS_2       (0x154 >> 2)
132 #define GPIO_UVWX_INT_STATUS       (0x158 >> 2)
133 #define GPIO_UVWX_RESET_TOLERANT   (0x15C >> 2)
134 #define GPIO_UVWX_DEBOUNCE_1       (0x160 >> 2)
135 #define GPIO_UVWX_DEBOUNCE_2       (0x164 >> 2)
136 #define GPIO_UVWX_INPUT_MASK       (0x168 >> 2)
137 #define GPIO_YZAAAB_COMMAND_SRC_0  (0x170 >> 2)
138 #define GPIO_YZAAAB_COMMAND_SRC_1  (0x174 >> 2)
139 #define GPIO_YZAAAB_INT_ENABLE     (0x178 >> 2)
140 #define GPIO_YZAAAB_INT_SENS_0     (0x17C >> 2)
141 #define GPIO_YZAAAB_INT_SENS_1     (0x180 >> 2)
142 #define GPIO_YZAAAB_INT_SENS_2     (0x184 >> 2)
143 #define GPIO_YZAAAB_INT_STATUS     (0x188 >> 2)
144 #define GPIO_YZAAAB_RESET_TOLERANT (0x18C >> 2)
145 #define GPIO_YZAAAB_DEBOUNCE_1     (0x190 >> 2)
146 #define GPIO_YZAAAB_DEBOUNCE_2     (0x194 >> 2)
147 #define GPIO_YZAAAB_INPUT_MASK     (0x198 >> 2)
148 #define GPIO_AC_COMMAND_SRC_0      (0x1A0 >> 2)
149 #define GPIO_AC_COMMAND_SRC_1      (0x1A4 >> 2)
150 #define GPIO_AC_INT_ENABLE         (0x1A8 >> 2)
151 #define GPIO_AC_INT_SENS_0         (0x1AC >> 2)
152 #define GPIO_AC_INT_SENS_1         (0x1B0 >> 2)
153 #define GPIO_AC_INT_SENS_2         (0x1B4 >> 2)
154 #define GPIO_AC_INT_STATUS         (0x1B8 >> 2)
155 #define GPIO_AC_RESET_TOLERANT     (0x1BC >> 2)
156 #define GPIO_AC_DEBOUNCE_1         (0x1C0 >> 2)
157 #define GPIO_AC_DEBOUNCE_2         (0x1C4 >> 2)
158 #define GPIO_AC_INPUT_MASK         (0x1C8 >> 2)
159 #define GPIO_ABCD_INPUT_MASK       (0x1D0 >> 2)
160 #define GPIO_EFGH_INPUT_MASK       (0x1D4 >> 2)
161 #define GPIO_YZAAAB_DATA_VALUE     (0x1E0 >> 2)
162 #define GPIO_YZAAAB_DIRECTION      (0x1E4 >> 2)
163 #define GPIO_AC_DATA_VALUE         (0x1E8 >> 2)
164 #define GPIO_AC_DIRECTION          (0x1EC >> 2)
165 #define GPIO_3_3V_MEM_SIZE         0x1F0
166 #define GPIO_3_3V_REG_ARRAY_SIZE   (GPIO_3_3V_MEM_SIZE >> 2)
167 
168 /* AST2600 only - 1.8V gpios */
169 /*
170  * The AST2600 two copies of the GPIO controller: the same 3.3V gpios as the
171  * AST2400 (memory offsets 0x0-0x198) and a second controller with 1.8V gpios
172  * (memory offsets 0x800-0x9D4).
173  */
174 #define GPIO_1_8V_ABCD_DATA_VALUE     (0x000 >> 2)
175 #define GPIO_1_8V_ABCD_DIRECTION      (0x004 >> 2)
176 #define GPIO_1_8V_ABCD_INT_ENABLE     (0x008 >> 2)
177 #define GPIO_1_8V_ABCD_INT_SENS_0     (0x00C >> 2)
178 #define GPIO_1_8V_ABCD_INT_SENS_1     (0x010 >> 2)
179 #define GPIO_1_8V_ABCD_INT_SENS_2     (0x014 >> 2)
180 #define GPIO_1_8V_ABCD_INT_STATUS     (0x018 >> 2)
181 #define GPIO_1_8V_ABCD_RESET_TOLERANT (0x01C >> 2)
182 #define GPIO_1_8V_E_DATA_VALUE        (0x020 >> 2)
183 #define GPIO_1_8V_E_DIRECTION         (0x024 >> 2)
184 #define GPIO_1_8V_E_INT_ENABLE        (0x028 >> 2)
185 #define GPIO_1_8V_E_INT_SENS_0        (0x02C >> 2)
186 #define GPIO_1_8V_E_INT_SENS_1        (0x030 >> 2)
187 #define GPIO_1_8V_E_INT_SENS_2        (0x034 >> 2)
188 #define GPIO_1_8V_E_INT_STATUS        (0x038 >> 2)
189 #define GPIO_1_8V_E_RESET_TOLERANT    (0x03C >> 2)
190 #define GPIO_1_8V_ABCD_DEBOUNCE_1     (0x040 >> 2)
191 #define GPIO_1_8V_ABCD_DEBOUNCE_2     (0x044 >> 2)
192 #define GPIO_1_8V_E_DEBOUNCE_1        (0x048 >> 2)
193 #define GPIO_1_8V_E_DEBOUNCE_2        (0x04C >> 2)
194 #define GPIO_1_8V_DEBOUNCE_TIME_1     (0x050 >> 2)
195 #define GPIO_1_8V_DEBOUNCE_TIME_2     (0x054 >> 2)
196 #define GPIO_1_8V_DEBOUNCE_TIME_3     (0x058 >> 2)
197 #define GPIO_1_8V_ABCD_COMMAND_SRC_0  (0x060 >> 2)
198 #define GPIO_1_8V_ABCD_COMMAND_SRC_1  (0x064 >> 2)
199 #define GPIO_1_8V_E_COMMAND_SRC_0     (0x068 >> 2)
200 #define GPIO_1_8V_E_COMMAND_SRC_1     (0x06C >> 2)
201 #define GPIO_1_8V_ABCD_DATA_READ      (0x0C0 >> 2)
202 #define GPIO_1_8V_E_DATA_READ         (0x0C4 >> 2)
203 #define GPIO_1_8V_ABCD_INPUT_MASK     (0x1D0 >> 2)
204 #define GPIO_1_8V_E_INPUT_MASK        (0x1D4 >> 2)
205 #define GPIO_1_8V_MEM_SIZE            0x1D8
206 #define GPIO_1_8V_REG_ARRAY_SIZE      (GPIO_1_8V_MEM_SIZE >> 2)
207 
208 /*
209  * GPIO index mode support
210  * It only supports write operation
211  */
212 REG32(GPIO_INDEX_REG, 0x2AC)
213     FIELD(GPIO_INDEX_REG, NUMBER, 0, 8)
214     FIELD(GPIO_INDEX_REG, COMMAND, 12, 1)
215     FIELD(GPIO_INDEX_REG, TYPE, 16, 4)
216     FIELD(GPIO_INDEX_REG, DATA_VALUE, 20, 1)
217     FIELD(GPIO_INDEX_REG, DIRECTION, 20, 1)
218     FIELD(GPIO_INDEX_REG, INT_ENABLE, 20, 1)
219     FIELD(GPIO_INDEX_REG, INT_SENS_0, 21, 1)
220     FIELD(GPIO_INDEX_REG, INT_SENS_1, 22, 1)
221     FIELD(GPIO_INDEX_REG, INT_SENS_2, 23, 1)
222     FIELD(GPIO_INDEX_REG, INT_STATUS, 24, 1)
223     FIELD(GPIO_INDEX_REG, DEBOUNCE_1, 20, 1)
224     FIELD(GPIO_INDEX_REG, DEBOUNCE_2, 21, 1)
225     FIELD(GPIO_INDEX_REG, RESET_TOLERANT, 20, 1)
226     FIELD(GPIO_INDEX_REG, COMMAND_SRC_0, 20, 1)
227     FIELD(GPIO_INDEX_REG, COMMAND_SRC_1, 21, 1)
228     FIELD(GPIO_INDEX_REG, INPUT_MASK, 20, 1)
229 
aspeed_evaluate_irq(GPIOSets * regs,int gpio_prev_high,int gpio)230 static int aspeed_evaluate_irq(GPIOSets *regs, int gpio_prev_high, int gpio)
231 {
232     uint32_t falling_edge = 0, rising_edge = 0;
233     uint32_t int_trigger = extract32(regs->int_sens_0, gpio, 1)
234                            | extract32(regs->int_sens_1, gpio, 1) << 1
235                            | extract32(regs->int_sens_2, gpio, 1) << 2;
236     uint32_t gpio_curr_high = extract32(regs->data_value, gpio, 1);
237     uint32_t gpio_int_enabled = extract32(regs->int_enable, gpio, 1);
238 
239     if (!gpio_int_enabled) {
240         return 0;
241     }
242 
243     /* Detect edges */
244     if (gpio_curr_high && !gpio_prev_high) {
245         rising_edge = 1;
246     } else if (!gpio_curr_high && gpio_prev_high) {
247         falling_edge = 1;
248     }
249 
250     if (((int_trigger == ASPEED_FALLING_EDGE)  && falling_edge)  ||
251         ((int_trigger == ASPEED_RISING_EDGE)  && rising_edge)    ||
252         ((int_trigger == ASPEED_LEVEL_LOW)  && !gpio_curr_high)  ||
253         ((int_trigger == ASPEED_LEVEL_HIGH)  && gpio_curr_high)  ||
254         ((int_trigger >= ASPEED_DUAL_EDGE)  && (rising_edge || falling_edge)))
255     {
256         regs->int_status = deposit32(regs->int_status, gpio, 1, 1);
257         return 1;
258     }
259     return 0;
260 }
261 
262 #define nested_struct_index(ta, pa, m, tb, pb) \
263         (pb - ((tb *)(((char *)pa) + offsetof(ta, m))))
264 
aspeed_gpio_set_idx(AspeedGPIOState * s,GPIOSets * regs)265 static ptrdiff_t aspeed_gpio_set_idx(AspeedGPIOState *s, GPIOSets *regs)
266 {
267     return nested_struct_index(AspeedGPIOState, s, sets, GPIOSets, regs);
268 }
269 
aspeed_gpio_update(AspeedGPIOState * s,GPIOSets * regs,uint32_t value,uint32_t mode_mask)270 static void aspeed_gpio_update(AspeedGPIOState *s, GPIOSets *regs,
271                                uint32_t value, uint32_t mode_mask)
272 {
273     uint32_t input_mask = regs->input_mask;
274     uint32_t direction = regs->direction;
275     uint32_t old = regs->data_value;
276     uint32_t new = value;
277     uint32_t diff;
278     int gpio;
279 
280     diff = (old ^ new);
281     diff &= mode_mask;
282     if (diff) {
283         for (gpio = 0; gpio < ASPEED_GPIOS_PER_SET; gpio++) {
284             uint32_t mask = 1U << gpio;
285 
286             /* If the gpio needs to be updated... */
287             if (!(diff & mask)) {
288                 continue;
289             }
290 
291             /* ...and we're output or not input-masked... */
292             if (!(direction & mask) && (input_mask & mask)) {
293                 continue;
294             }
295 
296             /* ...then update the state. */
297             if (mask & new) {
298                 regs->data_value |= mask;
299             } else {
300                 regs->data_value &= ~mask;
301             }
302 
303             /* If the gpio is set to output... */
304             if (direction & mask) {
305                 /* ...trigger the line-state IRQ */
306                 ptrdiff_t set = aspeed_gpio_set_idx(s, regs);
307                 qemu_set_irq(s->gpios[set][gpio], !!(new & mask));
308             } else {
309                 /* ...otherwise if we meet the line's current IRQ policy... */
310                 if (aspeed_evaluate_irq(regs, old & mask, gpio)) {
311                     /* ...trigger the VIC IRQ */
312                     s->pending++;
313                 }
314             }
315         }
316     }
317     qemu_set_irq(s->irq, !!(s->pending));
318 }
319 
aspeed_gpio_get_pin_level(AspeedGPIOState * s,uint32_t set_idx,uint32_t pin)320 static bool aspeed_gpio_get_pin_level(AspeedGPIOState *s, uint32_t set_idx,
321                                       uint32_t pin)
322 {
323     uint32_t reg_val;
324     uint32_t pin_mask = 1 << pin;
325 
326     reg_val = s->sets[set_idx].data_value;
327 
328     return !!(reg_val & pin_mask);
329 }
330 
aspeed_gpio_set_pin_level(AspeedGPIOState * s,uint32_t set_idx,uint32_t pin,bool level)331 static void aspeed_gpio_set_pin_level(AspeedGPIOState *s, uint32_t set_idx,
332                                       uint32_t pin, bool level)
333 {
334     uint32_t value = s->sets[set_idx].data_value;
335     uint32_t pin_mask = 1 << pin;
336 
337     if (level) {
338         value |= pin_mask;
339     } else {
340         value &= ~pin_mask;
341     }
342 
343     aspeed_gpio_update(s, &s->sets[set_idx], value, ~s->sets[set_idx].direction);
344 }
345 
346 /*
347  *  | src_1 | src_2 |  source     |
348  *  |-----------------------------|
349  *  |   0   |   0   |  ARM        |
350  *  |   0   |   1   |  LPC        |
351  *  |   1   |   0   |  Coprocessor|
352  *  |   1   |   1   |  Reserved   |
353  *
354  *  Once the source of a set is programmed, corresponding bits in the
355  *  data_value, direction, interrupt [enable, sens[0-2]], reset_tol and
356  *  debounce registers can only be written by the source.
357  *
358  *  Source is ARM by default
359  *  only bits 24, 16, 8, and 0 can be set
360  *
361  *  we don't currently have a model for the LPC or Coprocessor
362  */
update_value_control_source(GPIOSets * regs,uint32_t old_value,uint32_t value)363 static uint32_t update_value_control_source(GPIOSets *regs, uint32_t old_value,
364                                             uint32_t value)
365 {
366     int i;
367     int cmd_source;
368 
369     /* assume the source is always ARM for now */
370     int source = ASPEED_SOURCE_ARM;
371 
372     uint32_t new_value = 0;
373 
374     /* for each group in set */
375     for (i = 0; i < ASPEED_GPIOS_PER_SET; i += GPIOS_PER_GROUP) {
376         cmd_source = extract32(regs->cmd_source_0, i, 1)
377                 | (extract32(regs->cmd_source_1, i, 1) << 1);
378 
379         if (source == cmd_source) {
380             new_value |= (0xff << i) & value;
381         } else {
382             new_value |= (0xff << i) & old_value;
383         }
384     }
385     return new_value;
386 }
387 
388 static const AspeedGPIOReg aspeed_3_3v_gpios[GPIO_3_3V_REG_ARRAY_SIZE] = {
389     /* Set ABCD */
390     [GPIO_ABCD_DATA_VALUE] =     { 0, gpio_reg_data_value },
391     [GPIO_ABCD_DIRECTION] =      { 0, gpio_reg_direction },
392     [GPIO_ABCD_INT_ENABLE] =     { 0, gpio_reg_int_enable },
393     [GPIO_ABCD_INT_SENS_0] =     { 0, gpio_reg_int_sens_0 },
394     [GPIO_ABCD_INT_SENS_1] =     { 0, gpio_reg_int_sens_1 },
395     [GPIO_ABCD_INT_SENS_2] =     { 0, gpio_reg_int_sens_2 },
396     [GPIO_ABCD_INT_STATUS] =     { 0, gpio_reg_int_status },
397     [GPIO_ABCD_RESET_TOLERANT] = { 0, gpio_reg_reset_tolerant },
398     [GPIO_ABCD_DEBOUNCE_1] =     { 0, gpio_reg_debounce_1 },
399     [GPIO_ABCD_DEBOUNCE_2] =     { 0, gpio_reg_debounce_2 },
400     [GPIO_ABCD_COMMAND_SRC_0] =  { 0, gpio_reg_cmd_source_0 },
401     [GPIO_ABCD_COMMAND_SRC_1] =  { 0, gpio_reg_cmd_source_1 },
402     [GPIO_ABCD_DATA_READ] =      { 0, gpio_reg_data_read },
403     [GPIO_ABCD_INPUT_MASK] =     { 0, gpio_reg_input_mask },
404     /* Set EFGH */
405     [GPIO_EFGH_DATA_VALUE] =     { 1, gpio_reg_data_value },
406     [GPIO_EFGH_DIRECTION] =      { 1, gpio_reg_direction },
407     [GPIO_EFGH_INT_ENABLE] =     { 1, gpio_reg_int_enable },
408     [GPIO_EFGH_INT_SENS_0] =     { 1, gpio_reg_int_sens_0 },
409     [GPIO_EFGH_INT_SENS_1] =     { 1, gpio_reg_int_sens_1 },
410     [GPIO_EFGH_INT_SENS_2] =     { 1, gpio_reg_int_sens_2 },
411     [GPIO_EFGH_INT_STATUS] =     { 1, gpio_reg_int_status },
412     [GPIO_EFGH_RESET_TOLERANT] = { 1, gpio_reg_reset_tolerant },
413     [GPIO_EFGH_DEBOUNCE_1] =     { 1, gpio_reg_debounce_1 },
414     [GPIO_EFGH_DEBOUNCE_2] =     { 1, gpio_reg_debounce_2 },
415     [GPIO_EFGH_COMMAND_SRC_0] =  { 1, gpio_reg_cmd_source_0 },
416     [GPIO_EFGH_COMMAND_SRC_1] =  { 1, gpio_reg_cmd_source_1 },
417     [GPIO_EFGH_DATA_READ] =      { 1, gpio_reg_data_read },
418     [GPIO_EFGH_INPUT_MASK] =     { 1, gpio_reg_input_mask },
419     /* Set IJKL */
420     [GPIO_IJKL_DATA_VALUE] =     { 2, gpio_reg_data_value },
421     [GPIO_IJKL_DIRECTION] =      { 2, gpio_reg_direction },
422     [GPIO_IJKL_INT_ENABLE] =     { 2, gpio_reg_int_enable },
423     [GPIO_IJKL_INT_SENS_0] =     { 2, gpio_reg_int_sens_0 },
424     [GPIO_IJKL_INT_SENS_1] =     { 2, gpio_reg_int_sens_1 },
425     [GPIO_IJKL_INT_SENS_2] =     { 2, gpio_reg_int_sens_2 },
426     [GPIO_IJKL_INT_STATUS] =     { 2, gpio_reg_int_status },
427     [GPIO_IJKL_RESET_TOLERANT] = { 2, gpio_reg_reset_tolerant },
428     [GPIO_IJKL_DEBOUNCE_1] =     { 2, gpio_reg_debounce_1 },
429     [GPIO_IJKL_DEBOUNCE_2] =     { 2, gpio_reg_debounce_2 },
430     [GPIO_IJKL_COMMAND_SRC_0] =  { 2, gpio_reg_cmd_source_0 },
431     [GPIO_IJKL_COMMAND_SRC_1] =  { 2, gpio_reg_cmd_source_1 },
432     [GPIO_IJKL_DATA_READ] =      { 2, gpio_reg_data_read },
433     [GPIO_IJKL_INPUT_MASK] =     { 2, gpio_reg_input_mask },
434     /* Set MNOP */
435     [GPIO_MNOP_DATA_VALUE] =     { 3, gpio_reg_data_value },
436     [GPIO_MNOP_DIRECTION] =      { 3, gpio_reg_direction },
437     [GPIO_MNOP_INT_ENABLE] =     { 3, gpio_reg_int_enable },
438     [GPIO_MNOP_INT_SENS_0] =     { 3, gpio_reg_int_sens_0 },
439     [GPIO_MNOP_INT_SENS_1] =     { 3, gpio_reg_int_sens_1 },
440     [GPIO_MNOP_INT_SENS_2] =     { 3, gpio_reg_int_sens_2 },
441     [GPIO_MNOP_INT_STATUS] =     { 3, gpio_reg_int_status },
442     [GPIO_MNOP_RESET_TOLERANT] = { 3, gpio_reg_reset_tolerant },
443     [GPIO_MNOP_DEBOUNCE_1] =     { 3, gpio_reg_debounce_1 },
444     [GPIO_MNOP_DEBOUNCE_2] =     { 3, gpio_reg_debounce_2 },
445     [GPIO_MNOP_COMMAND_SRC_0] =  { 3, gpio_reg_cmd_source_0 },
446     [GPIO_MNOP_COMMAND_SRC_1] =  { 3, gpio_reg_cmd_source_1 },
447     [GPIO_MNOP_DATA_READ] =      { 3, gpio_reg_data_read },
448     [GPIO_MNOP_INPUT_MASK] =     { 3, gpio_reg_input_mask },
449     /* Set QRST */
450     [GPIO_QRST_DATA_VALUE] =     { 4, gpio_reg_data_value },
451     [GPIO_QRST_DIRECTION] =      { 4, gpio_reg_direction },
452     [GPIO_QRST_INT_ENABLE] =     { 4, gpio_reg_int_enable },
453     [GPIO_QRST_INT_SENS_0] =     { 4, gpio_reg_int_sens_0 },
454     [GPIO_QRST_INT_SENS_1] =     { 4, gpio_reg_int_sens_1 },
455     [GPIO_QRST_INT_SENS_2] =     { 4, gpio_reg_int_sens_2 },
456     [GPIO_QRST_INT_STATUS] =     { 4, gpio_reg_int_status },
457     [GPIO_QRST_RESET_TOLERANT] = { 4, gpio_reg_reset_tolerant },
458     [GPIO_QRST_DEBOUNCE_1] =     { 4, gpio_reg_debounce_1 },
459     [GPIO_QRST_DEBOUNCE_2] =     { 4, gpio_reg_debounce_2 },
460     [GPIO_QRST_COMMAND_SRC_0] =  { 4, gpio_reg_cmd_source_0 },
461     [GPIO_QRST_COMMAND_SRC_1] =  { 4, gpio_reg_cmd_source_1 },
462     [GPIO_QRST_DATA_READ] =      { 4, gpio_reg_data_read },
463     [GPIO_QRST_INPUT_MASK] =     { 4, gpio_reg_input_mask },
464     /* Set UVWX */
465     [GPIO_UVWX_DATA_VALUE] =     { 5, gpio_reg_data_value },
466     [GPIO_UVWX_DIRECTION] =      { 5, gpio_reg_direction },
467     [GPIO_UVWX_INT_ENABLE] =     { 5, gpio_reg_int_enable },
468     [GPIO_UVWX_INT_SENS_0] =     { 5, gpio_reg_int_sens_0 },
469     [GPIO_UVWX_INT_SENS_1] =     { 5, gpio_reg_int_sens_1 },
470     [GPIO_UVWX_INT_SENS_2] =     { 5, gpio_reg_int_sens_2 },
471     [GPIO_UVWX_INT_STATUS] =     { 5, gpio_reg_int_status },
472     [GPIO_UVWX_RESET_TOLERANT] = { 5, gpio_reg_reset_tolerant },
473     [GPIO_UVWX_DEBOUNCE_1] =     { 5, gpio_reg_debounce_1 },
474     [GPIO_UVWX_DEBOUNCE_2] =     { 5, gpio_reg_debounce_2 },
475     [GPIO_UVWX_COMMAND_SRC_0] =  { 5, gpio_reg_cmd_source_0 },
476     [GPIO_UVWX_COMMAND_SRC_1] =  { 5, gpio_reg_cmd_source_1 },
477     [GPIO_UVWX_DATA_READ] =      { 5, gpio_reg_data_read },
478     [GPIO_UVWX_INPUT_MASK] =     { 5, gpio_reg_input_mask },
479     /* Set YZAAAB */
480     [GPIO_YZAAAB_DATA_VALUE] =     { 6, gpio_reg_data_value },
481     [GPIO_YZAAAB_DIRECTION] =      { 6, gpio_reg_direction },
482     [GPIO_YZAAAB_INT_ENABLE] =     { 6, gpio_reg_int_enable },
483     [GPIO_YZAAAB_INT_SENS_0] =     { 6, gpio_reg_int_sens_0 },
484     [GPIO_YZAAAB_INT_SENS_1] =     { 6, gpio_reg_int_sens_1 },
485     [GPIO_YZAAAB_INT_SENS_2] =     { 6, gpio_reg_int_sens_2 },
486     [GPIO_YZAAAB_INT_STATUS] =     { 6, gpio_reg_int_status },
487     [GPIO_YZAAAB_RESET_TOLERANT] = { 6, gpio_reg_reset_tolerant },
488     [GPIO_YZAAAB_DEBOUNCE_1] =     { 6, gpio_reg_debounce_1 },
489     [GPIO_YZAAAB_DEBOUNCE_2] =     { 6, gpio_reg_debounce_2 },
490     [GPIO_YZAAAB_COMMAND_SRC_0] =  { 6, gpio_reg_cmd_source_0 },
491     [GPIO_YZAAAB_COMMAND_SRC_1] =  { 6, gpio_reg_cmd_source_1 },
492     [GPIO_YZAAAB_DATA_READ] =      { 6, gpio_reg_data_read },
493     [GPIO_YZAAAB_INPUT_MASK] =     { 6, gpio_reg_input_mask },
494     /* Set AC  (ast2500 only) */
495     [GPIO_AC_DATA_VALUE] =         { 7, gpio_reg_data_value },
496     [GPIO_AC_DIRECTION] =          { 7, gpio_reg_direction },
497     [GPIO_AC_INT_ENABLE] =         { 7, gpio_reg_int_enable },
498     [GPIO_AC_INT_SENS_0] =         { 7, gpio_reg_int_sens_0 },
499     [GPIO_AC_INT_SENS_1] =         { 7, gpio_reg_int_sens_1 },
500     [GPIO_AC_INT_SENS_2] =         { 7, gpio_reg_int_sens_2 },
501     [GPIO_AC_INT_STATUS] =         { 7, gpio_reg_int_status },
502     [GPIO_AC_RESET_TOLERANT] =     { 7, gpio_reg_reset_tolerant },
503     [GPIO_AC_DEBOUNCE_1] =         { 7, gpio_reg_debounce_1 },
504     [GPIO_AC_DEBOUNCE_2] =         { 7, gpio_reg_debounce_2 },
505     [GPIO_AC_COMMAND_SRC_0] =      { 7, gpio_reg_cmd_source_0 },
506     [GPIO_AC_COMMAND_SRC_1] =      { 7, gpio_reg_cmd_source_1 },
507     [GPIO_AC_DATA_READ] =          { 7, gpio_reg_data_read },
508     [GPIO_AC_INPUT_MASK] =         { 7, gpio_reg_input_mask },
509 };
510 
511 static const AspeedGPIOReg aspeed_1_8v_gpios[GPIO_1_8V_REG_ARRAY_SIZE] = {
512     /* 1.8V Set ABCD */
513     [GPIO_1_8V_ABCD_DATA_VALUE] =     {0, gpio_reg_data_value},
514     [GPIO_1_8V_ABCD_DIRECTION] =      {0, gpio_reg_direction},
515     [GPIO_1_8V_ABCD_INT_ENABLE] =     {0, gpio_reg_int_enable},
516     [GPIO_1_8V_ABCD_INT_SENS_0] =     {0, gpio_reg_int_sens_0},
517     [GPIO_1_8V_ABCD_INT_SENS_1] =     {0, gpio_reg_int_sens_1},
518     [GPIO_1_8V_ABCD_INT_SENS_2] =     {0, gpio_reg_int_sens_2},
519     [GPIO_1_8V_ABCD_INT_STATUS] =     {0, gpio_reg_int_status},
520     [GPIO_1_8V_ABCD_RESET_TOLERANT] = {0, gpio_reg_reset_tolerant},
521     [GPIO_1_8V_ABCD_DEBOUNCE_1] =     {0, gpio_reg_debounce_1},
522     [GPIO_1_8V_ABCD_DEBOUNCE_2] =     {0, gpio_reg_debounce_2},
523     [GPIO_1_8V_ABCD_COMMAND_SRC_0] =  {0, gpio_reg_cmd_source_0},
524     [GPIO_1_8V_ABCD_COMMAND_SRC_1] =  {0, gpio_reg_cmd_source_1},
525     [GPIO_1_8V_ABCD_DATA_READ] =      {0, gpio_reg_data_read},
526     [GPIO_1_8V_ABCD_INPUT_MASK] =     {0, gpio_reg_input_mask},
527     /* 1.8V Set E */
528     [GPIO_1_8V_E_DATA_VALUE] =     {1, gpio_reg_data_value},
529     [GPIO_1_8V_E_DIRECTION] =      {1, gpio_reg_direction},
530     [GPIO_1_8V_E_INT_ENABLE] =     {1, gpio_reg_int_enable},
531     [GPIO_1_8V_E_INT_SENS_0] =     {1, gpio_reg_int_sens_0},
532     [GPIO_1_8V_E_INT_SENS_1] =     {1, gpio_reg_int_sens_1},
533     [GPIO_1_8V_E_INT_SENS_2] =     {1, gpio_reg_int_sens_2},
534     [GPIO_1_8V_E_INT_STATUS] =     {1, gpio_reg_int_status},
535     [GPIO_1_8V_E_RESET_TOLERANT] = {1, gpio_reg_reset_tolerant},
536     [GPIO_1_8V_E_DEBOUNCE_1] =     {1, gpio_reg_debounce_1},
537     [GPIO_1_8V_E_DEBOUNCE_2] =     {1, gpio_reg_debounce_2},
538     [GPIO_1_8V_E_COMMAND_SRC_0] =  {1, gpio_reg_cmd_source_0},
539     [GPIO_1_8V_E_COMMAND_SRC_1] =  {1, gpio_reg_cmd_source_1},
540     [GPIO_1_8V_E_DATA_READ] =      {1, gpio_reg_data_read},
541     [GPIO_1_8V_E_INPUT_MASK] =     {1, gpio_reg_input_mask},
542 };
543 
aspeed_gpio_read(void * opaque,hwaddr offset,uint32_t size)544 static uint64_t aspeed_gpio_read(void *opaque, hwaddr offset, uint32_t size)
545 {
546     AspeedGPIOState *s = ASPEED_GPIO(opaque);
547     AspeedGPIOClass *agc = ASPEED_GPIO_GET_CLASS(s);
548     uint64_t idx = -1;
549     const AspeedGPIOReg *reg;
550     GPIOSets *set;
551     uint32_t value = 0;
552     uint64_t debounce_value;
553 
554     idx = offset >> 2;
555     if (idx >= GPIO_DEBOUNCE_TIME_1 && idx <= GPIO_DEBOUNCE_TIME_3) {
556         idx -= GPIO_DEBOUNCE_TIME_1;
557         debounce_value = (uint64_t) s->debounce_regs[idx];
558         trace_aspeed_gpio_read(offset, debounce_value);
559         return debounce_value;
560     }
561 
562     if (idx >= agc->reg_table_count) {
563         qemu_log_mask(LOG_GUEST_ERROR, "%s: idx 0x%" PRIx64 " out of bounds\n",
564                       __func__, idx);
565         return 0;
566     }
567 
568     reg = &agc->reg_table[idx];
569     if (reg->set_idx >= agc->nr_gpio_sets) {
570         qemu_log_mask(LOG_GUEST_ERROR, "%s: no getter for offset 0x%"
571                       PRIx64"\n", __func__, offset);
572         return 0;
573     }
574 
575     set = &s->sets[reg->set_idx];
576     switch (reg->type) {
577     case gpio_reg_data_value:
578         value = set->data_value;
579         break;
580     case gpio_reg_direction:
581         value = set->direction;
582         break;
583     case gpio_reg_int_enable:
584         value = set->int_enable;
585         break;
586     case gpio_reg_int_sens_0:
587         value = set->int_sens_0;
588         break;
589     case gpio_reg_int_sens_1:
590         value = set->int_sens_1;
591         break;
592     case gpio_reg_int_sens_2:
593         value = set->int_sens_2;
594         break;
595     case gpio_reg_int_status:
596         value = set->int_status;
597         break;
598     case gpio_reg_reset_tolerant:
599         value = set->reset_tol;
600         break;
601     case gpio_reg_debounce_1:
602         value = set->debounce_1;
603         break;
604     case gpio_reg_debounce_2:
605         value = set->debounce_2;
606         break;
607     case gpio_reg_cmd_source_0:
608         value = set->cmd_source_0;
609         break;
610     case gpio_reg_cmd_source_1:
611         value = set->cmd_source_1;
612         break;
613     case gpio_reg_data_read:
614         value = set->data_read;
615         break;
616     case gpio_reg_input_mask:
617         value = set->input_mask;
618         break;
619     default:
620         qemu_log_mask(LOG_GUEST_ERROR, "%s: no getter for offset 0x%"
621                       PRIx64"\n", __func__, offset);
622         return 0;
623     }
624 
625     trace_aspeed_gpio_read(offset, value);
626     return value;
627 }
628 
aspeed_gpio_write_index_mode(void * opaque,hwaddr offset,uint64_t data,uint32_t size)629 static void aspeed_gpio_write_index_mode(void *opaque, hwaddr offset,
630                                                 uint64_t data, uint32_t size)
631 {
632 
633     AspeedGPIOState *s = ASPEED_GPIO(opaque);
634     AspeedGPIOClass *agc = ASPEED_GPIO_GET_CLASS(s);
635     const GPIOSetProperties *props;
636     GPIOSets *set;
637     uint32_t reg_idx_number = FIELD_EX32(data, GPIO_INDEX_REG, NUMBER);
638     uint32_t reg_idx_type = FIELD_EX32(data, GPIO_INDEX_REG, TYPE);
639     uint32_t reg_idx_command = FIELD_EX32(data, GPIO_INDEX_REG, COMMAND);
640     uint32_t set_idx = reg_idx_number / ASPEED_GPIOS_PER_SET;
641     uint32_t pin_idx = reg_idx_number % ASPEED_GPIOS_PER_SET;
642     uint32_t group_idx = pin_idx / GPIOS_PER_GROUP;
643     uint32_t reg_value = 0;
644     uint32_t cleared;
645 
646     set = &s->sets[set_idx];
647     props = &agc->props[set_idx];
648 
649     if (reg_idx_command)
650         qemu_log_mask(LOG_GUEST_ERROR, "%s: offset 0x%" PRIx64 "data 0x%"
651             PRIx64 "index mode wrong command 0x%x\n",
652             __func__, offset, data, reg_idx_command);
653 
654     switch (reg_idx_type) {
655     case gpio_reg_idx_data:
656         reg_value = set->data_read;
657         reg_value = deposit32(reg_value, pin_idx, 1,
658                               FIELD_EX32(data, GPIO_INDEX_REG, DATA_VALUE));
659         reg_value &= props->output;
660         reg_value = update_value_control_source(set, set->data_value,
661                                                 reg_value);
662         set->data_read = reg_value;
663         aspeed_gpio_update(s, set, reg_value, set->direction);
664         return;
665     case gpio_reg_idx_direction:
666         reg_value = set->direction;
667         reg_value = deposit32(reg_value, pin_idx, 1,
668                               FIELD_EX32(data, GPIO_INDEX_REG, DIRECTION));
669         /*
670          *   where data is the value attempted to be written to the pin:
671          *    pin type      | input mask | output mask | expected value
672          *    ------------------------------------------------------------
673          *   bidirectional  |   1       |   1        |  data
674          *   input only     |   1       |   0        |   0
675          *   output only    |   0       |   1        |   1
676          *   no pin         |   0       |   0        |   0
677          *
678          *  which is captured by:
679          *  data = ( data | ~input) & output;
680          */
681         reg_value = (reg_value | ~props->input) & props->output;
682         set->direction = update_value_control_source(set, set->direction,
683                                                      reg_value);
684         break;
685     case gpio_reg_idx_interrupt:
686         reg_value = set->int_enable;
687         reg_value = deposit32(reg_value, pin_idx, 1,
688                               FIELD_EX32(data, GPIO_INDEX_REG, INT_ENABLE));
689         set->int_enable = update_value_control_source(set, set->int_enable,
690                                                       reg_value);
691         reg_value = set->int_sens_0;
692         reg_value = deposit32(reg_value, pin_idx, 1,
693                               FIELD_EX32(data, GPIO_INDEX_REG, INT_SENS_0));
694         set->int_sens_0 = update_value_control_source(set, set->int_sens_0,
695                                                       reg_value);
696         reg_value = set->int_sens_1;
697         reg_value = deposit32(reg_value, pin_idx, 1,
698                               FIELD_EX32(data, GPIO_INDEX_REG, INT_SENS_1));
699         set->int_sens_1 = update_value_control_source(set, set->int_sens_1,
700                                                       reg_value);
701         reg_value = set->int_sens_2;
702         reg_value = deposit32(reg_value, pin_idx, 1,
703                               FIELD_EX32(data, GPIO_INDEX_REG, INT_SENS_2));
704         set->int_sens_2 = update_value_control_source(set, set->int_sens_2,
705                                                       reg_value);
706         /* set interrupt status */
707         reg_value = set->int_status;
708         reg_value = deposit32(reg_value, pin_idx, 1,
709                               FIELD_EX32(data, GPIO_INDEX_REG, INT_STATUS));
710         cleared = ctpop32(reg_value & set->int_status);
711         if (s->pending && cleared) {
712             assert(s->pending >= cleared);
713             s->pending -= cleared;
714         }
715         set->int_status &= ~reg_value;
716         break;
717     case gpio_reg_idx_debounce:
718         reg_value = set->debounce_1;
719         reg_value = deposit32(reg_value, pin_idx, 1,
720                               FIELD_EX32(data, GPIO_INDEX_REG, DEBOUNCE_1));
721         set->debounce_1 = update_value_control_source(set, set->debounce_1,
722                                                       reg_value);
723         reg_value = set->debounce_2;
724         reg_value = deposit32(reg_value, pin_idx, 1,
725                               FIELD_EX32(data, GPIO_INDEX_REG, DEBOUNCE_2));
726         set->debounce_2 = update_value_control_source(set, set->debounce_2,
727                                                       reg_value);
728         return;
729     case gpio_reg_idx_tolerance:
730         reg_value = set->reset_tol;
731         reg_value = deposit32(reg_value, pin_idx, 1,
732                               FIELD_EX32(data, GPIO_INDEX_REG, RESET_TOLERANT));
733         set->reset_tol = update_value_control_source(set, set->reset_tol,
734                                                      reg_value);
735         return;
736     case gpio_reg_idx_cmd_src:
737         reg_value = set->cmd_source_0;
738         reg_value = deposit32(reg_value, GPIOS_PER_GROUP * group_idx, 1,
739                               FIELD_EX32(data, GPIO_INDEX_REG, COMMAND_SRC_0));
740         set->cmd_source_0 = reg_value & ASPEED_CMD_SRC_MASK;
741         reg_value = set->cmd_source_1;
742         reg_value = deposit32(reg_value, GPIOS_PER_GROUP * group_idx, 1,
743                               FIELD_EX32(data, GPIO_INDEX_REG, COMMAND_SRC_1));
744         set->cmd_source_1 = reg_value & ASPEED_CMD_SRC_MASK;
745         return;
746     case gpio_reg_idx_input_mask:
747         reg_value = set->input_mask;
748         reg_value = deposit32(reg_value, pin_idx, 1,
749                               FIELD_EX32(data, GPIO_INDEX_REG, INPUT_MASK));
750         /*
751          * feeds into interrupt generation
752          * 0: read from data value reg will be updated
753          * 1: read from data value reg will not be updated
754          */
755         set->input_mask = reg_value & props->input;
756         break;
757     default:
758         qemu_log_mask(LOG_GUEST_ERROR, "%s: offset 0x%" PRIx64 "data 0x%"
759             PRIx64 "index mode wrong type 0x%x\n",
760             __func__, offset, data, reg_idx_type);
761         return;
762     }
763     aspeed_gpio_update(s, set, set->data_value, UINT32_MAX);
764     return;
765 }
766 
aspeed_gpio_write(void * opaque,hwaddr offset,uint64_t data,uint32_t size)767 static void aspeed_gpio_write(void *opaque, hwaddr offset, uint64_t data,
768                               uint32_t size)
769 {
770     AspeedGPIOState *s = ASPEED_GPIO(opaque);
771     AspeedGPIOClass *agc = ASPEED_GPIO_GET_CLASS(s);
772     const GPIOSetProperties *props;
773     uint64_t idx = -1;
774     const AspeedGPIOReg *reg;
775     GPIOSets *set;
776     uint32_t cleared;
777 
778     trace_aspeed_gpio_write(offset, data);
779 
780     idx = offset >> 2;
781 
782     /* check gpio index mode */
783     if (idx == R_GPIO_INDEX_REG) {
784         aspeed_gpio_write_index_mode(opaque, offset, data, size);
785         return;
786     }
787 
788     if (idx >= GPIO_DEBOUNCE_TIME_1 && idx <= GPIO_DEBOUNCE_TIME_3) {
789         idx -= GPIO_DEBOUNCE_TIME_1;
790         s->debounce_regs[idx] = (uint32_t) data;
791         return;
792     }
793 
794     if (idx >= agc->reg_table_count) {
795         qemu_log_mask(LOG_GUEST_ERROR, "%s: idx 0x%" PRIx64 " out of bounds\n",
796                       __func__, idx);
797         return;
798     }
799 
800     reg = &agc->reg_table[idx];
801     if (reg->set_idx >= agc->nr_gpio_sets) {
802         qemu_log_mask(LOG_GUEST_ERROR, "%s: no setter for offset 0x%"
803                       PRIx64"\n", __func__, offset);
804         return;
805     }
806 
807     set = &s->sets[reg->set_idx];
808     props = &agc->props[reg->set_idx];
809 
810     switch (reg->type) {
811     case gpio_reg_data_value:
812         data &= props->output;
813         data = update_value_control_source(set, set->data_value, data);
814         set->data_read = data;
815         aspeed_gpio_update(s, set, data, set->direction);
816         return;
817     case gpio_reg_direction:
818         /*
819          *   where data is the value attempted to be written to the pin:
820          *    pin type      | input mask | output mask | expected value
821          *    ------------------------------------------------------------
822          *   bidirectional  |   1       |   1        |  data
823          *   input only     |   1       |   0        |   0
824          *   output only    |   0       |   1        |   1
825          *   no pin         |   0       |   0        |   0
826          *
827          *  which is captured by:
828          *  data = ( data | ~input) & output;
829          */
830         data = (data | ~props->input) & props->output;
831         set->direction = update_value_control_source(set, set->direction, data);
832         break;
833     case gpio_reg_int_enable:
834         set->int_enable = update_value_control_source(set, set->int_enable,
835                                                       data);
836         break;
837     case gpio_reg_int_sens_0:
838         set->int_sens_0 = update_value_control_source(set, set->int_sens_0,
839                                                       data);
840         break;
841     case gpio_reg_int_sens_1:
842         set->int_sens_1 = update_value_control_source(set, set->int_sens_1,
843                                                       data);
844         break;
845     case gpio_reg_int_sens_2:
846         set->int_sens_2 = update_value_control_source(set, set->int_sens_2,
847                                                       data);
848         break;
849     case gpio_reg_int_status:
850         cleared = ctpop32(data & set->int_status);
851         if (s->pending && cleared) {
852             assert(s->pending >= cleared);
853             s->pending -= cleared;
854         }
855         set->int_status &= ~data;
856         break;
857     case gpio_reg_reset_tolerant:
858         set->reset_tol = update_value_control_source(set, set->reset_tol,
859                                                      data);
860         return;
861     case gpio_reg_debounce_1:
862         set->debounce_1 = update_value_control_source(set, set->debounce_1,
863                                                       data);
864         return;
865     case gpio_reg_debounce_2:
866         set->debounce_2 = update_value_control_source(set, set->debounce_2,
867                                                       data);
868         return;
869     case gpio_reg_cmd_source_0:
870         set->cmd_source_0 = data & ASPEED_CMD_SRC_MASK;
871         return;
872     case gpio_reg_cmd_source_1:
873         set->cmd_source_1 = data & ASPEED_CMD_SRC_MASK;
874         return;
875     case gpio_reg_data_read:
876         /* Read only register */
877         return;
878     case gpio_reg_input_mask:
879         /*
880          * feeds into interrupt generation
881          * 0: read from data value reg will be updated
882          * 1: read from data value reg will not be updated
883          */
884          set->input_mask = data & props->input;
885         break;
886     default:
887         qemu_log_mask(LOG_GUEST_ERROR, "%s: no setter for offset 0x%"
888                       PRIx64"\n", __func__, offset);
889         return;
890     }
891     aspeed_gpio_update(s, set, set->data_value, UINT32_MAX);
892     return;
893 }
894 
get_set_idx(AspeedGPIOState * s,const char * group,int * group_idx)895 static int get_set_idx(AspeedGPIOState *s, const char *group, int *group_idx)
896 {
897     AspeedGPIOClass *agc = ASPEED_GPIO_GET_CLASS(s);
898     int set_idx, g_idx;
899 
900     for (set_idx = 0; set_idx < agc->nr_gpio_sets; set_idx++) {
901         const GPIOSetProperties *set_props = &agc->props[set_idx];
902         for (g_idx = 0; g_idx < ASPEED_GROUPS_PER_SET; g_idx++) {
903             if (!strncmp(group, set_props->group_label[g_idx], strlen(group))) {
904                 *group_idx = g_idx;
905                 return set_idx;
906             }
907         }
908     }
909     return -1;
910 }
911 
aspeed_gpio_get_pin(Object * obj,Visitor * v,const char * name,void * opaque,Error ** errp)912 static void aspeed_gpio_get_pin(Object *obj, Visitor *v, const char *name,
913                                 void *opaque, Error **errp)
914 {
915     int pin = 0xfff;
916     bool level = true;
917     char group[4];
918     AspeedGPIOState *s = ASPEED_GPIO(obj);
919     int set_idx, group_idx = 0;
920 
921     if (sscanf(name, "gpio%2[A-Z]%1d", group, &pin) != 2) {
922         /* 1.8V gpio */
923         if (sscanf(name, "gpio%3[18A-E]%1d", group, &pin) != 2) {
924             error_setg(errp, "%s: error reading %s", __func__, name);
925             return;
926         }
927     }
928     set_idx = get_set_idx(s, group, &group_idx);
929     if (set_idx == -1) {
930         error_setg(errp, "%s: invalid group %s", __func__, group);
931         return;
932     }
933     pin =  pin + group_idx * GPIOS_PER_GROUP;
934     level = aspeed_gpio_get_pin_level(s, set_idx, pin);
935     visit_type_bool(v, name, &level, errp);
936 }
937 
aspeed_gpio_set_pin(Object * obj,Visitor * v,const char * name,void * opaque,Error ** errp)938 static void aspeed_gpio_set_pin(Object *obj, Visitor *v, const char *name,
939                                void *opaque, Error **errp)
940 {
941     bool level;
942     int pin = 0xfff;
943     char group[4];
944     AspeedGPIOState *s = ASPEED_GPIO(obj);
945     int set_idx, group_idx = 0;
946 
947     if (!visit_type_bool(v, name, &level, errp)) {
948         return;
949     }
950     if (sscanf(name, "gpio%2[A-Z]%1d", group, &pin) != 2) {
951         /* 1.8V gpio */
952         if (sscanf(name, "gpio%3[18A-E]%1d", group, &pin) != 2) {
953             error_setg(errp, "%s: error reading %s", __func__, name);
954             return;
955         }
956     }
957     set_idx = get_set_idx(s, group, &group_idx);
958     if (set_idx == -1) {
959         error_setg(errp, "%s: invalid group %s", __func__, group);
960         return;
961     }
962     pin =  pin + group_idx * GPIOS_PER_GROUP;
963     aspeed_gpio_set_pin_level(s, set_idx, pin, level);
964 }
965 
966 /****************** Setup functions ******************/
967 static const GPIOSetProperties ast2400_set_props[ASPEED_GPIO_MAX_NR_SETS] = {
968     [0] = {0xffffffff,  0xffffffff,  {"A", "B", "C", "D"} },
969     [1] = {0xffffffff,  0xffffffff,  {"E", "F", "G", "H"} },
970     [2] = {0xffffffff,  0xffffffff,  {"I", "J", "K", "L"} },
971     [3] = {0xffffffff,  0xffffffff,  {"M", "N", "O", "P"} },
972     [4] = {0xffffffff,  0xffffffff,  {"Q", "R", "S", "T"} },
973     [5] = {0xffffffff,  0x0000ffff,  {"U", "V", "W", "X"} },
974     [6] = {0x0000000f,  0x0fffff0f,  {"Y", "Z", "AA", "AB"} },
975 };
976 
977 static const GPIOSetProperties ast2500_set_props[ASPEED_GPIO_MAX_NR_SETS] = {
978     [0] = {0xffffffff,  0xffffffff,  {"A", "B", "C", "D"} },
979     [1] = {0xffffffff,  0xffffffff,  {"E", "F", "G", "H"} },
980     [2] = {0xffffffff,  0xffffffff,  {"I", "J", "K", "L"} },
981     [3] = {0xffffffff,  0xffffffff,  {"M", "N", "O", "P"} },
982     [4] = {0xffffffff,  0xffffffff,  {"Q", "R", "S", "T"} },
983     [5] = {0xffffffff,  0x0000ffff,  {"U", "V", "W", "X"} },
984     [6] = {0x0fffffff,  0x0fffffff,  {"Y", "Z", "AA", "AB"} },
985     [7] = {0x000000ff,  0x000000ff,  {"AC"} },
986 };
987 
988 static GPIOSetProperties ast2600_3_3v_set_props[ASPEED_GPIO_MAX_NR_SETS] = {
989     [0] = {0xffffffff,  0xffffffff,  {"A", "B", "C", "D"} },
990     [1] = {0xffffffff,  0xffffffff,  {"E", "F", "G", "H"} },
991     [2] = {0xffffffff,  0xffffffff,  {"I", "J", "K", "L"} },
992     [3] = {0xffffffff,  0xffffffff,  {"M", "N", "O", "P"} },
993     [4] = {0xffffffff,  0x00ffffff,  {"Q", "R", "S", "T"} },
994     [5] = {0xffffffff,  0xffffff00,  {"U", "V", "W", "X"} },
995     [6] = {0x0000ffff,  0x0000ffff,  {"Y", "Z"} },
996 };
997 
998 static GPIOSetProperties ast2600_1_8v_set_props[ASPEED_GPIO_MAX_NR_SETS] = {
999     [0] = {0xffffffff,  0xffffffff,  {"18A", "18B", "18C", "18D"} },
1000     [1] = {0x0000000f,  0x0000000f,  {"18E"} },
1001 };
1002 
1003 static GPIOSetProperties ast1030_set_props[ASPEED_GPIO_MAX_NR_SETS] = {
1004     [0] = {0xffffffff,  0xffffffff,  {"A", "B", "C", "D"} },
1005     [1] = {0xffffffff,  0xffffffff,  {"E", "F", "G", "H"} },
1006     [2] = {0xffffffff,  0xffffffff,  {"I", "J", "K", "L"} },
1007     [3] = {0xffffff3f,  0xffffff3f,  {"M", "N", "O", "P"} },
1008     [4] = {0xff060c1f,  0x00060c1f,  {"Q", "R", "S", "T"} },
1009     [5] = {0x000000ff,  0x00000000,  {"U"} },
1010 };
1011 
1012 static const MemoryRegionOps aspeed_gpio_ops = {
1013     .read       = aspeed_gpio_read,
1014     .write      = aspeed_gpio_write,
1015     .endianness = DEVICE_LITTLE_ENDIAN,
1016     .valid.min_access_size = 4,
1017     .valid.max_access_size = 4,
1018 };
1019 
aspeed_gpio_reset(DeviceState * dev)1020 static void aspeed_gpio_reset(DeviceState *dev)
1021 {
1022     AspeedGPIOState *s = ASPEED_GPIO(dev);
1023 
1024     /* TODO: respect the reset tolerance registers */
1025     memset(s->sets, 0, sizeof(s->sets));
1026 }
1027 
aspeed_gpio_realize(DeviceState * dev,Error ** errp)1028 static void aspeed_gpio_realize(DeviceState *dev, Error **errp)
1029 {
1030     AspeedGPIOState *s = ASPEED_GPIO(dev);
1031     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
1032     AspeedGPIOClass *agc = ASPEED_GPIO_GET_CLASS(s);
1033 
1034     /* Interrupt parent line */
1035     sysbus_init_irq(sbd, &s->irq);
1036 
1037     /* Individual GPIOs */
1038     for (int i = 0; i < ASPEED_GPIO_MAX_NR_SETS; i++) {
1039         const GPIOSetProperties *props = &agc->props[i];
1040         uint32_t skip = ~(props->input | props->output);
1041         for (int j = 0; j < ASPEED_GPIOS_PER_SET; j++) {
1042             if (skip >> j & 1) {
1043                 continue;
1044             }
1045             sysbus_init_irq(sbd, &s->gpios[i][j]);
1046         }
1047     }
1048 
1049     memory_region_init_io(&s->iomem, OBJECT(s), &aspeed_gpio_ops, s,
1050             TYPE_ASPEED_GPIO, 0x800);
1051 
1052     sysbus_init_mmio(sbd, &s->iomem);
1053 }
1054 
aspeed_gpio_init(Object * obj)1055 static void aspeed_gpio_init(Object *obj)
1056 {
1057     AspeedGPIOState *s = ASPEED_GPIO(obj);
1058     AspeedGPIOClass *agc = ASPEED_GPIO_GET_CLASS(s);
1059 
1060     for (int i = 0; i < ASPEED_GPIO_MAX_NR_SETS; i++) {
1061         const GPIOSetProperties *props = &agc->props[i];
1062         uint32_t skip = ~(props->input | props->output);
1063         for (int j = 0; j < ASPEED_GPIOS_PER_SET; j++) {
1064             if (skip >> j & 1) {
1065                 continue;
1066             }
1067             int group_idx = j / GPIOS_PER_GROUP;
1068             int pin_idx = j % GPIOS_PER_GROUP;
1069             const char *group = &props->group_label[group_idx][0];
1070             char *name = g_strdup_printf("gpio%s%d", group, pin_idx);
1071             object_property_add(obj, name, "bool", aspeed_gpio_get_pin,
1072                                 aspeed_gpio_set_pin, NULL, NULL);
1073             g_free(name);
1074         }
1075     }
1076 }
1077 
1078 static const VMStateDescription vmstate_gpio_regs = {
1079     .name = TYPE_ASPEED_GPIO"/regs",
1080     .version_id = 1,
1081     .minimum_version_id = 1,
1082     .fields = (const VMStateField[]) {
1083         VMSTATE_UINT32(data_value,   GPIOSets),
1084         VMSTATE_UINT32(data_read,    GPIOSets),
1085         VMSTATE_UINT32(direction,    GPIOSets),
1086         VMSTATE_UINT32(int_enable,   GPIOSets),
1087         VMSTATE_UINT32(int_sens_0,   GPIOSets),
1088         VMSTATE_UINT32(int_sens_1,   GPIOSets),
1089         VMSTATE_UINT32(int_sens_2,   GPIOSets),
1090         VMSTATE_UINT32(int_status,   GPIOSets),
1091         VMSTATE_UINT32(reset_tol,    GPIOSets),
1092         VMSTATE_UINT32(cmd_source_0, GPIOSets),
1093         VMSTATE_UINT32(cmd_source_1, GPIOSets),
1094         VMSTATE_UINT32(debounce_1,   GPIOSets),
1095         VMSTATE_UINT32(debounce_2,   GPIOSets),
1096         VMSTATE_UINT32(input_mask,   GPIOSets),
1097         VMSTATE_END_OF_LIST(),
1098     }
1099 };
1100 
1101 static const VMStateDescription vmstate_aspeed_gpio = {
1102     .name = TYPE_ASPEED_GPIO,
1103     .version_id = 1,
1104     .minimum_version_id = 1,
1105     .fields = (const VMStateField[]) {
1106         VMSTATE_STRUCT_ARRAY(sets, AspeedGPIOState, ASPEED_GPIO_MAX_NR_SETS,
1107                              1, vmstate_gpio_regs, GPIOSets),
1108         VMSTATE_UINT32_ARRAY(debounce_regs, AspeedGPIOState,
1109                              ASPEED_GPIO_NR_DEBOUNCE_REGS),
1110         VMSTATE_END_OF_LIST(),
1111    }
1112 };
1113 
aspeed_gpio_class_init(ObjectClass * klass,void * data)1114 static void aspeed_gpio_class_init(ObjectClass *klass, void *data)
1115 {
1116     DeviceClass *dc = DEVICE_CLASS(klass);
1117 
1118     dc->realize = aspeed_gpio_realize;
1119     dc->reset = aspeed_gpio_reset;
1120     dc->desc = "Aspeed GPIO Controller";
1121     dc->vmsd = &vmstate_aspeed_gpio;
1122 }
1123 
aspeed_gpio_ast2400_class_init(ObjectClass * klass,void * data)1124 static void aspeed_gpio_ast2400_class_init(ObjectClass *klass, void *data)
1125 {
1126     AspeedGPIOClass *agc = ASPEED_GPIO_CLASS(klass);
1127 
1128     agc->props = ast2400_set_props;
1129     agc->nr_gpio_pins = 216;
1130     agc->nr_gpio_sets = 7;
1131     agc->reg_table = aspeed_3_3v_gpios;
1132     agc->reg_table_count = GPIO_3_3V_REG_ARRAY_SIZE;
1133 }
1134 
aspeed_gpio_2500_class_init(ObjectClass * klass,void * data)1135 static void aspeed_gpio_2500_class_init(ObjectClass *klass, void *data)
1136 {
1137     AspeedGPIOClass *agc = ASPEED_GPIO_CLASS(klass);
1138 
1139     agc->props = ast2500_set_props;
1140     agc->nr_gpio_pins = 228;
1141     agc->nr_gpio_sets = 8;
1142     agc->reg_table = aspeed_3_3v_gpios;
1143     agc->reg_table_count = GPIO_3_3V_REG_ARRAY_SIZE;
1144 }
1145 
aspeed_gpio_ast2600_3_3v_class_init(ObjectClass * klass,void * data)1146 static void aspeed_gpio_ast2600_3_3v_class_init(ObjectClass *klass, void *data)
1147 {
1148     AspeedGPIOClass *agc = ASPEED_GPIO_CLASS(klass);
1149 
1150     agc->props = ast2600_3_3v_set_props;
1151     agc->nr_gpio_pins = 208;
1152     agc->nr_gpio_sets = 7;
1153     agc->reg_table = aspeed_3_3v_gpios;
1154     agc->reg_table_count = GPIO_3_3V_REG_ARRAY_SIZE;
1155 }
1156 
aspeed_gpio_ast2600_1_8v_class_init(ObjectClass * klass,void * data)1157 static void aspeed_gpio_ast2600_1_8v_class_init(ObjectClass *klass, void *data)
1158 {
1159     AspeedGPIOClass *agc = ASPEED_GPIO_CLASS(klass);
1160 
1161     agc->props = ast2600_1_8v_set_props;
1162     agc->nr_gpio_pins = 36;
1163     agc->nr_gpio_sets = 2;
1164     agc->reg_table = aspeed_1_8v_gpios;
1165     agc->reg_table_count = GPIO_1_8V_REG_ARRAY_SIZE;
1166 }
1167 
aspeed_gpio_1030_class_init(ObjectClass * klass,void * data)1168 static void aspeed_gpio_1030_class_init(ObjectClass *klass, void *data)
1169 {
1170     AspeedGPIOClass *agc = ASPEED_GPIO_CLASS(klass);
1171 
1172     agc->props = ast1030_set_props;
1173     agc->nr_gpio_pins = 151;
1174     agc->nr_gpio_sets = 6;
1175     agc->reg_table = aspeed_3_3v_gpios;
1176     agc->reg_table_count = GPIO_3_3V_REG_ARRAY_SIZE;
1177 }
1178 
1179 static const TypeInfo aspeed_gpio_info = {
1180     .name           = TYPE_ASPEED_GPIO,
1181     .parent         = TYPE_SYS_BUS_DEVICE,
1182     .instance_size  = sizeof(AspeedGPIOState),
1183     .class_size     = sizeof(AspeedGPIOClass),
1184     .class_init     = aspeed_gpio_class_init,
1185     .abstract       = true,
1186 };
1187 
1188 static const TypeInfo aspeed_gpio_ast2400_info = {
1189     .name           = TYPE_ASPEED_GPIO "-ast2400",
1190     .parent         = TYPE_ASPEED_GPIO,
1191     .class_init     = aspeed_gpio_ast2400_class_init,
1192     .instance_init  = aspeed_gpio_init,
1193 };
1194 
1195 static const TypeInfo aspeed_gpio_ast2500_info = {
1196     .name           = TYPE_ASPEED_GPIO "-ast2500",
1197     .parent         = TYPE_ASPEED_GPIO,
1198     .class_init     = aspeed_gpio_2500_class_init,
1199     .instance_init  = aspeed_gpio_init,
1200 };
1201 
1202 static const TypeInfo aspeed_gpio_ast2600_3_3v_info = {
1203     .name           = TYPE_ASPEED_GPIO "-ast2600",
1204     .parent         = TYPE_ASPEED_GPIO,
1205     .class_init     = aspeed_gpio_ast2600_3_3v_class_init,
1206     .instance_init  = aspeed_gpio_init,
1207 };
1208 
1209 static const TypeInfo aspeed_gpio_ast2600_1_8v_info = {
1210     .name           = TYPE_ASPEED_GPIO "-ast2600-1_8v",
1211     .parent         = TYPE_ASPEED_GPIO,
1212     .class_init     = aspeed_gpio_ast2600_1_8v_class_init,
1213     .instance_init  = aspeed_gpio_init,
1214 };
1215 
1216 static const TypeInfo aspeed_gpio_ast1030_info = {
1217     .name           = TYPE_ASPEED_GPIO "-ast1030",
1218     .parent         = TYPE_ASPEED_GPIO,
1219     .class_init     = aspeed_gpio_1030_class_init,
1220     .instance_init  = aspeed_gpio_init,
1221 };
1222 
aspeed_gpio_register_types(void)1223 static void aspeed_gpio_register_types(void)
1224 {
1225     type_register_static(&aspeed_gpio_info);
1226     type_register_static(&aspeed_gpio_ast2400_info);
1227     type_register_static(&aspeed_gpio_ast2500_info);
1228     type_register_static(&aspeed_gpio_ast2600_3_3v_info);
1229     type_register_static(&aspeed_gpio_ast2600_1_8v_info);
1230     type_register_static(&aspeed_gpio_ast1030_info);
1231 }
1232 
1233 type_init(aspeed_gpio_register_types);
1234