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