1 /* SPDX-License-Identifier: GPL-2.0-only */
2
3 #include <stdint.h>
4
5 #include "chip.h"
6 #include "kempld.h"
7 #include "kempld_internal.h"
8
9 enum kempld_gpio_direction {
10 KEMPLD_GPIO_DIR_IN = 0,
11 KEMPLD_GPIO_DIR_OUT = 1
12 };
13
kempld_gpio_value_set(u8 pin_num,u8 value)14 static void kempld_gpio_value_set(u8 pin_num, u8 value)
15 {
16 const u8 mask = KEMPLD_GPIO_MASK(pin_num);
17 u8 reg_val = kempld_read8(KEMPLD_GPIO_LVL(pin_num));
18 reg_val = value ? reg_val | mask : reg_val & ~mask;
19 kempld_write8(KEMPLD_GPIO_LVL(pin_num), reg_val);
20 }
21
kempld_gpio_direction_set(u8 pin_num,enum kempld_gpio_direction dir)22 static void kempld_gpio_direction_set(u8 pin_num, enum kempld_gpio_direction dir)
23 {
24 const u8 mask = KEMPLD_GPIO_MASK(pin_num);
25 u8 reg_val = kempld_read8(KEMPLD_GPIO_DIR(pin_num));
26 reg_val = dir == KEMPLD_GPIO_DIR_OUT ? reg_val | mask : reg_val & ~mask;
27 kempld_write8(KEMPLD_GPIO_DIR(pin_num), reg_val);
28 }
29
kempld_configure_gpio(u8 pin_num,enum kempld_gpio_mode mode)30 static int kempld_configure_gpio(u8 pin_num, enum kempld_gpio_mode mode)
31 {
32 if (kempld_get_mutex(100) < 0)
33 return -1;
34
35 switch (mode) {
36 case KEMPLD_GPIO_DEFAULT:
37 break;
38
39 case KEMPLD_GPIO_INPUT:
40 kempld_gpio_direction_set(pin_num, KEMPLD_GPIO_DIR_IN);
41 break;
42
43 case KEMPLD_GPIO_OUTPUT_LOW:
44 kempld_gpio_value_set(pin_num, 0);
45 kempld_gpio_direction_set(pin_num, KEMPLD_GPIO_DIR_OUT);
46 break;
47
48 case KEMPLD_GPIO_OUTPUT_HIGH:
49 kempld_gpio_value_set(pin_num, 1);
50 kempld_gpio_direction_set(pin_num, KEMPLD_GPIO_DIR_OUT);
51 break;
52 }
53
54 kempld_release_mutex();
55 return 0;
56 }
57
kempld_gpio_pads_config(struct device * dev)58 int kempld_gpio_pads_config(struct device *dev)
59 {
60 const struct ec_kontron_kempld_config *config = dev->chip_info;
61
62 if (!config)
63 return -1;
64
65 for (u8 i = 0; i < KEMPLD_NUM_GPIOS; ++i) {
66 if (kempld_configure_gpio(i, config->gpio[i]) < 0)
67 return -1;
68 }
69 return 0;
70 }
71