|
@@ -19,7 +19,9 @@
|
|
|
#include <linux/mutex.h>
|
|
|
#include <linux/workqueue.h>
|
|
|
#include <linux/leds-pca9532.h>
|
|
|
+#include <linux/gpio.h>
|
|
|
|
|
|
+#define PCA9532_REG_INPUT(i) ((i)/8)
|
|
|
#define PCA9532_REG_PSC(i) (0x2+(i)*2)
|
|
|
#define PCA9532_REG_PWM(i) (0x3+(i)*2)
|
|
|
#define PCA9532_REG_LS0 0x6
|
|
@@ -34,6 +36,9 @@ struct pca9532_data {
|
|
|
struct mutex update_lock;
|
|
|
struct input_dev *idev;
|
|
|
struct work_struct work;
|
|
|
+#ifdef CONFIG_LEDS_PCA9532_GPIO
|
|
|
+ struct gpio_chip gpio;
|
|
|
+#endif
|
|
|
u8 pwm[2];
|
|
|
u8 psc[2];
|
|
|
};
|
|
@@ -200,16 +205,68 @@ static void pca9532_led_work(struct work_struct *work)
|
|
|
pca9532_setled(led);
|
|
|
}
|
|
|
|
|
|
-static void pca9532_destroy_devices(struct pca9532_data *data, int n_devs)
|
|
|
+#ifdef CONFIG_LEDS_PCA9532_GPIO
|
|
|
+static int pca9532_gpio_request_pin(struct gpio_chip *gc, unsigned offset)
|
|
|
+{
|
|
|
+ struct pca9532_data *data = container_of(gc, struct pca9532_data, gpio);
|
|
|
+ struct pca9532_led *led = &data->leds[offset];
|
|
|
+
|
|
|
+ if (led->type == PCA9532_TYPE_GPIO)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ return -EBUSY;
|
|
|
+}
|
|
|
+
|
|
|
+static void pca9532_gpio_set_value(struct gpio_chip *gc, unsigned offset, int val)
|
|
|
+{
|
|
|
+ struct pca9532_data *data = container_of(gc, struct pca9532_data, gpio);
|
|
|
+ struct pca9532_led *led = &data->leds[offset];
|
|
|
+
|
|
|
+ if (val)
|
|
|
+ led->state = PCA9532_ON;
|
|
|
+ else
|
|
|
+ led->state = PCA9532_OFF;
|
|
|
+
|
|
|
+ pca9532_setled(led);
|
|
|
+}
|
|
|
+
|
|
|
+static int pca9532_gpio_get_value(struct gpio_chip *gc, unsigned offset)
|
|
|
+{
|
|
|
+ struct pca9532_data *data = container_of(gc, struct pca9532_data, gpio);
|
|
|
+ unsigned char reg;
|
|
|
+
|
|
|
+ reg = i2c_smbus_read_byte_data(data->client, PCA9532_REG_INPUT(offset));
|
|
|
+
|
|
|
+ return !!(reg & (1 << (offset % 8)));
|
|
|
+}
|
|
|
+
|
|
|
+static int pca9532_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
|
|
|
+{
|
|
|
+ /* To use as input ensure pin is not driven */
|
|
|
+ pca9532_gpio_set_value(gc, offset, 0);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int pca9532_gpio_direction_output(struct gpio_chip *gc, unsigned offset, int val)
|
|
|
+{
|
|
|
+ pca9532_gpio_set_value(gc, offset, val);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+#endif /* CONFIG_LEDS_PCA9532_GPIO */
|
|
|
+
|
|
|
+static int pca9532_destroy_devices(struct pca9532_data *data, int n_devs)
|
|
|
{
|
|
|
int i = n_devs;
|
|
|
|
|
|
if (!data)
|
|
|
- return;
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
while (--i >= 0) {
|
|
|
switch (data->leds[i].type) {
|
|
|
case PCA9532_TYPE_NONE:
|
|
|
+ case PCA9532_TYPE_GPIO:
|
|
|
break;
|
|
|
case PCA9532_TYPE_LED:
|
|
|
led_classdev_unregister(&data->leds[i].ldev);
|
|
@@ -224,12 +281,26 @@ static void pca9532_destroy_devices(struct pca9532_data *data, int n_devs)
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
+
|
|
|
+#ifdef CONFIG_LEDS_PCA9532_GPIO
|
|
|
+ if (data->gpio.dev) {
|
|
|
+ int err = gpiochip_remove(&data->gpio);
|
|
|
+ if (err) {
|
|
|
+ dev_err(&data->client->dev, "%s failed, %d\n",
|
|
|
+ "gpiochip_remove()", err);
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
static int pca9532_configure(struct i2c_client *client,
|
|
|
struct pca9532_data *data, struct pca9532_platform_data *pdata)
|
|
|
{
|
|
|
int i, err = 0;
|
|
|
+ int gpios = 0;
|
|
|
|
|
|
for (i = 0; i < 2; i++) {
|
|
|
data->pwm[i] = pdata->pwm[i];
|
|
@@ -249,6 +320,9 @@ static int pca9532_configure(struct i2c_client *client,
|
|
|
switch (led->type) {
|
|
|
case PCA9532_TYPE_NONE:
|
|
|
break;
|
|
|
+ case PCA9532_TYPE_GPIO:
|
|
|
+ gpios++;
|
|
|
+ break;
|
|
|
case PCA9532_TYPE_LED:
|
|
|
led->state = pled->state;
|
|
|
led->name = pled->name;
|
|
@@ -297,6 +371,34 @@ static int pca9532_configure(struct i2c_client *client,
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
+
|
|
|
+#ifdef CONFIG_LEDS_PCA9532_GPIO
|
|
|
+ if (gpios) {
|
|
|
+ data->gpio.label = "gpio-pca9532";
|
|
|
+ data->gpio.direction_input = pca9532_gpio_direction_input;
|
|
|
+ data->gpio.direction_output = pca9532_gpio_direction_output;
|
|
|
+ data->gpio.set = pca9532_gpio_set_value;
|
|
|
+ data->gpio.get = pca9532_gpio_get_value;
|
|
|
+ data->gpio.request = pca9532_gpio_request_pin;
|
|
|
+ data->gpio.can_sleep = 1;
|
|
|
+ data->gpio.base = pdata->gpio_base;
|
|
|
+ data->gpio.ngpio = 16;
|
|
|
+ data->gpio.dev = &client->dev;
|
|
|
+ data->gpio.owner = THIS_MODULE;
|
|
|
+
|
|
|
+ err = gpiochip_add(&data->gpio);
|
|
|
+ if (err) {
|
|
|
+ /* Use data->gpio.dev as a flag for freeing gpiochip */
|
|
|
+ data->gpio.dev = NULL;
|
|
|
+ dev_warn(&client->dev, "could not add gpiochip\n");
|
|
|
+ } else {
|
|
|
+ dev_info(&client->dev, "gpios %i...%i\n",
|
|
|
+ data->gpio.base, data->gpio.base +
|
|
|
+ data->gpio.ngpio - 1);
|
|
|
+ }
|
|
|
+ }
|
|
|
+#endif
|
|
|
+
|
|
|
return 0;
|
|
|
|
|
|
exit:
|
|
@@ -337,7 +439,12 @@ static int pca9532_probe(struct i2c_client *client,
|
|
|
static int pca9532_remove(struct i2c_client *client)
|
|
|
{
|
|
|
struct pca9532_data *data = i2c_get_clientdata(client);
|
|
|
- pca9532_destroy_devices(data, 16);
|
|
|
+ int err;
|
|
|
+
|
|
|
+ err = pca9532_destroy_devices(data, 16);
|
|
|
+ if (err)
|
|
|
+ return err;
|
|
|
+
|
|
|
kfree(data);
|
|
|
return 0;
|
|
|
}
|