Loading...
1/*
2 * TI/National Semiconductor LP3943 GPIO driver
3 *
4 * Copyright 2013 Texas Instruments
5 *
6 * Author: Milo Kim <milo.kim@ti.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; version 2.
11 */
12
13#include <linux/bitops.h>
14#include <linux/err.h>
15#include <linux/gpio.h>
16#include <linux/i2c.h>
17#include <linux/mfd/lp3943.h>
18#include <linux/module.h>
19#include <linux/platform_device.h>
20#include <linux/slab.h>
21
22enum lp3943_gpios {
23 LP3943_GPIO1,
24 LP3943_GPIO2,
25 LP3943_GPIO3,
26 LP3943_GPIO4,
27 LP3943_GPIO5,
28 LP3943_GPIO6,
29 LP3943_GPIO7,
30 LP3943_GPIO8,
31 LP3943_GPIO9,
32 LP3943_GPIO10,
33 LP3943_GPIO11,
34 LP3943_GPIO12,
35 LP3943_GPIO13,
36 LP3943_GPIO14,
37 LP3943_GPIO15,
38 LP3943_GPIO16,
39 LP3943_MAX_GPIO,
40};
41
42struct lp3943_gpio {
43 struct gpio_chip chip;
44 struct lp3943 *lp3943;
45 u16 input_mask; /* 1 = GPIO is input direction, 0 = output */
46};
47
48static inline struct lp3943_gpio *to_lp3943_gpio(struct gpio_chip *_chip)
49{
50 return container_of(_chip, struct lp3943_gpio, chip);
51}
52
53static int lp3943_gpio_request(struct gpio_chip *chip, unsigned offset)
54{
55 struct lp3943_gpio *lp3943_gpio = to_lp3943_gpio(chip);
56 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
57
58 /* Return an error if the pin is already assigned */
59 if (test_and_set_bit(offset, &lp3943->pin_used))
60 return -EBUSY;
61
62 return 0;
63}
64
65static void lp3943_gpio_free(struct gpio_chip *chip, unsigned offset)
66{
67 struct lp3943_gpio *lp3943_gpio = to_lp3943_gpio(chip);
68 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
69
70 clear_bit(offset, &lp3943->pin_used);
71}
72
73static int lp3943_gpio_set_mode(struct lp3943_gpio *lp3943_gpio, u8 offset,
74 u8 val)
75{
76 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
77 const struct lp3943_reg_cfg *mux = lp3943->mux_cfg;
78
79 return lp3943_update_bits(lp3943, mux[offset].reg, mux[offset].mask,
80 val << mux[offset].shift);
81}
82
83static int lp3943_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
84{
85 struct lp3943_gpio *lp3943_gpio = to_lp3943_gpio(chip);
86
87 lp3943_gpio->input_mask |= BIT(offset);
88
89 return lp3943_gpio_set_mode(lp3943_gpio, offset, LP3943_GPIO_IN);
90}
91
92static int lp3943_get_gpio_in_status(struct lp3943_gpio *lp3943_gpio,
93 struct gpio_chip *chip, unsigned offset)
94{
95 u8 addr, read;
96 int err;
97
98 switch (offset) {
99 case LP3943_GPIO1 ... LP3943_GPIO8:
100 addr = LP3943_REG_GPIO_A;
101 break;
102 case LP3943_GPIO9 ... LP3943_GPIO16:
103 addr = LP3943_REG_GPIO_B;
104 offset = offset - 8;
105 break;
106 default:
107 return -EINVAL;
108 }
109
110 err = lp3943_read_byte(lp3943_gpio->lp3943, addr, &read);
111 if (err)
112 return err;
113
114 return !!(read & BIT(offset));
115}
116
117static int lp3943_get_gpio_out_status(struct lp3943_gpio *lp3943_gpio,
118 struct gpio_chip *chip, unsigned offset)
119{
120 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
121 const struct lp3943_reg_cfg *mux = lp3943->mux_cfg;
122 u8 read;
123 int err;
124
125 err = lp3943_read_byte(lp3943, mux[offset].reg, &read);
126 if (err)
127 return err;
128
129 read = (read & mux[offset].mask) >> mux[offset].shift;
130
131 if (read == LP3943_GPIO_OUT_HIGH)
132 return 1;
133 else if (read == LP3943_GPIO_OUT_LOW)
134 return 0;
135 else
136 return -EINVAL;
137}
138
139static int lp3943_gpio_get(struct gpio_chip *chip, unsigned offset)
140{
141 struct lp3943_gpio *lp3943_gpio = to_lp3943_gpio(chip);
142
143 /*
144 * Limitation:
145 * LP3943 doesn't have the GPIO direction register. It provides
146 * only input and output status registers.
147 * So, direction info is required to handle the 'get' operation.
148 * This variable is updated whenever the direction is changed and
149 * it is used here.
150 */
151
152 if (lp3943_gpio->input_mask & BIT(offset))
153 return lp3943_get_gpio_in_status(lp3943_gpio, chip, offset);
154 else
155 return lp3943_get_gpio_out_status(lp3943_gpio, chip, offset);
156}
157
158static void lp3943_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
159{
160 struct lp3943_gpio *lp3943_gpio = to_lp3943_gpio(chip);
161 u8 data;
162
163 if (value)
164 data = LP3943_GPIO_OUT_HIGH;
165 else
166 data = LP3943_GPIO_OUT_LOW;
167
168 lp3943_gpio_set_mode(lp3943_gpio, offset, data);
169}
170
171static int lp3943_gpio_direction_output(struct gpio_chip *chip, unsigned offset,
172 int value)
173{
174 struct lp3943_gpio *lp3943_gpio = to_lp3943_gpio(chip);
175
176 lp3943_gpio_set(chip, offset, value);
177 lp3943_gpio->input_mask &= ~BIT(offset);
178
179 return 0;
180}
181
182static const struct gpio_chip lp3943_gpio_chip = {
183 .label = "lp3943",
184 .owner = THIS_MODULE,
185 .request = lp3943_gpio_request,
186 .free = lp3943_gpio_free,
187 .direction_input = lp3943_gpio_direction_input,
188 .get = lp3943_gpio_get,
189 .direction_output = lp3943_gpio_direction_output,
190 .set = lp3943_gpio_set,
191 .base = -1,
192 .ngpio = LP3943_MAX_GPIO,
193 .can_sleep = 1,
194};
195
196static int lp3943_gpio_probe(struct platform_device *pdev)
197{
198 struct lp3943 *lp3943 = dev_get_drvdata(pdev->dev.parent);
199 struct lp3943_gpio *lp3943_gpio;
200
201 lp3943_gpio = devm_kzalloc(&pdev->dev, sizeof(*lp3943_gpio),
202 GFP_KERNEL);
203 if (!lp3943_gpio)
204 return -ENOMEM;
205
206 lp3943_gpio->lp3943 = lp3943;
207 lp3943_gpio->chip = lp3943_gpio_chip;
208 lp3943_gpio->chip.dev = &pdev->dev;
209
210 platform_set_drvdata(pdev, lp3943_gpio);
211
212 return gpiochip_add(&lp3943_gpio->chip);
213}
214
215static int lp3943_gpio_remove(struct platform_device *pdev)
216{
217 struct lp3943_gpio *lp3943_gpio = platform_get_drvdata(pdev);
218
219 return gpiochip_remove(&lp3943_gpio->chip);
220}
221
222static const struct of_device_id lp3943_gpio_of_match[] = {
223 { .compatible = "ti,lp3943-gpio", },
224 { }
225};
226MODULE_DEVICE_TABLE(of, lp3943_gpio_of_match);
227
228static struct platform_driver lp3943_gpio_driver = {
229 .probe = lp3943_gpio_probe,
230 .remove = lp3943_gpio_remove,
231 .driver = {
232 .name = "lp3943-gpio",
233 .owner = THIS_MODULE,
234 .of_match_table = lp3943_gpio_of_match,
235 },
236};
237module_platform_driver(lp3943_gpio_driver);
238
239MODULE_DESCRIPTION("LP3943 GPIO driver");
240MODULE_ALIAS("platform:lp3943-gpio");
241MODULE_AUTHOR("Milo Kim");
242MODULE_LICENSE("GPL");
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * TI/National Semiconductor LP3943 GPIO driver
4 *
5 * Copyright 2013 Texas Instruments
6 *
7 * Author: Milo Kim <milo.kim@ti.com>
8 */
9
10#include <linux/bitops.h>
11#include <linux/err.h>
12#include <linux/gpio/driver.h>
13#include <linux/i2c.h>
14#include <linux/mfd/lp3943.h>
15#include <linux/module.h>
16#include <linux/platform_device.h>
17#include <linux/slab.h>
18
19enum lp3943_gpios {
20 LP3943_GPIO1,
21 LP3943_GPIO2,
22 LP3943_GPIO3,
23 LP3943_GPIO4,
24 LP3943_GPIO5,
25 LP3943_GPIO6,
26 LP3943_GPIO7,
27 LP3943_GPIO8,
28 LP3943_GPIO9,
29 LP3943_GPIO10,
30 LP3943_GPIO11,
31 LP3943_GPIO12,
32 LP3943_GPIO13,
33 LP3943_GPIO14,
34 LP3943_GPIO15,
35 LP3943_GPIO16,
36 LP3943_MAX_GPIO,
37};
38
39struct lp3943_gpio {
40 struct gpio_chip chip;
41 struct lp3943 *lp3943;
42 u16 input_mask; /* 1 = GPIO is input direction, 0 = output */
43};
44
45static int lp3943_gpio_request(struct gpio_chip *chip, unsigned offset)
46{
47 struct lp3943_gpio *lp3943_gpio = gpiochip_get_data(chip);
48 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
49
50 /* Return an error if the pin is already assigned */
51 if (test_and_set_bit(offset, &lp3943->pin_used))
52 return -EBUSY;
53
54 return 0;
55}
56
57static void lp3943_gpio_free(struct gpio_chip *chip, unsigned offset)
58{
59 struct lp3943_gpio *lp3943_gpio = gpiochip_get_data(chip);
60 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
61
62 clear_bit(offset, &lp3943->pin_used);
63}
64
65static int lp3943_gpio_set_mode(struct lp3943_gpio *lp3943_gpio, u8 offset,
66 u8 val)
67{
68 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
69 const struct lp3943_reg_cfg *mux = lp3943->mux_cfg;
70
71 return lp3943_update_bits(lp3943, mux[offset].reg, mux[offset].mask,
72 val << mux[offset].shift);
73}
74
75static int lp3943_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
76{
77 struct lp3943_gpio *lp3943_gpio = gpiochip_get_data(chip);
78
79 lp3943_gpio->input_mask |= BIT(offset);
80
81 return lp3943_gpio_set_mode(lp3943_gpio, offset, LP3943_GPIO_IN);
82}
83
84static int lp3943_get_gpio_in_status(struct lp3943_gpio *lp3943_gpio,
85 struct gpio_chip *chip, unsigned offset)
86{
87 u8 addr, read;
88 int err;
89
90 switch (offset) {
91 case LP3943_GPIO1 ... LP3943_GPIO8:
92 addr = LP3943_REG_GPIO_A;
93 break;
94 case LP3943_GPIO9 ... LP3943_GPIO16:
95 addr = LP3943_REG_GPIO_B;
96 offset = offset - 8;
97 break;
98 default:
99 return -EINVAL;
100 }
101
102 err = lp3943_read_byte(lp3943_gpio->lp3943, addr, &read);
103 if (err)
104 return err;
105
106 return !!(read & BIT(offset));
107}
108
109static int lp3943_get_gpio_out_status(struct lp3943_gpio *lp3943_gpio,
110 struct gpio_chip *chip, unsigned offset)
111{
112 struct lp3943 *lp3943 = lp3943_gpio->lp3943;
113 const struct lp3943_reg_cfg *mux = lp3943->mux_cfg;
114 u8 read;
115 int err;
116
117 err = lp3943_read_byte(lp3943, mux[offset].reg, &read);
118 if (err)
119 return err;
120
121 read = (read & mux[offset].mask) >> mux[offset].shift;
122
123 if (read == LP3943_GPIO_OUT_HIGH)
124 return 1;
125 else if (read == LP3943_GPIO_OUT_LOW)
126 return 0;
127 else
128 return -EINVAL;
129}
130
131static int lp3943_gpio_get(struct gpio_chip *chip, unsigned offset)
132{
133 struct lp3943_gpio *lp3943_gpio = gpiochip_get_data(chip);
134
135 /*
136 * Limitation:
137 * LP3943 doesn't have the GPIO direction register. It provides
138 * only input and output status registers.
139 * So, direction info is required to handle the 'get' operation.
140 * This variable is updated whenever the direction is changed and
141 * it is used here.
142 */
143
144 if (lp3943_gpio->input_mask & BIT(offset))
145 return lp3943_get_gpio_in_status(lp3943_gpio, chip, offset);
146 else
147 return lp3943_get_gpio_out_status(lp3943_gpio, chip, offset);
148}
149
150static void lp3943_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
151{
152 struct lp3943_gpio *lp3943_gpio = gpiochip_get_data(chip);
153 u8 data;
154
155 if (value)
156 data = LP3943_GPIO_OUT_HIGH;
157 else
158 data = LP3943_GPIO_OUT_LOW;
159
160 lp3943_gpio_set_mode(lp3943_gpio, offset, data);
161}
162
163static int lp3943_gpio_direction_output(struct gpio_chip *chip, unsigned offset,
164 int value)
165{
166 struct lp3943_gpio *lp3943_gpio = gpiochip_get_data(chip);
167
168 lp3943_gpio_set(chip, offset, value);
169 lp3943_gpio->input_mask &= ~BIT(offset);
170
171 return 0;
172}
173
174static const struct gpio_chip lp3943_gpio_chip = {
175 .label = "lp3943",
176 .owner = THIS_MODULE,
177 .request = lp3943_gpio_request,
178 .free = lp3943_gpio_free,
179 .direction_input = lp3943_gpio_direction_input,
180 .get = lp3943_gpio_get,
181 .direction_output = lp3943_gpio_direction_output,
182 .set = lp3943_gpio_set,
183 .base = -1,
184 .ngpio = LP3943_MAX_GPIO,
185 .can_sleep = 1,
186};
187
188static int lp3943_gpio_probe(struct platform_device *pdev)
189{
190 struct lp3943 *lp3943 = dev_get_drvdata(pdev->dev.parent);
191 struct lp3943_gpio *lp3943_gpio;
192
193 lp3943_gpio = devm_kzalloc(&pdev->dev, sizeof(*lp3943_gpio),
194 GFP_KERNEL);
195 if (!lp3943_gpio)
196 return -ENOMEM;
197
198 lp3943_gpio->lp3943 = lp3943;
199 lp3943_gpio->chip = lp3943_gpio_chip;
200 lp3943_gpio->chip.parent = &pdev->dev;
201
202 platform_set_drvdata(pdev, lp3943_gpio);
203
204 return devm_gpiochip_add_data(&pdev->dev, &lp3943_gpio->chip,
205 lp3943_gpio);
206}
207
208static const struct of_device_id lp3943_gpio_of_match[] = {
209 { .compatible = "ti,lp3943-gpio", },
210 { }
211};
212MODULE_DEVICE_TABLE(of, lp3943_gpio_of_match);
213
214static struct platform_driver lp3943_gpio_driver = {
215 .probe = lp3943_gpio_probe,
216 .driver = {
217 .name = "lp3943-gpio",
218 .of_match_table = lp3943_gpio_of_match,
219 },
220};
221module_platform_driver(lp3943_gpio_driver);
222
223MODULE_DESCRIPTION("LP3943 GPIO driver");
224MODULE_ALIAS("platform:lp3943-gpio");
225MODULE_AUTHOR("Milo Kim");
226MODULE_LICENSE("GPL");