Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 1 | /* |
| 2 | * Greybus "Core" |
| 3 | * |
Alex Elder | 4441f47 | 2015-05-22 12:59:16 -0500 | [diff] [blame] | 4 | * Copyright 2014-2015 Google Inc. |
| 5 | * Copyright 2014-2015 Linaro Ltd. |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 6 | * |
| 7 | * Released under the GPLv2 only. |
| 8 | */ |
| 9 | |
| 10 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 11 | |
Bryan O'Donoghue | 5c8ad59 | 2015-09-18 16:38:45 +0100 | [diff] [blame] | 12 | #define CREATE_TRACE_POINTS |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 13 | #include "greybus.h" |
Bryan O'Donoghue | 5c8ad59 | 2015-09-18 16:38:45 +0100 | [diff] [blame] | 14 | #include "greybus_trace.h" |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 15 | |
David Lin | 61e13db | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 16 | #define GB_BUNDLE_AUTOSUSPEND_MS 3000 |
| 17 | |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 18 | /* Allow greybus to be disabled at boot if needed */ |
| 19 | static bool nogreybus; |
| 20 | #ifdef MODULE |
| 21 | module_param(nogreybus, bool, 0444); |
| 22 | #else |
Viresh Kumar | 8597e6b | 2014-10-20 16:45:50 +0530 | [diff] [blame] | 23 | core_param(nogreybus, nogreybus, bool, 0444); |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 24 | #endif |
| 25 | int greybus_disabled(void) |
| 26 | { |
| 27 | return nogreybus; |
| 28 | } |
| 29 | EXPORT_SYMBOL_GPL(greybus_disabled); |
| 30 | |
Viresh Kumar | 129a6fb | 2016-06-09 16:34:36 +0530 | [diff] [blame] | 31 | static bool greybus_match_one_id(struct gb_bundle *bundle, |
Johan Hovold | 700001a | 2015-11-21 10:52:03 +0100 | [diff] [blame] | 32 | const struct greybus_bundle_id *id) |
| 33 | { |
| 34 | if ((id->match_flags & GREYBUS_ID_MATCH_VENDOR) && |
Johan Hovold | 9f59263 | 2015-11-25 15:58:56 +0100 | [diff] [blame] | 35 | (id->vendor != bundle->intf->vendor_id)) |
Viresh Kumar | 129a6fb | 2016-06-09 16:34:36 +0530 | [diff] [blame] | 36 | return false; |
Johan Hovold | 700001a | 2015-11-21 10:52:03 +0100 | [diff] [blame] | 37 | |
| 38 | if ((id->match_flags & GREYBUS_ID_MATCH_PRODUCT) && |
Johan Hovold | 9f59263 | 2015-11-25 15:58:56 +0100 | [diff] [blame] | 39 | (id->product != bundle->intf->product_id)) |
Viresh Kumar | 129a6fb | 2016-06-09 16:34:36 +0530 | [diff] [blame] | 40 | return false; |
Johan Hovold | 700001a | 2015-11-21 10:52:03 +0100 | [diff] [blame] | 41 | |
| 42 | if ((id->match_flags & GREYBUS_ID_MATCH_CLASS) && |
| 43 | (id->class != bundle->class)) |
Viresh Kumar | 129a6fb | 2016-06-09 16:34:36 +0530 | [diff] [blame] | 44 | return false; |
Johan Hovold | 700001a | 2015-11-21 10:52:03 +0100 | [diff] [blame] | 45 | |
Viresh Kumar | 129a6fb | 2016-06-09 16:34:36 +0530 | [diff] [blame] | 46 | return true; |
Johan Hovold | 700001a | 2015-11-21 10:52:03 +0100 | [diff] [blame] | 47 | } |
| 48 | |
| 49 | static const struct greybus_bundle_id * |
| 50 | greybus_match_id(struct gb_bundle *bundle, const struct greybus_bundle_id *id) |
| 51 | { |
| 52 | if (id == NULL) |
| 53 | return NULL; |
| 54 | |
| 55 | for (; id->vendor || id->product || id->class || id->driver_info; |
| 56 | id++) { |
| 57 | if (greybus_match_one_id(bundle, id)) |
| 58 | return id; |
| 59 | } |
| 60 | |
| 61 | return NULL; |
| 62 | } |
| 63 | |
Viresh Kumar | e4e5536 | 2016-05-12 11:34:05 +0530 | [diff] [blame] | 64 | static int greybus_match_device(struct device *dev, struct device_driver *drv) |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 65 | { |
Viresh Kumar | 95bd99d | 2014-11-14 17:24:59 +0530 | [diff] [blame] | 66 | struct greybus_driver *driver = to_greybus_driver(drv); |
Johan Hovold | b77f932 | 2016-01-08 20:13:41 +0100 | [diff] [blame] | 67 | struct gb_bundle *bundle; |
Viresh Kumar | 9f5f30e712 | 2015-04-01 20:32:04 +0530 | [diff] [blame] | 68 | const struct greybus_bundle_id *id; |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 69 | |
Johan Hovold | b77f932 | 2016-01-08 20:13:41 +0100 | [diff] [blame] | 70 | if (!is_gb_bundle(dev)) |
| 71 | return 0; |
| 72 | |
| 73 | bundle = to_gb_bundle(dev); |
| 74 | |
Johan Hovold | 700001a | 2015-11-21 10:52:03 +0100 | [diff] [blame] | 75 | id = greybus_match_id(bundle, driver->id_table); |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 76 | if (id) |
| 77 | return 1; |
Viresh Kumar | 696e0cc | 2014-11-21 11:26:30 +0530 | [diff] [blame] | 78 | /* FIXME - Dynamic ids? */ |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 79 | return 0; |
| 80 | } |
| 81 | |
| 82 | static int greybus_uevent(struct device *dev, struct kobj_uevent_env *env) |
| 83 | { |
Johan Hovold | f0960d0 | 2015-12-03 19:18:02 +0100 | [diff] [blame] | 84 | struct gb_host_device *hd; |
Johan Hovold | b15d97d | 2016-04-23 18:47:24 +0200 | [diff] [blame] | 85 | struct gb_module *module = NULL; |
Greg Kroah-Hartman | 4ab9b3c | 2014-12-19 14:56:31 -0800 | [diff] [blame] | 86 | struct gb_interface *intf = NULL; |
Johan Hovold | a6e5b01 | 2016-04-13 19:19:02 +0200 | [diff] [blame] | 87 | struct gb_control *control = NULL; |
Greg Kroah-Hartman | 1db0a5f | 2014-12-12 17:10:17 -0500 | [diff] [blame] | 88 | struct gb_bundle *bundle = NULL; |
Johan Hovold | 88f7b96 | 2015-11-25 15:59:08 +0100 | [diff] [blame] | 89 | struct gb_svc *svc = NULL; |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 90 | |
Johan Hovold | 2adaefb | 2015-11-25 15:59:02 +0100 | [diff] [blame] | 91 | if (is_gb_host_device(dev)) { |
| 92 | hd = to_gb_host_device(dev); |
Johan Hovold | b15d97d | 2016-04-23 18:47:24 +0200 | [diff] [blame] | 93 | } else if (is_gb_module(dev)) { |
| 94 | module = to_gb_module(dev); |
| 95 | hd = module->hd; |
Greg Kroah-Hartman | df67155 | 2014-12-21 14:10:26 -0800 | [diff] [blame] | 96 | } else if (is_gb_interface(dev)) { |
Greg Kroah-Hartman | 4ab9b3c | 2014-12-19 14:56:31 -0800 | [diff] [blame] | 97 | intf = to_gb_interface(dev); |
Johan Hovold | b15d97d | 2016-04-23 18:47:24 +0200 | [diff] [blame] | 98 | module = intf->module; |
Johan Hovold | f0960d0 | 2015-12-03 19:18:02 +0100 | [diff] [blame] | 99 | hd = intf->hd; |
Johan Hovold | a6e5b01 | 2016-04-13 19:19:02 +0200 | [diff] [blame] | 100 | } else if (is_gb_control(dev)) { |
| 101 | control = to_gb_control(dev); |
| 102 | intf = control->intf; |
Sandeep Patil | 3e29bcf | 2016-05-04 16:21:29 -0700 | [diff] [blame] | 103 | module = intf->module; |
Johan Hovold | a6e5b01 | 2016-04-13 19:19:02 +0200 | [diff] [blame] | 104 | hd = intf->hd; |
Greg Kroah-Hartman | 1db0a5f | 2014-12-12 17:10:17 -0500 | [diff] [blame] | 105 | } else if (is_gb_bundle(dev)) { |
| 106 | bundle = to_gb_bundle(dev); |
Greg Kroah-Hartman | 4ab9b3c | 2014-12-19 14:56:31 -0800 | [diff] [blame] | 107 | intf = bundle->intf; |
Johan Hovold | b15d97d | 2016-04-23 18:47:24 +0200 | [diff] [blame] | 108 | module = intf->module; |
Johan Hovold | f0960d0 | 2015-12-03 19:18:02 +0100 | [diff] [blame] | 109 | hd = intf->hd; |
Johan Hovold | 88f7b96 | 2015-11-25 15:59:08 +0100 | [diff] [blame] | 110 | } else if (is_gb_svc(dev)) { |
| 111 | svc = to_gb_svc(dev); |
Johan Hovold | f0960d0 | 2015-12-03 19:18:02 +0100 | [diff] [blame] | 112 | hd = svc->hd; |
Greg Kroah-Hartman | 0ac5a83 | 2014-11-15 12:12:16 -0800 | [diff] [blame] | 113 | } else { |
| 114 | dev_WARN(dev, "uevent for unknown greybus device \"type\"!\n"); |
| 115 | return -EINVAL; |
| 116 | } |
Greg Kroah-Hartman | f0f61b9 | 2014-10-24 17:34:46 +0800 | [diff] [blame] | 117 | |
Johan Hovold | f0960d0 | 2015-12-03 19:18:02 +0100 | [diff] [blame] | 118 | if (add_uevent_var(env, "BUS=%u", hd->bus_id)) |
| 119 | return -ENOMEM; |
| 120 | |
Johan Hovold | b15d97d | 2016-04-23 18:47:24 +0200 | [diff] [blame] | 121 | if (module) { |
| 122 | if (add_uevent_var(env, "MODULE=%u", module->module_id)) |
| 123 | return -ENOMEM; |
| 124 | } |
| 125 | |
Johan Hovold | c5e6b05 | 2015-12-03 19:18:04 +0100 | [diff] [blame] | 126 | if (intf) { |
| 127 | if (add_uevent_var(env, "INTERFACE=%u", intf->interface_id)) |
| 128 | return -ENOMEM; |
Greg Kroah-Hartman | 611924d | 2016-02-26 21:54:38 -0800 | [diff] [blame] | 129 | if (add_uevent_var(env, "GREYBUS_ID=%08x/%08x", |
| 130 | intf->vendor_id, intf->product_id)) |
Greg Kroah-Hartman | de14131 | 2016-01-11 19:24:54 -0800 | [diff] [blame] | 131 | return -ENOMEM; |
Johan Hovold | c5e6b05 | 2015-12-03 19:18:04 +0100 | [diff] [blame] | 132 | } |
| 133 | |
Greg Kroah-Hartman | 1db0a5f | 2014-12-12 17:10:17 -0500 | [diff] [blame] | 134 | if (bundle) { |
Greg Kroah-Hartman | 0ac5a83 | 2014-11-15 12:12:16 -0800 | [diff] [blame] | 135 | // FIXME |
Greg Kroah-Hartman | 1db0a5f | 2014-12-12 17:10:17 -0500 | [diff] [blame] | 136 | // add a uevent that can "load" a bundle type |
Greg Kroah-Hartman | 0ac5a83 | 2014-11-15 12:12:16 -0800 | [diff] [blame] | 137 | // This is what we need to bind a driver to so use the info |
| 138 | // in gmod here as well |
Johan Hovold | c29c016 | 2015-12-04 10:44:24 +0100 | [diff] [blame] | 139 | |
| 140 | if (add_uevent_var(env, "BUNDLE=%u", bundle->id)) |
| 141 | return -ENOMEM; |
Greg Kroah-Hartman | 6ce4cc2 | 2016-01-21 18:13:41 -0800 | [diff] [blame] | 142 | if (add_uevent_var(env, "BUNDLE_CLASS=%02x", bundle->class)) |
| 143 | return -ENOMEM; |
Greg Kroah-Hartman | 0ac5a83 | 2014-11-15 12:12:16 -0800 | [diff] [blame] | 144 | } |
| 145 | |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 146 | return 0; |
| 147 | } |
| 148 | |
David Lin | 1f77b36 | 2016-07-12 17:41:21 -0700 | [diff] [blame] | 149 | static void greybus_shutdown(struct device *dev) |
| 150 | { |
| 151 | if (is_gb_host_device(dev)) { |
| 152 | struct gb_host_device *hd; |
| 153 | |
| 154 | hd = to_gb_host_device(dev); |
| 155 | gb_hd_shutdown(hd); |
| 156 | } |
| 157 | } |
| 158 | |
Greg Kroah-Hartman | f0f61b9 | 2014-10-24 17:34:46 +0800 | [diff] [blame] | 159 | struct bus_type greybus_bus_type = { |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 160 | .name = "greybus", |
Viresh Kumar | e4e5536 | 2016-05-12 11:34:05 +0530 | [diff] [blame] | 161 | .match = greybus_match_device, |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 162 | .uevent = greybus_uevent, |
David Lin | 1f77b36 | 2016-07-12 17:41:21 -0700 | [diff] [blame] | 163 | .shutdown = greybus_shutdown, |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 164 | }; |
| 165 | |
| 166 | static int greybus_probe(struct device *dev) |
| 167 | { |
| 168 | struct greybus_driver *driver = to_greybus_driver(dev->driver); |
Viresh Kumar | 9f5f30e712 | 2015-04-01 20:32:04 +0530 | [diff] [blame] | 169 | struct gb_bundle *bundle = to_gb_bundle(dev); |
| 170 | const struct greybus_bundle_id *id; |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 171 | int retval; |
| 172 | |
| 173 | /* match id */ |
Johan Hovold | 700001a | 2015-11-21 10:52:03 +0100 | [diff] [blame] | 174 | id = greybus_match_id(bundle, driver->id_table); |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 175 | if (!id) |
| 176 | return -ENODEV; |
| 177 | |
David Lin | 61e13db | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 178 | retval = pm_runtime_get_sync(&bundle->intf->dev); |
| 179 | if (retval < 0) { |
| 180 | pm_runtime_put_noidle(&bundle->intf->dev); |
| 181 | return retval; |
| 182 | } |
| 183 | |
Bartosz Golaszewski | f5c93de | 2016-07-21 18:09:34 +0200 | [diff] [blame] | 184 | retval = gb_control_bundle_activate(bundle->intf->control, bundle->id); |
| 185 | if (retval) { |
| 186 | pm_runtime_put(&bundle->intf->dev); |
| 187 | return retval; |
| 188 | } |
David Lin | 2d48b5b | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 189 | |
David Lin | 61e13db | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 190 | /* |
| 191 | * Unbound bundle devices are always deactivated. During probe, the |
| 192 | * Runtime PM is set to enabled and active and the usage count is |
| 193 | * incremented. If the driver supports runtime PM, it should call |
| 194 | * pm_runtime_put() in its probe routine and pm_runtime_get_sync() |
| 195 | * in remove routine. |
| 196 | */ |
| 197 | pm_runtime_set_autosuspend_delay(dev, GB_BUNDLE_AUTOSUSPEND_MS); |
| 198 | pm_runtime_use_autosuspend(dev); |
| 199 | pm_runtime_get_noresume(dev); |
| 200 | pm_runtime_set_active(dev); |
| 201 | pm_runtime_enable(dev); |
| 202 | |
Viresh Kumar | 9f5f30e712 | 2015-04-01 20:32:04 +0530 | [diff] [blame] | 203 | retval = driver->probe(bundle, id); |
Johan Hovold | 98fdf5a | 2016-01-21 17:34:09 +0100 | [diff] [blame] | 204 | if (retval) { |
| 205 | /* |
| 206 | * Catch buggy drivers that fail to destroy their connections. |
| 207 | */ |
| 208 | WARN_ON(!list_empty(&bundle->connections)); |
| 209 | |
David Lin | 2d48b5b | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 210 | gb_control_bundle_deactivate(bundle->intf->control, bundle->id); |
| 211 | |
David Lin | 61e13db | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 212 | pm_runtime_disable(dev); |
| 213 | pm_runtime_set_suspended(dev); |
| 214 | pm_runtime_put_noidle(dev); |
| 215 | pm_runtime_dont_use_autosuspend(dev); |
| 216 | pm_runtime_put(&bundle->intf->dev); |
| 217 | |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 218 | return retval; |
Johan Hovold | 98fdf5a | 2016-01-21 17:34:09 +0100 | [diff] [blame] | 219 | } |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 220 | |
Bryan O'Donoghue | 10a24b7 | 2016-07-20 19:31:18 +0100 | [diff] [blame] | 221 | gb_timesync_schedule_synchronous(bundle->intf); |
Bryan O'Donoghue | 4a44842 | 2016-06-05 14:03:27 +0100 | [diff] [blame] | 222 | |
David Lin | 61e13db | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 223 | pm_runtime_put(&bundle->intf->dev); |
| 224 | |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 225 | return 0; |
| 226 | } |
| 227 | |
| 228 | static int greybus_remove(struct device *dev) |
| 229 | { |
| 230 | struct greybus_driver *driver = to_greybus_driver(dev->driver); |
Viresh Kumar | 9f5f30e712 | 2015-04-01 20:32:04 +0530 | [diff] [blame] | 231 | struct gb_bundle *bundle = to_gb_bundle(dev); |
Johan Hovold | fa8369c | 2016-01-19 12:51:09 +0100 | [diff] [blame] | 232 | struct gb_connection *connection; |
David Lin | 61e13db | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 233 | int retval; |
| 234 | |
| 235 | retval = pm_runtime_get_sync(dev); |
| 236 | if (retval < 0) |
| 237 | dev_err(dev, "failed to resume bundle: %d\n", retval); |
Johan Hovold | fa8369c | 2016-01-19 12:51:09 +0100 | [diff] [blame] | 238 | |
Johan Hovold | 82278bf | 2016-06-09 18:42:19 +0200 | [diff] [blame] | 239 | /* |
| 240 | * Disable (non-offloaded) connections early in case the interface is |
| 241 | * already gone to avoid unceccessary operation timeouts during |
| 242 | * driver disconnect. Otherwise, only disable incoming requests. |
| 243 | */ |
Johan Hovold | 47a2e67 | 2016-01-19 12:51:18 +0100 | [diff] [blame] | 244 | list_for_each_entry(connection, &bundle->connections, bundle_links) { |
Johan Hovold | 82278bf | 2016-06-09 18:42:19 +0200 | [diff] [blame] | 245 | if (gb_connection_is_offloaded(connection)) |
| 246 | continue; |
| 247 | |
Johan Hovold | 47a2e67 | 2016-01-19 12:51:18 +0100 | [diff] [blame] | 248 | if (bundle->intf->disconnected) |
Johan Hovold | 7aefe79 | 2016-05-27 17:26:22 +0200 | [diff] [blame] | 249 | gb_connection_disable_forced(connection); |
Johan Hovold | 47a2e67 | 2016-01-19 12:51:18 +0100 | [diff] [blame] | 250 | else |
| 251 | gb_connection_disable_rx(connection); |
| 252 | } |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 253 | |
Viresh Kumar | 9f5f30e712 | 2015-04-01 20:32:04 +0530 | [diff] [blame] | 254 | driver->disconnect(bundle); |
Johan Hovold | 02a54dd | 2016-01-19 12:51:10 +0100 | [diff] [blame] | 255 | |
Johan Hovold | 98fdf5a | 2016-01-21 17:34:09 +0100 | [diff] [blame] | 256 | /* Catch buggy drivers that fail to destroy their connections. */ |
| 257 | WARN_ON(!list_empty(&bundle->connections)); |
Johan Hovold | 02a54dd | 2016-01-19 12:51:10 +0100 | [diff] [blame] | 258 | |
David Lin | 2d48b5b | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 259 | if (!bundle->intf->disconnected) |
| 260 | gb_control_bundle_deactivate(bundle->intf->control, bundle->id); |
| 261 | |
David Lin | 61e13db | 2016-07-14 15:13:00 -0500 | [diff] [blame] | 262 | pm_runtime_put_noidle(dev); |
| 263 | pm_runtime_disable(dev); |
| 264 | pm_runtime_set_suspended(dev); |
| 265 | pm_runtime_dont_use_autosuspend(dev); |
| 266 | pm_runtime_put_noidle(dev); |
| 267 | |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 268 | return 0; |
| 269 | } |
| 270 | |
| 271 | int greybus_register_driver(struct greybus_driver *driver, struct module *owner, |
| 272 | const char *mod_name) |
| 273 | { |
| 274 | int retval; |
| 275 | |
| 276 | if (greybus_disabled()) |
| 277 | return -ENODEV; |
| 278 | |
Johan Hovold | 3c48d1b | 2016-01-08 20:13:42 +0100 | [diff] [blame] | 279 | driver->driver.bus = &greybus_bus_type; |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 280 | driver->driver.name = driver->name; |
| 281 | driver->driver.probe = greybus_probe; |
| 282 | driver->driver.remove = greybus_remove; |
| 283 | driver->driver.owner = owner; |
| 284 | driver->driver.mod_name = mod_name; |
| 285 | |
| 286 | retval = driver_register(&driver->driver); |
| 287 | if (retval) |
| 288 | return retval; |
| 289 | |
| 290 | pr_info("registered new driver %s\n", driver->name); |
| 291 | return 0; |
| 292 | } |
| 293 | EXPORT_SYMBOL_GPL(greybus_register_driver); |
| 294 | |
Alex Elder | fd1c2e5 | 2015-06-08 12:05:13 -0500 | [diff] [blame] | 295 | void greybus_deregister_driver(struct greybus_driver *driver) |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 296 | { |
| 297 | driver_unregister(&driver->driver); |
| 298 | } |
Alex Elder | fd1c2e5 | 2015-06-08 12:05:13 -0500 | [diff] [blame] | 299 | EXPORT_SYMBOL_GPL(greybus_deregister_driver); |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 300 | |
Greg Kroah-Hartman | 503c1cd | 2014-08-30 16:21:03 -0700 | [diff] [blame] | 301 | static int __init gb_init(void) |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 302 | { |
Greg Kroah-Hartman | db6e1fd | 2014-08-30 16:47:26 -0700 | [diff] [blame] | 303 | int retval; |
| 304 | |
Viresh Kumar | 337b068 | 2015-03-20 20:29:13 +0530 | [diff] [blame] | 305 | if (greybus_disabled()) |
| 306 | return -ENODEV; |
| 307 | |
Alex Elder | fb690ca | 2015-06-13 11:02:09 -0500 | [diff] [blame] | 308 | BUILD_BUG_ON(CPORT_ID_MAX >= (long)CPORT_ID_BAD); |
Alex Elder | 1bb3c72 | 2014-10-02 12:30:03 -0500 | [diff] [blame] | 309 | |
Greg Kroah-Hartman | 48f7047 | 2015-03-27 11:38:06 +0100 | [diff] [blame] | 310 | gb_debugfs_init(); |
Greg Kroah-Hartman | db6e1fd | 2014-08-30 16:47:26 -0700 | [diff] [blame] | 311 | |
Greg Kroah-Hartman | 27fb831 | 2014-08-31 13:54:59 -0700 | [diff] [blame] | 312 | retval = bus_register(&greybus_bus_type); |
Greg Kroah-Hartman | 168db1c | 2014-09-13 16:15:52 -0700 | [diff] [blame] | 313 | if (retval) { |
Alex Elder | f35ab90 | 2015-06-09 17:42:51 -0500 | [diff] [blame] | 314 | pr_err("bus_register failed (%d)\n", retval); |
Greg Kroah-Hartman | 27fb831 | 2014-08-31 13:54:59 -0700 | [diff] [blame] | 315 | goto error_bus; |
Greg Kroah-Hartman | 168db1c | 2014-09-13 16:15:52 -0700 | [diff] [blame] | 316 | } |
Greg Kroah-Hartman | 27fb831 | 2014-08-31 13:54:59 -0700 | [diff] [blame] | 317 | |
Johan Hovold | 2adaefb | 2015-11-25 15:59:02 +0100 | [diff] [blame] | 318 | retval = gb_hd_init(); |
| 319 | if (retval) { |
| 320 | pr_err("gb_hd_init failed (%d)\n", retval); |
| 321 | goto error_hd; |
| 322 | } |
| 323 | |
Alex Elder | 2eb585f | 2014-10-16 06:35:34 -0500 | [diff] [blame] | 324 | retval = gb_operation_init(); |
| 325 | if (retval) { |
Alex Elder | f35ab90 | 2015-06-09 17:42:51 -0500 | [diff] [blame] | 326 | pr_err("gb_operation_init failed (%d)\n", retval); |
Alex Elder | 2eb585f | 2014-10-16 06:35:34 -0500 | [diff] [blame] | 327 | goto error_operation; |
| 328 | } |
| 329 | |
Bryan O'Donoghue | 4a44842 | 2016-06-05 14:03:27 +0100 | [diff] [blame] | 330 | retval = gb_timesync_init(); |
| 331 | if (retval) { |
| 332 | pr_err("gb_timesync_init failed\n"); |
| 333 | goto error_timesync; |
| 334 | } |
Alex Elder | 19d03de | 2014-11-05 16:12:53 -0600 | [diff] [blame] | 335 | return 0; /* Success */ |
| 336 | |
Bryan O'Donoghue | 4a44842 | 2016-06-05 14:03:27 +0100 | [diff] [blame] | 337 | error_timesync: |
Alex Elder | f35ab90 | 2015-06-09 17:42:51 -0500 | [diff] [blame] | 338 | gb_operation_exit(); |
Alex Elder | 2eb585f | 2014-10-16 06:35:34 -0500 | [diff] [blame] | 339 | error_operation: |
Johan Hovold | 2adaefb | 2015-11-25 15:59:02 +0100 | [diff] [blame] | 340 | gb_hd_exit(); |
| 341 | error_hd: |
Greg Kroah-Hartman | 27fb831 | 2014-08-31 13:54:59 -0700 | [diff] [blame] | 342 | bus_unregister(&greybus_bus_type); |
Greg Kroah-Hartman | 27fb831 | 2014-08-31 13:54:59 -0700 | [diff] [blame] | 343 | error_bus: |
Greg Kroah-Hartman | de536e3 | 2014-08-31 16:17:04 -0700 | [diff] [blame] | 344 | gb_debugfs_cleanup(); |
Greg Kroah-Hartman | 27fb831 | 2014-08-31 13:54:59 -0700 | [diff] [blame] | 345 | |
| 346 | return retval; |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 347 | } |
Viresh Kumar | d71aaf2 | 2015-03-19 17:02:49 +0530 | [diff] [blame] | 348 | module_init(gb_init); |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 349 | |
Greg Kroah-Hartman | 503c1cd | 2014-08-30 16:21:03 -0700 | [diff] [blame] | 350 | static void __exit gb_exit(void) |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 351 | { |
Bryan O'Donoghue | 4a44842 | 2016-06-05 14:03:27 +0100 | [diff] [blame] | 352 | gb_timesync_exit(); |
Alex Elder | 2eb585f | 2014-10-16 06:35:34 -0500 | [diff] [blame] | 353 | gb_operation_exit(); |
Johan Hovold | 2adaefb | 2015-11-25 15:59:02 +0100 | [diff] [blame] | 354 | gb_hd_exit(); |
Greg Kroah-Hartman | 27fb831 | 2014-08-31 13:54:59 -0700 | [diff] [blame] | 355 | bus_unregister(&greybus_bus_type); |
Greg Kroah-Hartman | de536e3 | 2014-08-31 16:17:04 -0700 | [diff] [blame] | 356 | gb_debugfs_cleanup(); |
Bryan O'Donoghue | 5c8ad59 | 2015-09-18 16:38:45 +0100 | [diff] [blame] | 357 | tracepoint_synchronize_unregister(); |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 358 | } |
Greg Kroah-Hartman | 199d68d | 2014-08-30 16:20:22 -0700 | [diff] [blame] | 359 | module_exit(gb_exit); |
Greg Kroah-Hartman | 6cf42a4 | 2015-04-13 19:51:33 +0200 | [diff] [blame] | 360 | MODULE_LICENSE("GPL v2"); |
Greg Kroah-Hartman | c8a797a | 2014-08-11 15:30:45 +0800 | [diff] [blame] | 361 | MODULE_AUTHOR("Greg Kroah-Hartman <gregkh@linuxfoundation.org>"); |