Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 1 | /* |
| 2 | * GPIO Greybus driver. |
| 3 | * |
| 4 | * Copyright 2014 Google Inc. |
| 5 | * |
| 6 | * Released under the GPLv2 only. |
| 7 | */ |
| 8 | |
| 9 | #include <linux/kernel.h> |
| 10 | #include <linux/module.h> |
| 11 | #include <linux/slab.h> |
| 12 | #include <linux/gpio.h> |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 13 | #include <linux/gpio/driver.h> |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 14 | #include "greybus.h" |
| 15 | |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 16 | struct gb_gpio_device { |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 17 | struct gpio_chip chip; |
| 18 | struct greybus_device *gdev; |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 19 | struct gpio_chip *gpio; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 20 | // FIXME - some lock? |
| 21 | }; |
| 22 | |
Greg Kroah-Hartman | 6584c8a | 2014-09-01 13:31:31 -0700 | [diff] [blame] | 23 | static const struct greybus_module_id id_table[] = { |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 24 | { GREYBUS_DEVICE(0x44, 0x44) }, /* make shit up */ |
| 25 | { }, /* terminating NULL entry */ |
| 26 | }; |
| 27 | |
| 28 | static int direction_input(struct gpio_chip *gpio, unsigned nr) |
| 29 | { |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 30 | //struct gb_gpio_device *gb_gpio_dev = container_of(gpio, struct gb_gpio_device, chip); |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 31 | |
| 32 | // FIXME - do something there |
| 33 | return 0; |
| 34 | } |
| 35 | |
| 36 | static int direction_output(struct gpio_chip *gpio, unsigned nr, int val) |
| 37 | { |
| 38 | // FIXME - do something there |
| 39 | return 0; |
| 40 | } |
| 41 | |
| 42 | static int gpio_get(struct gpio_chip *gpio, unsigned nr) |
| 43 | { |
| 44 | // FIXME - do something there |
| 45 | return 0; |
| 46 | } |
| 47 | |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 48 | static void gpio_set(struct gpio_chip *gpio, unsigned nr, int val) |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 49 | { |
| 50 | // FIXME - do something there |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 51 | } |
| 52 | |
Greg Kroah-Hartman | db6e1fd | 2014-08-30 16:47:26 -0700 | [diff] [blame] | 53 | int gb_gpio_probe(struct greybus_device *gdev, |
Greg Kroah-Hartman | 6584c8a | 2014-09-01 13:31:31 -0700 | [diff] [blame] | 54 | const struct greybus_module_id *id) |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 55 | { |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 56 | struct gb_gpio_device *gb_gpio; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 57 | struct gpio_chip *gpio; |
| 58 | struct device *dev = &gdev->dev; |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 59 | int retval; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 60 | |
Greg Kroah-Hartman | 8bf23e8 | 2014-08-30 17:18:04 -0700 | [diff] [blame] | 61 | gb_gpio = kzalloc(sizeof(*gb_gpio), GFP_KERNEL); |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 62 | if (!gb_gpio) |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 63 | return -ENOMEM; |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 64 | gb_gpio->gdev = gdev; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 65 | |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 66 | gpio = &gb_gpio->chip; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 67 | |
| 68 | gpio->label = "greybus_gpio"; |
| 69 | gpio->owner = THIS_MODULE; |
| 70 | gpio->direction_input = direction_input; |
| 71 | gpio->direction_output = direction_output; |
| 72 | gpio->get = gpio_get; |
| 73 | gpio->set = gpio_set; |
| 74 | gpio->dbg_show = NULL; |
| 75 | gpio->base = 0; // FIXME!!! |
| 76 | gpio->ngpio = 42; // FIXME!!! |
| 77 | gpio->can_sleep = false; // FIXME!!! |
| 78 | |
Greg Kroah-Hartman | 3be03d4 | 2014-09-01 19:10:06 -0700 | [diff] [blame^] | 79 | gdev->gb_gpio_dev = gb_gpio; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 80 | |
Greg Kroah-Hartman | e9023d2 | 2014-08-12 14:41:49 +0800 | [diff] [blame] | 81 | retval = gpiochip_add(gpio); |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 82 | if (retval) { |
| 83 | dev_err(dev, "Failed to register GPIO\n"); |
| 84 | return retval; |
| 85 | } |
| 86 | |
| 87 | return 0; |
| 88 | } |
| 89 | |
Greg Kroah-Hartman | db6e1fd | 2014-08-30 16:47:26 -0700 | [diff] [blame] | 90 | void gb_gpio_disconnect(struct greybus_device *gdev) |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 91 | { |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 92 | struct gb_gpio_device *gb_gpio_dev; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 93 | |
Greg Kroah-Hartman | 426f29d | 2014-08-30 16:51:21 -0700 | [diff] [blame] | 94 | gb_gpio_dev = gdev->gb_gpio_dev; |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 95 | |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 96 | gpiochip_remove(&gb_gpio_dev->chip); |
Greg Kroah-Hartman | e5f167f | 2014-08-30 17:11:41 -0700 | [diff] [blame] | 97 | kfree(gb_gpio_dev); |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 98 | } |
| 99 | |
Greg Kroah-Hartman | db6e1fd | 2014-08-30 16:47:26 -0700 | [diff] [blame] | 100 | #if 0 |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 101 | static struct greybus_driver gpio_gb_driver = { |
Greg Kroah-Hartman | db6e1fd | 2014-08-30 16:47:26 -0700 | [diff] [blame] | 102 | .probe = gb_gpio_probe, |
| 103 | .disconnect = gb_gpio_disconnect, |
Greg Kroah-Hartman | c16854c | 2014-08-12 12:00:16 +0800 | [diff] [blame] | 104 | .id_table = id_table, |
| 105 | }; |
| 106 | |
| 107 | module_greybus_driver(gpio_gb_driver); |
| 108 | MODULE_LICENSE("GPL"); |
| 109 | MODULE_DESCRIPTION("Greybus GPIO driver"); |
| 110 | MODULE_AUTHOR("Greg Kroah-Hartman <gregkh@linuxfoundation.org>"); |
Greg Kroah-Hartman | db6e1fd | 2014-08-30 16:47:26 -0700 | [diff] [blame] | 111 | #endif |