2 * GPIO driver for Analog Devices ADP5520 MFD PMICs
4 * Copyright 2009 Analog Devices Inc.
6 * Licensed under the GPL-2 or later.
9 #include <linux/module.h>
10 #include <linux/slab.h>
11 #include <linux/kernel.h>
12 #include <linux/init.h>
13 #include <linux/platform_device.h>
14 #include <linux/mfd/adp5520.h>
16 #include <linux/gpio.h>
19 struct device
*master
;
20 struct gpio_chip gpio_chip
;
21 unsigned char lut
[ADP5520_MAXGPIOS
];
25 static int adp5520_gpio_get_value(struct gpio_chip
*chip
, unsigned off
)
27 struct adp5520_gpio
*dev
;
30 dev
= container_of(chip
, struct adp5520_gpio
, gpio_chip
);
33 * There are dedicated registers for GPIO IN/OUT.
34 * Make sure we return the right value, even when configured as output
37 if (test_bit(off
, &dev
->output
))
38 adp5520_read(dev
->master
, ADP5520_GPIO_OUT
, ®_val
);
40 adp5520_read(dev
->master
, ADP5520_GPIO_IN
, ®_val
);
42 return !!(reg_val
& dev
->lut
[off
]);
45 static void adp5520_gpio_set_value(struct gpio_chip
*chip
,
46 unsigned off
, int val
)
48 struct adp5520_gpio
*dev
;
49 dev
= container_of(chip
, struct adp5520_gpio
, gpio_chip
);
52 adp5520_set_bits(dev
->master
, ADP5520_GPIO_OUT
, dev
->lut
[off
]);
54 adp5520_clr_bits(dev
->master
, ADP5520_GPIO_OUT
, dev
->lut
[off
]);
57 static int adp5520_gpio_direction_input(struct gpio_chip
*chip
, unsigned off
)
59 struct adp5520_gpio
*dev
;
60 dev
= container_of(chip
, struct adp5520_gpio
, gpio_chip
);
62 clear_bit(off
, &dev
->output
);
64 return adp5520_clr_bits(dev
->master
, ADP5520_GPIO_CFG_2
,
68 static int adp5520_gpio_direction_output(struct gpio_chip
*chip
,
69 unsigned off
, int val
)
71 struct adp5520_gpio
*dev
;
73 dev
= container_of(chip
, struct adp5520_gpio
, gpio_chip
);
75 set_bit(off
, &dev
->output
);
78 ret
|= adp5520_set_bits(dev
->master
, ADP5520_GPIO_OUT
,
81 ret
|= adp5520_clr_bits(dev
->master
, ADP5520_GPIO_OUT
,
84 ret
|= adp5520_set_bits(dev
->master
, ADP5520_GPIO_CFG_2
,
90 static int adp5520_gpio_probe(struct platform_device
*pdev
)
92 struct adp5520_gpio_platform_data
*pdata
= dev_get_platdata(&pdev
->dev
);
93 struct adp5520_gpio
*dev
;
96 unsigned char ctl_mask
= 0;
99 dev_err(&pdev
->dev
, "missing platform data\n");
103 if (pdev
->id
!= ID_ADP5520
) {
104 dev_err(&pdev
->dev
, "only ADP5520 supports GPIO\n");
108 dev
= devm_kzalloc(&pdev
->dev
, sizeof(*dev
), GFP_KERNEL
);
110 dev_err(&pdev
->dev
, "failed to alloc memory\n");
114 dev
->master
= pdev
->dev
.parent
;
116 for (gpios
= 0, i
= 0; i
< ADP5520_MAXGPIOS
; i
++)
117 if (pdata
->gpio_en_mask
& (1 << i
))
118 dev
->lut
[gpios
++] = 1 << i
;
125 gc
= &dev
->gpio_chip
;
126 gc
->direction_input
= adp5520_gpio_direction_input
;
127 gc
->direction_output
= adp5520_gpio_direction_output
;
128 gc
->get
= adp5520_gpio_get_value
;
129 gc
->set
= adp5520_gpio_set_value
;
132 gc
->base
= pdata
->gpio_start
;
134 gc
->label
= pdev
->name
;
135 gc
->owner
= THIS_MODULE
;
137 ret
= adp5520_clr_bits(dev
->master
, ADP5520_GPIO_CFG_1
,
138 pdata
->gpio_en_mask
);
140 if (pdata
->gpio_en_mask
& ADP5520_GPIO_C3
)
141 ctl_mask
|= ADP5520_C3_MODE
;
143 if (pdata
->gpio_en_mask
& ADP5520_GPIO_R3
)
144 ctl_mask
|= ADP5520_R3_MODE
;
147 ret
= adp5520_set_bits(dev
->master
, ADP5520_LED_CONTROL
,
150 ret
|= adp5520_set_bits(dev
->master
, ADP5520_GPIO_PULLUP
,
151 pdata
->gpio_pullup_mask
);
154 dev_err(&pdev
->dev
, "failed to write\n");
158 ret
= gpiochip_add(&dev
->gpio_chip
);
162 platform_set_drvdata(pdev
, dev
);
169 static int adp5520_gpio_remove(struct platform_device
*pdev
)
171 struct adp5520_gpio
*dev
;
174 dev
= platform_get_drvdata(pdev
);
175 ret
= gpiochip_remove(&dev
->gpio_chip
);
177 dev_err(&pdev
->dev
, "%s failed, %d\n",
178 "gpiochip_remove()", ret
);
185 static struct platform_driver adp5520_gpio_driver
= {
187 .name
= "adp5520-gpio",
188 .owner
= THIS_MODULE
,
190 .probe
= adp5520_gpio_probe
,
191 .remove
= adp5520_gpio_remove
,
194 module_platform_driver(adp5520_gpio_driver
);
196 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
197 MODULE_DESCRIPTION("GPIO ADP5520 Driver");
198 MODULE_LICENSE("GPL");
199 MODULE_ALIAS("platform:adp5520-gpio");