1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Pinconf driver for TI DA850/OMAP-L138/AM18XX pullup/pulldown groups 4 * 5 * Copyright (C) 2016 David Lechner 6 */ 7 8 #include <linux/bitops.h> 9 #include <linux/device.h> 10 #include <linux/io.h> 11 #include <linux/ioport.h> 12 #include <linux/module.h> 13 #include <linux/pinctrl/pinconf.h> 14 #include <linux/pinctrl/pinconf-generic.h> 15 #include <linux/pinctrl/pinctrl.h> 16 #include <linux/platform_device.h> 17 18 #define DA850_PUPD_ENA 0x00 19 #define DA850_PUPD_SEL 0x04 20 21 struct da850_pupd_data { 22 void __iomem *base; 23 struct pinctrl_desc desc; 24 struct pinctrl_dev *pinctrl; 25 }; 26 27 static const char * const da850_pupd_group_names[] = { 28 "cp0", "cp1", "cp2", "cp3", "cp4", "cp5", "cp6", "cp7", 29 "cp8", "cp9", "cp10", "cp11", "cp12", "cp13", "cp14", "cp15", 30 "cp16", "cp17", "cp18", "cp19", "cp20", "cp21", "cp22", "cp23", 31 "cp24", "cp25", "cp26", "cp27", "cp28", "cp29", "cp30", "cp31", 32 }; 33 34 static int da850_pupd_get_groups_count(struct pinctrl_dev *pctldev) 35 { 36 return ARRAY_SIZE(da850_pupd_group_names); 37 } 38 39 static const char *da850_pupd_get_group_name(struct pinctrl_dev *pctldev, 40 unsigned int selector) 41 { 42 return da850_pupd_group_names[selector]; 43 } 44 45 static int da850_pupd_get_group_pins(struct pinctrl_dev *pctldev, 46 unsigned int selector, 47 const unsigned int **pins, 48 unsigned int *num_pins) 49 { 50 *num_pins = 0; 51 52 return 0; 53 } 54 55 static const struct pinctrl_ops da850_pupd_pctlops = { 56 .get_groups_count = da850_pupd_get_groups_count, 57 .get_group_name = da850_pupd_get_group_name, 58 .get_group_pins = da850_pupd_get_group_pins, 59 .dt_node_to_map = pinconf_generic_dt_node_to_map_group, 60 .dt_free_map = pinconf_generic_dt_free_map, 61 }; 62 63 static int da850_pupd_pin_config_group_get(struct pinctrl_dev *pctldev, 64 unsigned int selector, 65 unsigned long *config) 66 { 67 struct da850_pupd_data *data = pinctrl_dev_get_drvdata(pctldev); 68 enum pin_config_param param = pinconf_to_config_param(*config); 69 u32 val; 70 u16 arg; 71 72 val = readl(data->base + DA850_PUPD_ENA); 73 arg = !!(~val & BIT(selector)); 74 75 switch (param) { 76 case PIN_CONFIG_BIAS_DISABLE: 77 break; 78 case PIN_CONFIG_BIAS_PULL_UP: 79 case PIN_CONFIG_BIAS_PULL_DOWN: 80 if (arg) { 81 /* bias is disabled */ 82 arg = 0; 83 break; 84 } 85 val = readl(data->base + DA850_PUPD_SEL); 86 if (param == PIN_CONFIG_BIAS_PULL_DOWN) 87 val = ~val; 88 arg = !!(val & BIT(selector)); 89 break; 90 default: 91 return -EINVAL; 92 } 93 94 *config = pinconf_to_config_packed(param, arg); 95 96 return 0; 97 } 98 99 static int da850_pupd_pin_config_group_set(struct pinctrl_dev *pctldev, 100 unsigned int selector, 101 unsigned long *configs, 102 unsigned int num_configs) 103 { 104 struct da850_pupd_data *data = pinctrl_dev_get_drvdata(pctldev); 105 u32 ena, sel; 106 enum pin_config_param param; 107 int i; 108 109 ena = readl(data->base + DA850_PUPD_ENA); 110 sel = readl(data->base + DA850_PUPD_SEL); 111 112 for (i = 0; i < num_configs; i++) { 113 param = pinconf_to_config_param(configs[i]); 114 115 switch (param) { 116 case PIN_CONFIG_BIAS_DISABLE: 117 ena &= ~BIT(selector); 118 break; 119 case PIN_CONFIG_BIAS_PULL_UP: 120 ena |= BIT(selector); 121 sel |= BIT(selector); 122 break; 123 case PIN_CONFIG_BIAS_PULL_DOWN: 124 ena |= BIT(selector); 125 sel &= ~BIT(selector); 126 break; 127 default: 128 return -EINVAL; 129 } 130 } 131 132 writel(sel, data->base + DA850_PUPD_SEL); 133 writel(ena, data->base + DA850_PUPD_ENA); 134 135 return 0; 136 } 137 138 static const struct pinconf_ops da850_pupd_confops = { 139 .is_generic = true, 140 .pin_config_group_get = da850_pupd_pin_config_group_get, 141 .pin_config_group_set = da850_pupd_pin_config_group_set, 142 }; 143 144 static int da850_pupd_probe(struct platform_device *pdev) 145 { 146 struct device *dev = &pdev->dev; 147 struct da850_pupd_data *data; 148 149 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); 150 if (!data) 151 return -ENOMEM; 152 153 data->base = devm_platform_ioremap_resource(pdev, 0); 154 if (IS_ERR(data->base)) { 155 dev_err(dev, "Could not map resource\n"); 156 return PTR_ERR(data->base); 157 } 158 159 data->desc.name = dev_name(dev); 160 data->desc.pctlops = &da850_pupd_pctlops; 161 data->desc.confops = &da850_pupd_confops; 162 data->desc.owner = THIS_MODULE; 163 164 data->pinctrl = devm_pinctrl_register(dev, &data->desc, data); 165 if (IS_ERR(data->pinctrl)) { 166 dev_err(dev, "Failed to register pinctrl\n"); 167 return PTR_ERR(data->pinctrl); 168 } 169 170 platform_set_drvdata(pdev, data); 171 172 return 0; 173 } 174 175 static const struct of_device_id da850_pupd_of_match[] = { 176 { .compatible = "ti,da850-pupd" }, 177 { } 178 }; 179 MODULE_DEVICE_TABLE(of, da850_pupd_of_match); 180 181 static struct platform_driver da850_pupd_driver = { 182 .driver = { 183 .name = "ti-da850-pupd", 184 .of_match_table = da850_pupd_of_match, 185 }, 186 .probe = da850_pupd_probe, 187 }; 188 module_platform_driver(da850_pupd_driver); 189 190 MODULE_AUTHOR("David Lechner <david@lechnology.com>"); 191 MODULE_DESCRIPTION("TI DA850/OMAP-L138/AM18XX pullup/pulldown configuration"); 192 MODULE_LICENSE("GPL"); 193