1 // SPDX-License-Identifier: GPL-2.0-or-later
23 static int adp5520_gpio_get_value(struct gpio_chip *chip, unsigned off)  in adp5520_gpio_get_value()  argument
28 	dev = gpiochip_get_data(chip);  in adp5520_gpio_get_value()
35 	if (test_bit(off, &dev->output))  in adp5520_gpio_get_value()
36 		adp5520_read(dev->master, ADP5520_GPIO_OUT, &reg_val);  in adp5520_gpio_get_value()
38 		adp5520_read(dev->master, ADP5520_GPIO_IN, &reg_val);  in adp5520_gpio_get_value()
40 	return !!(reg_val & dev->lut[off]);  in adp5520_gpio_get_value()
43 static void adp5520_gpio_set_value(struct gpio_chip *chip,  in adp5520_gpio_set_value()  argument
44 		unsigned off, int val)  in adp5520_gpio_set_value()  argument
47 	dev = gpiochip_get_data(chip);  in adp5520_gpio_set_value()
50 		adp5520_set_bits(dev->master, ADP5520_GPIO_OUT, dev->lut[off]);  in adp5520_gpio_set_value()
52 		adp5520_clr_bits(dev->master, ADP5520_GPIO_OUT, dev->lut[off]);  in adp5520_gpio_set_value()
55 static int adp5520_gpio_direction_input(struct gpio_chip *chip, unsigned off)  in adp5520_gpio_direction_input()  argument
58 	dev = gpiochip_get_data(chip);  in adp5520_gpio_direction_input()
60 	clear_bit(off, &dev->output);  in adp5520_gpio_direction_input()
62 	return adp5520_clr_bits(dev->master, ADP5520_GPIO_CFG_2,  in adp5520_gpio_direction_input()
63 				dev->lut[off]);  in adp5520_gpio_direction_input()
66 static int adp5520_gpio_direction_output(struct gpio_chip *chip,  in adp5520_gpio_direction_output()  argument
67 		unsigned off, int val)  in adp5520_gpio_direction_output()  argument
71 	dev = gpiochip_get_data(chip);  in adp5520_gpio_direction_output()
73 	set_bit(off, &dev->output);  in adp5520_gpio_direction_output()
76 		ret |= adp5520_set_bits(dev->master, ADP5520_GPIO_OUT,  in adp5520_gpio_direction_output()
77 					dev->lut[off]);  in adp5520_gpio_direction_output()
79 		ret |= adp5520_clr_bits(dev->master, ADP5520_GPIO_OUT,  in adp5520_gpio_direction_output()
80 					dev->lut[off]);  in adp5520_gpio_direction_output()
82 	ret |= adp5520_set_bits(dev->master, ADP5520_GPIO_CFG_2,  in adp5520_gpio_direction_output()
83 					dev->lut[off]);  in adp5520_gpio_direction_output()
90 	struct adp5520_gpio_platform_data *pdata = dev_get_platdata(&pdev->dev);  in adp5520_gpio_probe()
97 		dev_err(&pdev->dev, "missing platform data\n");  in adp5520_gpio_probe()
98 		return -ENODEV;  in adp5520_gpio_probe()
101 	if (pdev->id != ID_ADP5520) {  in adp5520_gpio_probe()
102 		dev_err(&pdev->dev, "only ADP5520 supports GPIO\n");  in adp5520_gpio_probe()
103 		return -ENODEV;  in adp5520_gpio_probe()
106 	dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);  in adp5520_gpio_probe()
108 		return -ENOMEM;  in adp5520_gpio_probe()
110 	dev->master = pdev->dev.parent;  in adp5520_gpio_probe()
113 		if (pdata->gpio_en_mask & (1 << i))  in adp5520_gpio_probe()
114 			dev->lut[gpios++] = 1 << i;  in adp5520_gpio_probe()
117 		return -EINVAL;  in adp5520_gpio_probe()
119 	gc = &dev->gpio_chip;  in adp5520_gpio_probe()
120 	gc->direction_input  = adp5520_gpio_direction_input;  in adp5520_gpio_probe()
121 	gc->direction_output = adp5520_gpio_direction_output;  in adp5520_gpio_probe()
122 	gc->get = adp5520_gpio_get_value;  in adp5520_gpio_probe()
123 	gc->set = adp5520_gpio_set_value;  in adp5520_gpio_probe()
124 	gc->can_sleep = true;  in adp5520_gpio_probe()
126 	gc->base = pdata->gpio_start;  in adp5520_gpio_probe()
127 	gc->ngpio = gpios;  in adp5520_gpio_probe()
128 	gc->label = pdev->name;  in adp5520_gpio_probe()
129 	gc->owner = THIS_MODULE;  in adp5520_gpio_probe()
131 	ret = adp5520_clr_bits(dev->master, ADP5520_GPIO_CFG_1,  in adp5520_gpio_probe()
132 		pdata->gpio_en_mask);  in adp5520_gpio_probe()
134 	if (pdata->gpio_en_mask & ADP5520_GPIO_C3)  in adp5520_gpio_probe()
137 	if (pdata->gpio_en_mask & ADP5520_GPIO_R3)  in adp5520_gpio_probe()
141 		ret = adp5520_set_bits(dev->master, ADP5520_LED_CONTROL,  in adp5520_gpio_probe()
144 	ret |= adp5520_set_bits(dev->master, ADP5520_GPIO_PULLUP,  in adp5520_gpio_probe()
145 		pdata->gpio_pullup_mask);  in adp5520_gpio_probe()
148 		dev_err(&pdev->dev, "failed to write\n");  in adp5520_gpio_probe()
152 	return devm_gpiochip_add_data(&pdev->dev, &dev->gpio_chip, dev);  in adp5520_gpio_probe()
157 		.name	= "adp5520-gpio",
167 MODULE_ALIAS("platform:adp5520-gpio");