1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/gpio.h>
15#include <linux/module.h>
16#include <linux/of.h>
17#include <linux/pinctrl/pinconf-generic.h>
18#include <linux/pinctrl/pinconf.h>
19#include <linux/pinctrl/pinmux.h>
20#include <linux/platform_device.h>
21#include <linux/regmap.h>
22#include <linux/slab.h>
23#include <linux/types.h>
24
25#include <dt-bindings/pinctrl/qcom,pmic-mpp.h>
26
27#include "../core.h"
28#include "../pinctrl-utils.h"
29
30#define PMIC_MPP_ADDRESS_RANGE 0x100
31
32
33
34
35
36
37#define PMIC_MPP_PULL_UP_0P6KOHM 0
38#define PMIC_MPP_PULL_UP_10KOHM 1
39#define PMIC_MPP_PULL_UP_30KOHM 2
40#define PMIC_MPP_PULL_UP_OPEN 3
41
42
43#define PMIC_MPP_REG_TYPE 0x4
44#define PMIC_MPP_REG_SUBTYPE 0x5
45
46
47#define PMIC_MPP_TYPE 0x11
48#define PMIC_MPP_SUBTYPE_4CH_NO_ANA_OUT 0x3
49#define PMIC_MPP_SUBTYPE_ULT_4CH_NO_ANA_OUT 0x4
50#define PMIC_MPP_SUBTYPE_4CH_NO_SINK 0x5
51#define PMIC_MPP_SUBTYPE_ULT_4CH_NO_SINK 0x6
52#define PMIC_MPP_SUBTYPE_4CH_FULL_FUNC 0x7
53#define PMIC_MPP_SUBTYPE_8CH_FULL_FUNC 0xf
54
55#define PMIC_MPP_REG_RT_STS 0x10
56#define PMIC_MPP_REG_RT_STS_VAL_MASK 0x1
57
58
59#define PMIC_MPP_REG_MODE_CTL 0x40
60#define PMIC_MPP_REG_DIG_VIN_CTL 0x41
61#define PMIC_MPP_REG_DIG_PULL_CTL 0x42
62#define PMIC_MPP_REG_DIG_IN_CTL 0x43
63#define PMIC_MPP_REG_EN_CTL 0x46
64#define PMIC_MPP_REG_AOUT_CTL 0x48
65#define PMIC_MPP_REG_AIN_CTL 0x4a
66#define PMIC_MPP_REG_SINK_CTL 0x4c
67
68
69#define PMIC_MPP_REG_MODE_VALUE_MASK 0x1
70#define PMIC_MPP_REG_MODE_FUNCTION_SHIFT 1
71#define PMIC_MPP_REG_MODE_FUNCTION_MASK 0x7
72#define PMIC_MPP_REG_MODE_DIR_SHIFT 4
73#define PMIC_MPP_REG_MODE_DIR_MASK 0x7
74
75
76#define PMIC_MPP_REG_VIN_SHIFT 0
77#define PMIC_MPP_REG_VIN_MASK 0x7
78
79
80#define PMIC_MPP_REG_PULL_SHIFT 0
81#define PMIC_MPP_REG_PULL_MASK 0x7
82
83
84#define PMIC_MPP_REG_MASTER_EN_SHIFT 7
85
86
87#define PMIC_MPP_REG_AIN_ROUTE_SHIFT 0
88#define PMIC_MPP_REG_AIN_ROUTE_MASK 0x7
89
90#define PMIC_MPP_MODE_DIGITAL_INPUT 0
91#define PMIC_MPP_MODE_DIGITAL_OUTPUT 1
92#define PMIC_MPP_MODE_DIGITAL_BIDIR 2
93#define PMIC_MPP_MODE_ANALOG_BIDIR 3
94#define PMIC_MPP_MODE_ANALOG_INPUT 4
95#define PMIC_MPP_MODE_ANALOG_OUTPUT 5
96#define PMIC_MPP_MODE_CURRENT_SINK 6
97
98#define PMIC_MPP_SELECTOR_NORMAL 0
99#define PMIC_MPP_SELECTOR_PAIRED 1
100#define PMIC_MPP_SELECTOR_DTEST_FIRST 4
101
102#define PMIC_MPP_PHYSICAL_OFFSET 1
103
104
105#define PMIC_MPP_CONF_AMUX_ROUTE (PIN_CONFIG_END + 1)
106#define PMIC_MPP_CONF_ANALOG_LEVEL (PIN_CONFIG_END + 2)
107#define PMIC_MPP_CONF_DTEST_SELECTOR (PIN_CONFIG_END + 3)
108#define PMIC_MPP_CONF_PAIRED (PIN_CONFIG_END + 4)
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128struct pmic_mpp_pad {
129 u16 base;
130 int irq;
131 bool is_enabled;
132 bool out_value;
133 bool output_enabled;
134 bool input_enabled;
135 bool paired;
136 unsigned int num_sources;
137 unsigned int power_source;
138 unsigned int amux_input;
139 unsigned int aout_level;
140 unsigned int pullup;
141 unsigned int function;
142 unsigned int drive_strength;
143 unsigned int dtest;
144};
145
146struct pmic_mpp_state {
147 struct device *dev;
148 struct regmap *map;
149 struct pinctrl_dev *ctrl;
150 struct gpio_chip chip;
151};
152
153static const struct pinconf_generic_params pmic_mpp_bindings[] = {
154 {"qcom,amux-route", PMIC_MPP_CONF_AMUX_ROUTE, 0},
155 {"qcom,analog-level", PMIC_MPP_CONF_ANALOG_LEVEL, 0},
156 {"qcom,dtest", PMIC_MPP_CONF_DTEST_SELECTOR, 0},
157 {"qcom,paired", PMIC_MPP_CONF_PAIRED, 0},
158};
159
160#ifdef CONFIG_DEBUG_FS
161static const struct pin_config_item pmic_conf_items[] = {
162 PCONFDUMP(PMIC_MPP_CONF_AMUX_ROUTE, "analog mux", NULL, true),
163 PCONFDUMP(PMIC_MPP_CONF_ANALOG_LEVEL, "analog level", NULL, true),
164 PCONFDUMP(PMIC_MPP_CONF_DTEST_SELECTOR, "dtest", NULL, true),
165 PCONFDUMP(PMIC_MPP_CONF_PAIRED, "paired", NULL, false),
166};
167#endif
168
169static const char *const pmic_mpp_groups[] = {
170 "mpp1", "mpp2", "mpp3", "mpp4", "mpp5", "mpp6", "mpp7", "mpp8",
171};
172
173#define PMIC_MPP_DIGITAL 0
174#define PMIC_MPP_ANALOG 1
175#define PMIC_MPP_SINK 2
176
177static const char *const pmic_mpp_functions[] = {
178 "digital", "analog", "sink"
179};
180
181static inline struct pmic_mpp_state *to_mpp_state(struct gpio_chip *chip)
182{
183 return container_of(chip, struct pmic_mpp_state, chip);
184};
185
186static int pmic_mpp_read(struct pmic_mpp_state *state,
187 struct pmic_mpp_pad *pad, unsigned int addr)
188{
189 unsigned int val;
190 int ret;
191
192 ret = regmap_read(state->map, pad->base + addr, &val);
193 if (ret < 0)
194 dev_err(state->dev, "read 0x%x failed\n", addr);
195 else
196 ret = val;
197
198 return ret;
199}
200
201static int pmic_mpp_write(struct pmic_mpp_state *state,
202 struct pmic_mpp_pad *pad, unsigned int addr,
203 unsigned int val)
204{
205 int ret;
206
207 ret = regmap_write(state->map, pad->base + addr, val);
208 if (ret < 0)
209 dev_err(state->dev, "write 0x%x failed\n", addr);
210
211 return ret;
212}
213
214static int pmic_mpp_get_groups_count(struct pinctrl_dev *pctldev)
215{
216
217 return pctldev->desc->npins;
218}
219
220static const char *pmic_mpp_get_group_name(struct pinctrl_dev *pctldev,
221 unsigned pin)
222{
223 return pctldev->desc->pins[pin].name;
224}
225
226static int pmic_mpp_get_group_pins(struct pinctrl_dev *pctldev,
227 unsigned pin,
228 const unsigned **pins, unsigned *num_pins)
229{
230 *pins = &pctldev->desc->pins[pin].number;
231 *num_pins = 1;
232 return 0;
233}
234
235static const struct pinctrl_ops pmic_mpp_pinctrl_ops = {
236 .get_groups_count = pmic_mpp_get_groups_count,
237 .get_group_name = pmic_mpp_get_group_name,
238 .get_group_pins = pmic_mpp_get_group_pins,
239 .dt_node_to_map = pinconf_generic_dt_node_to_map_group,
240 .dt_free_map = pinctrl_utils_dt_free_map,
241};
242
243static int pmic_mpp_get_functions_count(struct pinctrl_dev *pctldev)
244{
245 return ARRAY_SIZE(pmic_mpp_functions);
246}
247
248static const char *pmic_mpp_get_function_name(struct pinctrl_dev *pctldev,
249 unsigned function)
250{
251 return pmic_mpp_functions[function];
252}
253
254static int pmic_mpp_get_function_groups(struct pinctrl_dev *pctldev,
255 unsigned function,
256 const char *const **groups,
257 unsigned *const num_qgroups)
258{
259 *groups = pmic_mpp_groups;
260 *num_qgroups = pctldev->desc->npins;
261 return 0;
262}
263
264static int pmic_mpp_write_mode_ctl(struct pmic_mpp_state *state,
265 struct pmic_mpp_pad *pad)
266{
267 unsigned int mode;
268 unsigned int sel;
269 unsigned int val;
270 unsigned int en;
271
272 switch (pad->function) {
273 case PMIC_MPP_ANALOG:
274 if (pad->input_enabled && pad->output_enabled)
275 mode = PMIC_MPP_MODE_ANALOG_BIDIR;
276 else if (pad->input_enabled)
277 mode = PMIC_MPP_MODE_ANALOG_INPUT;
278 else
279 mode = PMIC_MPP_MODE_ANALOG_OUTPUT;
280 break;
281 case PMIC_MPP_DIGITAL:
282 if (pad->input_enabled && pad->output_enabled)
283 mode = PMIC_MPP_MODE_DIGITAL_BIDIR;
284 else if (pad->input_enabled)
285 mode = PMIC_MPP_MODE_DIGITAL_INPUT;
286 else
287 mode = PMIC_MPP_MODE_DIGITAL_OUTPUT;
288 break;
289 case PMIC_MPP_SINK:
290 default:
291 mode = PMIC_MPP_MODE_CURRENT_SINK;
292 break;
293 }
294
295 if (pad->dtest)
296 sel = PMIC_MPP_SELECTOR_DTEST_FIRST + pad->dtest - 1;
297 else if (pad->paired)
298 sel = PMIC_MPP_SELECTOR_PAIRED;
299 else
300 sel = PMIC_MPP_SELECTOR_NORMAL;
301
302 en = !!pad->out_value;
303
304 val = mode << PMIC_MPP_REG_MODE_DIR_SHIFT |
305 sel << PMIC_MPP_REG_MODE_FUNCTION_SHIFT |
306 en;
307
308 return pmic_mpp_write(state, pad, PMIC_MPP_REG_MODE_CTL, val);
309}
310
311static int pmic_mpp_set_mux(struct pinctrl_dev *pctldev, unsigned function,
312 unsigned pin)
313{
314 struct pmic_mpp_state *state = pinctrl_dev_get_drvdata(pctldev);
315 struct pmic_mpp_pad *pad;
316 unsigned int val;
317 int ret;
318
319 pad = pctldev->desc->pins[pin].drv_data;
320
321 pad->function = function;
322
323 ret = pmic_mpp_write_mode_ctl(state, pad);
324
325 val = pad->is_enabled << PMIC_MPP_REG_MASTER_EN_SHIFT;
326
327 return pmic_mpp_write(state, pad, PMIC_MPP_REG_EN_CTL, val);
328}
329
330static const struct pinmux_ops pmic_mpp_pinmux_ops = {
331 .get_functions_count = pmic_mpp_get_functions_count,
332 .get_function_name = pmic_mpp_get_function_name,
333 .get_function_groups = pmic_mpp_get_function_groups,
334 .set_mux = pmic_mpp_set_mux,
335};
336
337static int pmic_mpp_config_get(struct pinctrl_dev *pctldev,
338 unsigned int pin, unsigned long *config)
339{
340 unsigned param = pinconf_to_config_param(*config);
341 struct pmic_mpp_pad *pad;
342 unsigned arg = 0;
343
344 pad = pctldev->desc->pins[pin].drv_data;
345
346 switch (param) {
347 case PIN_CONFIG_BIAS_DISABLE:
348 arg = pad->pullup == PMIC_MPP_PULL_UP_OPEN;
349 break;
350 case PIN_CONFIG_BIAS_PULL_UP:
351 switch (pad->pullup) {
352 case PMIC_MPP_PULL_UP_OPEN:
353 arg = 0;
354 break;
355 case PMIC_MPP_PULL_UP_0P6KOHM:
356 arg = 600;
357 break;
358 case PMIC_MPP_PULL_UP_10KOHM:
359 arg = 10000;
360 break;
361 case PMIC_MPP_PULL_UP_30KOHM:
362 arg = 30000;
363 break;
364 default:
365 return -EINVAL;
366 }
367 break;
368 case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
369 arg = !pad->is_enabled;
370 break;
371 case PIN_CONFIG_POWER_SOURCE:
372 arg = pad->power_source;
373 break;
374 case PIN_CONFIG_INPUT_ENABLE:
375 arg = pad->input_enabled;
376 break;
377 case PIN_CONFIG_OUTPUT:
378 arg = pad->out_value;
379 break;
380 case PMIC_MPP_CONF_DTEST_SELECTOR:
381 arg = pad->dtest;
382 break;
383 case PMIC_MPP_CONF_AMUX_ROUTE:
384 arg = pad->amux_input;
385 break;
386 case PMIC_MPP_CONF_PAIRED:
387 arg = pad->paired;
388 break;
389 case PIN_CONFIG_DRIVE_STRENGTH:
390 arg = pad->drive_strength;
391 break;
392 case PMIC_MPP_CONF_ANALOG_LEVEL:
393 arg = pad->aout_level;
394 break;
395 default:
396 return -EINVAL;
397 }
398
399
400 *config = pinconf_to_config_packed(param, arg);
401 return 0;
402}
403
404static int pmic_mpp_config_set(struct pinctrl_dev *pctldev, unsigned int pin,
405 unsigned long *configs, unsigned nconfs)
406{
407 struct pmic_mpp_state *state = pinctrl_dev_get_drvdata(pctldev);
408 struct pmic_mpp_pad *pad;
409 unsigned param, arg;
410 unsigned int val;
411 int i, ret;
412
413 pad = pctldev->desc->pins[pin].drv_data;
414
415
416 pad->is_enabled = true;
417
418 for (i = 0; i < nconfs; i++) {
419 param = pinconf_to_config_param(configs[i]);
420 arg = pinconf_to_config_argument(configs[i]);
421
422 switch (param) {
423 case PIN_CONFIG_BIAS_DISABLE:
424 pad->pullup = PMIC_MPP_PULL_UP_OPEN;
425 break;
426 case PIN_CONFIG_BIAS_PULL_UP:
427 switch (arg) {
428 case 600:
429 pad->pullup = PMIC_MPP_PULL_UP_0P6KOHM;
430 break;
431 case 10000:
432 pad->pullup = PMIC_MPP_PULL_UP_10KOHM;
433 break;
434 case 30000:
435 pad->pullup = PMIC_MPP_PULL_UP_30KOHM;
436 break;
437 default:
438 return -EINVAL;
439 }
440 break;
441 case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
442 pad->is_enabled = false;
443 break;
444 case PIN_CONFIG_POWER_SOURCE:
445 if (arg >= pad->num_sources)
446 return -EINVAL;
447 pad->power_source = arg;
448 break;
449 case PIN_CONFIG_INPUT_ENABLE:
450 pad->input_enabled = arg ? true : false;
451 break;
452 case PIN_CONFIG_OUTPUT:
453 pad->output_enabled = true;
454 pad->out_value = arg;
455 break;
456 case PMIC_MPP_CONF_DTEST_SELECTOR:
457 pad->dtest = arg;
458 break;
459 case PIN_CONFIG_DRIVE_STRENGTH:
460 arg = pad->drive_strength;
461 break;
462 case PMIC_MPP_CONF_AMUX_ROUTE:
463 if (arg >= PMIC_MPP_AMUX_ROUTE_ABUS4)
464 return -EINVAL;
465 pad->amux_input = arg;
466 break;
467 case PMIC_MPP_CONF_ANALOG_LEVEL:
468 pad->aout_level = arg;
469 break;
470 case PMIC_MPP_CONF_PAIRED:
471 pad->paired = !!arg;
472 break;
473 default:
474 return -EINVAL;
475 }
476 }
477
478 val = pad->power_source << PMIC_MPP_REG_VIN_SHIFT;
479
480 ret = pmic_mpp_write(state, pad, PMIC_MPP_REG_DIG_VIN_CTL, val);
481 if (ret < 0)
482 return ret;
483
484 val = pad->pullup << PMIC_MPP_REG_PULL_SHIFT;
485
486 ret = pmic_mpp_write(state, pad, PMIC_MPP_REG_DIG_PULL_CTL, val);
487 if (ret < 0)
488 return ret;
489
490 val = pad->amux_input & PMIC_MPP_REG_AIN_ROUTE_MASK;
491
492 ret = pmic_mpp_write(state, pad, PMIC_MPP_REG_AIN_CTL, val);
493 if (ret < 0)
494 return ret;
495
496 ret = pmic_mpp_write(state, pad, PMIC_MPP_REG_AOUT_CTL, pad->aout_level);
497 if (ret < 0)
498 return ret;
499
500 ret = pmic_mpp_write_mode_ctl(state, pad);
501 if (ret < 0)
502 return ret;
503
504 val = pad->is_enabled << PMIC_MPP_REG_MASTER_EN_SHIFT;
505
506 return pmic_mpp_write(state, pad, PMIC_MPP_REG_EN_CTL, val);
507}
508
509static void pmic_mpp_config_dbg_show(struct pinctrl_dev *pctldev,
510 struct seq_file *s, unsigned pin)
511{
512 struct pmic_mpp_state *state = pinctrl_dev_get_drvdata(pctldev);
513 struct pmic_mpp_pad *pad;
514 int ret;
515
516 static const char *const biases[] = {
517 "0.6kOhm", "10kOhm", "30kOhm", "Disabled"
518 };
519
520 pad = pctldev->desc->pins[pin].drv_data;
521
522 seq_printf(s, " mpp%-2d:", pin + PMIC_MPP_PHYSICAL_OFFSET);
523
524 if (!pad->is_enabled) {
525 seq_puts(s, " ---");
526 } else {
527
528 if (pad->input_enabled) {
529 ret = pmic_mpp_read(state, pad, PMIC_MPP_REG_RT_STS);
530 if (ret < 0)
531 return;
532
533 ret &= PMIC_MPP_REG_RT_STS_VAL_MASK;
534 pad->out_value = ret;
535 }
536
537 seq_printf(s, " %-4s", pad->output_enabled ? "out" : "in");
538 seq_printf(s, " %-7s", pmic_mpp_functions[pad->function]);
539 seq_printf(s, " vin-%d", pad->power_source);
540 seq_printf(s, " %d", pad->aout_level);
541 seq_printf(s, " %-8s", biases[pad->pullup]);
542 seq_printf(s, " %-4s", pad->out_value ? "high" : "low");
543 if (pad->dtest)
544 seq_printf(s, " dtest%d", pad->dtest);
545 if (pad->paired)
546 seq_puts(s, " paired");
547 }
548}
549
550static const struct pinconf_ops pmic_mpp_pinconf_ops = {
551 .is_generic = true,
552 .pin_config_group_get = pmic_mpp_config_get,
553 .pin_config_group_set = pmic_mpp_config_set,
554 .pin_config_group_dbg_show = pmic_mpp_config_dbg_show,
555};
556
557static int pmic_mpp_direction_input(struct gpio_chip *chip, unsigned pin)
558{
559 struct pmic_mpp_state *state = to_mpp_state(chip);
560 unsigned long config;
561
562 config = pinconf_to_config_packed(PIN_CONFIG_INPUT_ENABLE, 1);
563
564 return pmic_mpp_config_set(state->ctrl, pin, &config, 1);
565}
566
567static int pmic_mpp_direction_output(struct gpio_chip *chip,
568 unsigned pin, int val)
569{
570 struct pmic_mpp_state *state = to_mpp_state(chip);
571 unsigned long config;
572
573 config = pinconf_to_config_packed(PIN_CONFIG_OUTPUT, val);
574
575 return pmic_mpp_config_set(state->ctrl, pin, &config, 1);
576}
577
578static int pmic_mpp_get(struct gpio_chip *chip, unsigned pin)
579{
580 struct pmic_mpp_state *state = to_mpp_state(chip);
581 struct pmic_mpp_pad *pad;
582 int ret;
583
584 pad = state->ctrl->desc->pins[pin].drv_data;
585
586 if (pad->input_enabled) {
587 ret = pmic_mpp_read(state, pad, PMIC_MPP_REG_RT_STS);
588 if (ret < 0)
589 return ret;
590
591 pad->out_value = ret & PMIC_MPP_REG_RT_STS_VAL_MASK;
592 }
593
594 return pad->out_value;
595}
596
597static void pmic_mpp_set(struct gpio_chip *chip, unsigned pin, int value)
598{
599 struct pmic_mpp_state *state = to_mpp_state(chip);
600 unsigned long config;
601
602 config = pinconf_to_config_packed(PIN_CONFIG_OUTPUT, value);
603
604 pmic_mpp_config_set(state->ctrl, pin, &config, 1);
605}
606
607static int pmic_mpp_of_xlate(struct gpio_chip *chip,
608 const struct of_phandle_args *gpio_desc,
609 u32 *flags)
610{
611 if (chip->of_gpio_n_cells < 2)
612 return -EINVAL;
613
614 if (flags)
615 *flags = gpio_desc->args[1];
616
617 return gpio_desc->args[0] - PMIC_MPP_PHYSICAL_OFFSET;
618}
619
620static int pmic_mpp_to_irq(struct gpio_chip *chip, unsigned pin)
621{
622 struct pmic_mpp_state *state = to_mpp_state(chip);
623 struct pmic_mpp_pad *pad;
624
625 pad = state->ctrl->desc->pins[pin].drv_data;
626
627 return pad->irq;
628}
629
630static void pmic_mpp_dbg_show(struct seq_file *s, struct gpio_chip *chip)
631{
632 struct pmic_mpp_state *state = to_mpp_state(chip);
633 unsigned i;
634
635 for (i = 0; i < chip->ngpio; i++) {
636 pmic_mpp_config_dbg_show(state->ctrl, s, i);
637 seq_puts(s, "\n");
638 }
639}
640
641static const struct gpio_chip pmic_mpp_gpio_template = {
642 .direction_input = pmic_mpp_direction_input,
643 .direction_output = pmic_mpp_direction_output,
644 .get = pmic_mpp_get,
645 .set = pmic_mpp_set,
646 .request = gpiochip_generic_request,
647 .free = gpiochip_generic_free,
648 .of_xlate = pmic_mpp_of_xlate,
649 .to_irq = pmic_mpp_to_irq,
650 .dbg_show = pmic_mpp_dbg_show,
651};
652
653static int pmic_mpp_populate(struct pmic_mpp_state *state,
654 struct pmic_mpp_pad *pad)
655{
656 int type, subtype, val, dir;
657 unsigned int sel;
658
659 type = pmic_mpp_read(state, pad, PMIC_MPP_REG_TYPE);
660 if (type < 0)
661 return type;
662
663 if (type != PMIC_MPP_TYPE) {
664 dev_err(state->dev, "incorrect block type 0x%x at 0x%x\n",
665 type, pad->base);
666 return -ENODEV;
667 }
668
669 subtype = pmic_mpp_read(state, pad, PMIC_MPP_REG_SUBTYPE);
670 if (subtype < 0)
671 return subtype;
672
673 switch (subtype) {
674 case PMIC_MPP_SUBTYPE_4CH_NO_ANA_OUT:
675 case PMIC_MPP_SUBTYPE_ULT_4CH_NO_ANA_OUT:
676 case PMIC_MPP_SUBTYPE_4CH_NO_SINK:
677 case PMIC_MPP_SUBTYPE_ULT_4CH_NO_SINK:
678 case PMIC_MPP_SUBTYPE_4CH_FULL_FUNC:
679 pad->num_sources = 4;
680 break;
681 case PMIC_MPP_SUBTYPE_8CH_FULL_FUNC:
682 pad->num_sources = 8;
683 break;
684 default:
685 dev_err(state->dev, "unknown MPP type 0x%x at 0x%x\n",
686 subtype, pad->base);
687 return -ENODEV;
688 }
689
690 val = pmic_mpp_read(state, pad, PMIC_MPP_REG_MODE_CTL);
691 if (val < 0)
692 return val;
693
694 pad->out_value = val & PMIC_MPP_REG_MODE_VALUE_MASK;
695
696 dir = val >> PMIC_MPP_REG_MODE_DIR_SHIFT;
697 dir &= PMIC_MPP_REG_MODE_DIR_MASK;
698
699 switch (dir) {
700 case PMIC_MPP_MODE_DIGITAL_INPUT:
701 pad->input_enabled = true;
702 pad->output_enabled = false;
703 pad->function = PMIC_MPP_DIGITAL;
704 break;
705 case PMIC_MPP_MODE_DIGITAL_OUTPUT:
706 pad->input_enabled = false;
707 pad->output_enabled = true;
708 pad->function = PMIC_MPP_DIGITAL;
709 break;
710 case PMIC_MPP_MODE_DIGITAL_BIDIR:
711 pad->input_enabled = true;
712 pad->output_enabled = true;
713 pad->function = PMIC_MPP_DIGITAL;
714 break;
715 case PMIC_MPP_MODE_ANALOG_BIDIR:
716 pad->input_enabled = true;
717 pad->output_enabled = true;
718 pad->function = PMIC_MPP_ANALOG;
719 break;
720 case PMIC_MPP_MODE_ANALOG_INPUT:
721 pad->input_enabled = true;
722 pad->output_enabled = false;
723 pad->function = PMIC_MPP_ANALOG;
724 break;
725 case PMIC_MPP_MODE_ANALOG_OUTPUT:
726 pad->input_enabled = false;
727 pad->output_enabled = true;
728 pad->function = PMIC_MPP_ANALOG;
729 break;
730 case PMIC_MPP_MODE_CURRENT_SINK:
731 pad->input_enabled = false;
732 pad->output_enabled = true;
733 pad->function = PMIC_MPP_SINK;
734 break;
735 default:
736 dev_err(state->dev, "unknown MPP direction\n");
737 return -ENODEV;
738 }
739
740 sel = val >> PMIC_MPP_REG_MODE_FUNCTION_SHIFT;
741 sel &= PMIC_MPP_REG_MODE_FUNCTION_MASK;
742
743 if (sel >= PMIC_MPP_SELECTOR_DTEST_FIRST)
744 pad->dtest = sel + 1;
745 else if (sel == PMIC_MPP_SELECTOR_PAIRED)
746 pad->paired = true;
747
748 val = pmic_mpp_read(state, pad, PMIC_MPP_REG_DIG_VIN_CTL);
749 if (val < 0)
750 return val;
751
752 pad->power_source = val >> PMIC_MPP_REG_VIN_SHIFT;
753 pad->power_source &= PMIC_MPP_REG_VIN_MASK;
754
755 val = pmic_mpp_read(state, pad, PMIC_MPP_REG_DIG_PULL_CTL);
756 if (val < 0)
757 return val;
758
759 pad->pullup = val >> PMIC_MPP_REG_PULL_SHIFT;
760 pad->pullup &= PMIC_MPP_REG_PULL_MASK;
761
762 val = pmic_mpp_read(state, pad, PMIC_MPP_REG_AIN_CTL);
763 if (val < 0)
764 return val;
765
766 pad->amux_input = val >> PMIC_MPP_REG_AIN_ROUTE_SHIFT;
767 pad->amux_input &= PMIC_MPP_REG_AIN_ROUTE_MASK;
768
769 val = pmic_mpp_read(state, pad, PMIC_MPP_REG_SINK_CTL);
770 if (val < 0)
771 return val;
772
773 pad->drive_strength = val;
774
775 val = pmic_mpp_read(state, pad, PMIC_MPP_REG_AOUT_CTL);
776 if (val < 0)
777 return val;
778
779 pad->aout_level = val;
780
781 val = pmic_mpp_read(state, pad, PMIC_MPP_REG_EN_CTL);
782 if (val < 0)
783 return val;
784
785 pad->is_enabled = !!val;
786
787 return 0;
788}
789
790static int pmic_mpp_probe(struct platform_device *pdev)
791{
792 struct device *dev = &pdev->dev;
793 struct pinctrl_pin_desc *pindesc;
794 struct pinctrl_desc *pctrldesc;
795 struct pmic_mpp_pad *pad, *pads;
796 struct pmic_mpp_state *state;
797 int ret, npins, i;
798 u32 res[2];
799
800 ret = of_property_read_u32_array(dev->of_node, "reg", res, 2);
801 if (ret < 0) {
802 dev_err(dev, "missing base address and/or range");
803 return ret;
804 }
805
806 npins = res[1] / PMIC_MPP_ADDRESS_RANGE;
807 if (!npins)
808 return -EINVAL;
809
810 BUG_ON(npins > ARRAY_SIZE(pmic_mpp_groups));
811
812 state = devm_kzalloc(dev, sizeof(*state), GFP_KERNEL);
813 if (!state)
814 return -ENOMEM;
815
816 platform_set_drvdata(pdev, state);
817
818 state->dev = &pdev->dev;
819 state->map = dev_get_regmap(dev->parent, NULL);
820
821 pindesc = devm_kcalloc(dev, npins, sizeof(*pindesc), GFP_KERNEL);
822 if (!pindesc)
823 return -ENOMEM;
824
825 pads = devm_kcalloc(dev, npins, sizeof(*pads), GFP_KERNEL);
826 if (!pads)
827 return -ENOMEM;
828
829 pctrldesc = devm_kzalloc(dev, sizeof(*pctrldesc), GFP_KERNEL);
830 if (!pctrldesc)
831 return -ENOMEM;
832
833 pctrldesc->pctlops = &pmic_mpp_pinctrl_ops;
834 pctrldesc->pmxops = &pmic_mpp_pinmux_ops;
835 pctrldesc->confops = &pmic_mpp_pinconf_ops;
836 pctrldesc->owner = THIS_MODULE;
837 pctrldesc->name = dev_name(dev);
838 pctrldesc->pins = pindesc;
839 pctrldesc->npins = npins;
840
841 pctrldesc->num_custom_params = ARRAY_SIZE(pmic_mpp_bindings);
842 pctrldesc->custom_params = pmic_mpp_bindings;
843#ifdef CONFIG_DEBUG_FS
844 pctrldesc->custom_conf_items = pmic_conf_items;
845#endif
846
847 for (i = 0; i < npins; i++, pindesc++) {
848 pad = &pads[i];
849 pindesc->drv_data = pad;
850 pindesc->number = i;
851 pindesc->name = pmic_mpp_groups[i];
852
853 pad->irq = platform_get_irq(pdev, i);
854 if (pad->irq < 0)
855 return pad->irq;
856
857 pad->base = res[0] + i * PMIC_MPP_ADDRESS_RANGE;
858
859 ret = pmic_mpp_populate(state, pad);
860 if (ret < 0)
861 return ret;
862 }
863
864 state->chip = pmic_mpp_gpio_template;
865 state->chip.dev = dev;
866 state->chip.base = -1;
867 state->chip.ngpio = npins;
868 state->chip.label = dev_name(dev);
869 state->chip.of_gpio_n_cells = 2;
870 state->chip.can_sleep = false;
871
872 state->ctrl = pinctrl_register(pctrldesc, dev, state);
873 if (IS_ERR(state->ctrl))
874 return PTR_ERR(state->ctrl);
875
876 ret = gpiochip_add(&state->chip);
877 if (ret) {
878 dev_err(state->dev, "can't add gpio chip\n");
879 goto err_chip;
880 }
881
882 ret = gpiochip_add_pin_range(&state->chip, dev_name(dev), 0, 0, npins);
883 if (ret) {
884 dev_err(dev, "failed to add pin range\n");
885 goto err_range;
886 }
887
888 return 0;
889
890err_range:
891 gpiochip_remove(&state->chip);
892err_chip:
893 pinctrl_unregister(state->ctrl);
894 return ret;
895}
896
897static int pmic_mpp_remove(struct platform_device *pdev)
898{
899 struct pmic_mpp_state *state = platform_get_drvdata(pdev);
900
901 gpiochip_remove(&state->chip);
902 pinctrl_unregister(state->ctrl);
903 return 0;
904}
905
906static const struct of_device_id pmic_mpp_of_match[] = {
907 { .compatible = "qcom,pm8841-mpp" },
908 { .compatible = "qcom,pm8916-mpp" },
909 { .compatible = "qcom,pm8941-mpp" },
910 { .compatible = "qcom,pma8084-mpp" },
911 { },
912};
913
914MODULE_DEVICE_TABLE(of, pmic_mpp_of_match);
915
916static struct platform_driver pmic_mpp_driver = {
917 .driver = {
918 .name = "qcom-spmi-mpp",
919 .of_match_table = pmic_mpp_of_match,
920 },
921 .probe = pmic_mpp_probe,
922 .remove = pmic_mpp_remove,
923};
924
925module_platform_driver(pmic_mpp_driver);
926
927MODULE_AUTHOR("Ivan T. Ivanov <iivanov@mm-sol.com>");
928MODULE_DESCRIPTION("Qualcomm SPMI PMIC MPP pin control driver");
929MODULE_ALIAS("platform:qcom-spmi-mpp");
930MODULE_LICENSE("GPL v2");
931