hc
2024-02-20 102a0743326a03cd1a1202ceda21e175b7d3575c
kernel/drivers/pinctrl/pinctrl-amd.c
....@@ -126,6 +126,14 @@
126126 struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
127127
128128 raw_spin_lock_irqsave(&gpio_dev->lock, flags);
129
+
130
+ /* Use special handling for Pin0 debounce */
131
+ if (offset == 0) {
132
+ pin_reg = readl(gpio_dev->base + WAKE_INT_MASTER_REG);
133
+ if (pin_reg & INTERNAL_GPIO0_DEBOUNCE)
134
+ debounce = 0;
135
+ }
136
+
129137 pin_reg = readl(gpio_dev->base + offset * 4);
130138
131139 if (debounce) {
....@@ -181,18 +189,6 @@
181189 return ret;
182190 }
183191
184
-static int amd_gpio_set_config(struct gpio_chip *gc, unsigned offset,
185
- unsigned long config)
186
-{
187
- u32 debounce;
188
-
189
- if (pinconf_to_config_param(config) != PIN_CONFIG_INPUT_DEBOUNCE)
190
- return -ENOTSUPP;
191
-
192
- debounce = pinconf_to_config_argument(config);
193
- return amd_gpio_set_debounce(gc, offset, debounce);
194
-}
195
-
196192 #ifdef CONFIG_DEBUG_FS
197193 static void amd_gpio_dbg_show(struct seq_file *s, struct gpio_chip *gc)
198194 {
....@@ -215,6 +211,7 @@
215211 char *output_value;
216212 char *output_enable;
217213
214
+ seq_printf(s, "WAKE_INT_MASTER_REG: 0x%08x\n", readl(gpio_dev->base + WAKE_INT_MASTER_REG));
218215 for (bank = 0; bank < gpio_dev->hwbank_num; bank++) {
219216 seq_printf(s, "GPIO bank%d\t", bank);
220217
....@@ -656,7 +653,7 @@
656653 break;
657654
658655 default:
659
- dev_err(&gpio_dev->pdev->dev, "Invalid config param %04x\n",
656
+ dev_dbg(&gpio_dev->pdev->dev, "Invalid config param %04x\n",
660657 param);
661658 return -ENOTSUPP;
662659 }
....@@ -667,7 +664,7 @@
667664 }
668665
669666 static int amd_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
670
- unsigned long *configs, unsigned num_configs)
667
+ unsigned long *configs, unsigned int num_configs)
671668 {
672669 int i;
673670 u32 arg;
....@@ -709,7 +706,7 @@
709706 break;
710707
711708 default:
712
- dev_err(&gpio_dev->pdev->dev,
709
+ dev_dbg(&gpio_dev->pdev->dev,
713710 "Invalid config param %04x\n", param);
714711 ret = -ENOTSUPP;
715712 }
....@@ -757,6 +754,20 @@
757754 return 0;
758755 }
759756
757
+static int amd_gpio_set_config(struct gpio_chip *gc, unsigned int pin,
758
+ unsigned long config)
759
+{
760
+ struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
761
+
762
+ if (pinconf_to_config_param(config) == PIN_CONFIG_INPUT_DEBOUNCE) {
763
+ u32 debounce = pinconf_to_config_argument(config);
764
+
765
+ return amd_gpio_set_debounce(gc, pin, debounce);
766
+ }
767
+
768
+ return amd_pinconf_set(gpio_dev->pctrl, pin, &config, 1);
769
+}
770
+
760771 static const struct pinconf_ops amd_pinconf_ops = {
761772 .pin_config_get = amd_pinconf_get,
762773 .pin_config_set = amd_pinconf_set,
....@@ -784,9 +795,9 @@
784795
785796 raw_spin_lock_irqsave(&gpio_dev->lock, flags);
786797
787
- pin_reg = readl(gpio_dev->base + i * 4);
798
+ pin_reg = readl(gpio_dev->base + pin * 4);
788799 pin_reg &= ~mask;
789
- writel(pin_reg, gpio_dev->base + i * 4);
800
+ writel(pin_reg, gpio_dev->base + pin * 4);
790801
791802 raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
792803 }