blob: 50f81b2d22b70ad5812273b71cd64fae800bba72 [file] [log] [blame]
Paul Walmsleyb04b65a2009-09-03 20:14:05 +03001/*
2 * omap_device implementation
3 *
Paul Walmsley887adea2010-07-26 16:34:33 -06004 * Copyright (C) 2009-2010 Nokia Corporation
Paul Walmsley4788da22010-05-18 20:24:05 -06005 * Paul Walmsley, Kevin Hilman
Paul Walmsleyb04b65a2009-09-03 20:14:05 +03006 *
7 * Developed in collaboration with (alphabetical order): Benoit
Paul Walmsley4788da22010-05-18 20:24:05 -06008 * Cousson, Thara Gopinath, Tony Lindgren, Rajendra Nayak, Vikram
Paul Walmsleyb04b65a2009-09-03 20:14:05 +03009 * Pandita, Sakari Poussa, Anand Sawant, Santosh Shilimkar, Richard
10 * Woodruff
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License version 2 as
14 * published by the Free Software Foundation.
15 *
16 * This code provides a consistent interface for OMAP device drivers
17 * to control power management and interconnect properties of their
18 * devices.
19 *
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -070020 * In the medium- to long-term, this code should be implemented as a
21 * proper omap_bus/omap_device in Linux, no more platform_data func
22 * pointers
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030023 *
24 *
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030025 */
26#undef DEBUG
27
28#include <linux/kernel.h>
29#include <linux/platform_device.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090030#include <linux/slab.h>
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030031#include <linux/err.h>
32#include <linux/io.h>
Partha Basak4ef7aca2010-09-21 19:23:04 +020033#include <linux/clk.h>
Rajendra Nayakda0653f2011-02-25 15:40:21 -070034#include <linux/clkdev.h>
Tomeu Vizoso989561d2016-01-07 16:46:13 +010035#include <linux/pm_domain.h>
Kevin Hilman345f79b2011-05-31 16:08:09 -070036#include <linux/pm_runtime.h>
Benoit Coussondc2d07e2011-08-10 13:32:08 +020037#include <linux/of.h>
Tony Lindgrend85a2d62017-10-10 14:23:35 -070038#include <linux/of_address.h>
39#include <linux/of_irq.h>
Benoit Coussondc2d07e2011-08-10 13:32:08 +020040#include <linux/notifier.h>
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030041
Tony Lindgrendad12d12013-12-06 10:52:58 -080042#include "common.h"
Tony Lindgrenb76c8b12013-01-11 11:24:18 -080043#include "soc.h"
Tony Lindgren25c7d492012-10-02 17:25:48 -070044#include "omap_device.h"
Tony Lindgren2a296c82012-10-02 17:41:35 -070045#include "omap_hwmod.h"
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030046
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030047/* Private functions */
48
Benoit Coussonbf1e0772011-07-10 05:54:12 -060049static void _add_clkdev(struct omap_device *od, const char *clk_alias,
50 const char *clk_name)
51{
52 struct clk *r;
Russell King1ca90bd2015-03-02 15:46:03 +000053 int rc;
Benoit Coussonbf1e0772011-07-10 05:54:12 -060054
55 if (!clk_alias || !clk_name)
56 return;
57
Kevin Hilmand66b3fe2011-07-21 13:58:51 -070058 dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060059
Kevin Hilmand66b3fe2011-07-21 13:58:51 -070060 r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060061 if (!IS_ERR(r)) {
Markus Pargmann9a02ae42014-08-25 16:15:34 -070062 dev_dbg(&od->pdev->dev,
Kevin Hilman49882c92011-07-21 09:58:36 -070063 "alias %s already exists\n", clk_alias);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060064 clk_put(r);
65 return;
66 }
67
Tero Kristo59dcfc42016-06-30 16:14:59 +030068 r = clk_get_sys(NULL, clk_name);
69
Tony Lindgren1aa8f0c2017-05-31 15:51:37 -070070 if (IS_ERR(r)) {
Tero Kristo59dcfc42016-06-30 16:14:59 +030071 struct of_phandle_args clkspec;
72
73 clkspec.np = of_find_node_by_name(NULL, clk_name);
74
75 r = of_clk_get_from_provider(&clkspec);
76
77 rc = clk_register_clkdev(r, clk_alias,
78 dev_name(&od->pdev->dev));
79 } else {
80 rc = clk_add_alias(clk_alias, dev_name(&od->pdev->dev),
81 clk_name, NULL);
82 }
83
Russell King1ca90bd2015-03-02 15:46:03 +000084 if (rc) {
85 if (rc == -ENODEV || rc == -ENOMEM)
86 dev_err(&od->pdev->dev,
87 "clkdev_alloc for %s failed\n", clk_alias);
88 else
89 dev_err(&od->pdev->dev,
90 "clk_get for %s failed\n", clk_name);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060091 }
Benoit Coussonbf1e0772011-07-10 05:54:12 -060092}
93
Partha Basak4ef7aca2010-09-21 19:23:04 +020094/**
Benoit Coussonbf1e0772011-07-10 05:54:12 -060095 * _add_hwmod_clocks_clkdev - Add clkdev entry for hwmod optional clocks
96 * and main clock
Partha Basak4ef7aca2010-09-21 19:23:04 +020097 * @od: struct omap_device *od
Benoit Coussonbf1e0772011-07-10 05:54:12 -060098 * @oh: struct omap_hwmod *oh
Partha Basak4ef7aca2010-09-21 19:23:04 +020099 *
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600100 * For the main clock and every optional clock present per hwmod per
101 * omap_device, this function adds an entry in the clkdev table of the
102 * form <dev-id=dev_name, con-id=role> if it does not exist already.
Partha Basak4ef7aca2010-09-21 19:23:04 +0200103 *
104 * The function is called from inside omap_device_build_ss(), after
105 * omap_device_register.
106 *
107 * This allows drivers to get a pointer to its optional clocks based on its role
108 * by calling clk_get(<dev*>, <role>).
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600109 * In the case of the main clock, a "fck" alias is used.
Partha Basak4ef7aca2010-09-21 19:23:04 +0200110 *
111 * No return value.
112 */
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600113static void _add_hwmod_clocks_clkdev(struct omap_device *od,
114 struct omap_hwmod *oh)
Partha Basak4ef7aca2010-09-21 19:23:04 +0200115{
116 int i;
117
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600118 _add_clkdev(od, "fck", oh->main_clk);
Partha Basak4ef7aca2010-09-21 19:23:04 +0200119
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600120 for (i = 0; i < oh->opt_clks_cnt; i++)
121 _add_clkdev(od, oh->opt_clks[i].role, oh->opt_clks[i].clk);
Partha Basak4ef7aca2010-09-21 19:23:04 +0200122}
123
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300124
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200125/**
126 * omap_device_build_from_dt - build an omap_device with multiple hwmods
127 * @pdev_name: name of the platform_device driver to use
128 * @pdev_id: this platform_device's connection ID
129 * @oh: ptr to the single omap_hwmod that backs this omap_device
130 * @pdata: platform_data ptr to associate with the platform_device
131 * @pdata_len: amount of memory pointed to by @pdata
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200132 *
133 * Function for building an omap_device already registered from device-tree
134 *
135 * Returns 0 or PTR_ERR() on error.
136 */
137static int omap_device_build_from_dt(struct platform_device *pdev)
138{
139 struct omap_hwmod **hwmods;
140 struct omap_device *od;
141 struct omap_hwmod *oh;
142 struct device_node *node = pdev->dev.of_node;
143 const char *oh_name;
144 int oh_cnt, i, ret = 0;
Rajendra Nayak72680322013-07-28 23:01:51 -0600145 bool device_active = false;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200146
147 oh_cnt = of_property_count_strings(node, "ti,hwmods");
Russell Kingc48cd652013-03-13 20:44:21 +0000148 if (oh_cnt <= 0) {
Benoit Cousson5dc06b72012-01-20 18:14:00 +0100149 dev_dbg(&pdev->dev, "No 'hwmods' to build omap_device\n");
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200150 return -ENODEV;
151 }
152
153 hwmods = kzalloc(sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
154 if (!hwmods) {
155 ret = -ENOMEM;
156 goto odbfd_exit;
157 }
158
159 for (i = 0; i < oh_cnt; i++) {
160 of_property_read_string_index(node, "ti,hwmods", i, &oh_name);
161 oh = omap_hwmod_lookup(oh_name);
162 if (!oh) {
163 dev_err(&pdev->dev, "Cannot lookup hwmod '%s'\n",
164 oh_name);
165 ret = -EINVAL;
166 goto odbfd_exit1;
167 }
168 hwmods[i] = oh;
Rajendra Nayak72680322013-07-28 23:01:51 -0600169 if (oh->flags & HWMOD_INIT_NO_IDLE)
170 device_active = true;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200171 }
172
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700173 od = omap_device_alloc(pdev, hwmods, oh_cnt);
Wei Yongjun4cf9cf82013-09-18 12:01:58 -0700174 if (IS_ERR(od)) {
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200175 dev_err(&pdev->dev, "Cannot allocate omap_device for :%s\n",
176 oh_name);
177 ret = PTR_ERR(od);
178 goto odbfd_exit1;
179 }
180
Peter Ujfalusi3956a1a2012-08-23 16:54:09 +0300181 /* Fix up missing resource names */
182 for (i = 0; i < pdev->num_resources; i++) {
183 struct resource *r = &pdev->resource[i];
184
185 if (r->name == NULL)
186 r->name = dev_name(&pdev->dev);
187 }
188
Tomeu Vizoso989561d2016-01-07 16:46:13 +0100189 dev_pm_domain_set(&pdev->dev, &omap_device_pm_domain);
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200190
Rajendra Nayak72680322013-07-28 23:01:51 -0600191 if (device_active) {
192 omap_device_enable(pdev);
193 pm_runtime_set_active(&pdev->dev);
194 }
195
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200196odbfd_exit1:
197 kfree(hwmods);
198odbfd_exit:
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600199 /* if data/we are at fault.. load up a fail handler */
200 if (ret)
Tomeu Vizoso989561d2016-01-07 16:46:13 +0100201 dev_pm_domain_set(&pdev->dev, &omap_device_fail_pm_domain);
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600202
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200203 return ret;
204}
205
206static int _omap_device_notifier_call(struct notifier_block *nb,
207 unsigned long event, void *dev)
208{
209 struct platform_device *pdev = to_platform_device(dev);
Kevin Hilmane7533452012-07-10 11:13:16 -0700210 struct omap_device *od;
Tony Lindgrencf26f112016-02-12 08:56:52 -0800211 int err;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200212
213 switch (event) {
Grygorii Strashko213fa102016-07-28 20:50:37 +0300214 case BUS_NOTIFY_REMOVED_DEVICE:
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200215 if (pdev->archdata.od)
216 omap_device_delete(pdev->archdata.od);
217 break;
Tony Lindgrencf26f112016-02-12 08:56:52 -0800218 case BUS_NOTIFY_UNBOUND_DRIVER:
219 od = to_omap_device(pdev);
220 if (od && (od->_state == OMAP_DEVICE_STATE_ENABLED)) {
221 dev_info(dev, "enabled after unload, idling\n");
222 err = omap_device_idle(pdev);
223 if (err)
224 dev_err(dev, "failed to idle\n");
225 }
226 break;
Dave Gerlach04abaf02017-03-30 14:58:18 -0500227 case BUS_NOTIFY_BIND_DRIVER:
228 od = to_omap_device(pdev);
229 if (od && (od->_state == OMAP_DEVICE_STATE_ENABLED) &&
230 pm_runtime_status_suspended(dev)) {
231 od->_driver_status = BUS_NOTIFY_BIND_DRIVER;
232 pm_runtime_set_active(dev);
233 }
234 break;
Kevin Hilmane7533452012-07-10 11:13:16 -0700235 case BUS_NOTIFY_ADD_DEVICE:
236 if (pdev->dev.of_node)
237 omap_device_build_from_dt(pdev);
Tony Lindgrendad12d12013-12-06 10:52:58 -0800238 omap_auxdata_legacy_init(dev);
Kevin Hilmane7533452012-07-10 11:13:16 -0700239 /* fall through */
240 default:
241 od = to_omap_device(pdev);
242 if (od)
243 od->_driver_status = event;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200244 }
245
246 return NOTIFY_DONE;
247}
248
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700249/**
250 * _omap_device_enable_hwmods - call omap_hwmod_enable() on all hwmods
251 * @od: struct omap_device *od
252 *
253 * Enable all underlying hwmods. Returns 0.
254 */
255static int _omap_device_enable_hwmods(struct omap_device *od)
256{
Pali Rohár6da23352015-02-26 14:49:51 +0100257 int ret = 0;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700258 int i;
259
260 for (i = 0; i < od->hwmods_cnt; i++)
Pali Rohár6da23352015-02-26 14:49:51 +0100261 ret |= omap_hwmod_enable(od->hwmods[i]);
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700262
Pali Rohár6da23352015-02-26 14:49:51 +0100263 return ret;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700264}
265
266/**
267 * _omap_device_idle_hwmods - call omap_hwmod_idle() on all hwmods
268 * @od: struct omap_device *od
269 *
270 * Idle all underlying hwmods. Returns 0.
271 */
272static int _omap_device_idle_hwmods(struct omap_device *od)
273{
Pali Rohár6da23352015-02-26 14:49:51 +0100274 int ret = 0;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700275 int i;
276
277 for (i = 0; i < od->hwmods_cnt; i++)
Pali Rohár6da23352015-02-26 14:49:51 +0100278 ret |= omap_hwmod_idle(od->hwmods[i]);
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700279
Pali Rohár6da23352015-02-26 14:49:51 +0100280 return ret;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700281}
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200282
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300283/* Public functions for use by core code */
284
285/**
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700286 * omap_device_get_context_loss_count - get lost context count
287 * @od: struct omap_device *
288 *
289 * Using the primary hwmod, query the context loss count for this
290 * device.
291 *
292 * Callers should consider context for this device lost any time this
293 * function returns a value different than the value the caller got
294 * the last time it called this function.
295 *
Andrea Gelminif733e7c2016-05-21 13:50:25 +0200296 * If any hwmods exist for the omap_device associated with @pdev,
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700297 * return the context loss counter for that hwmod, otherwise return
298 * zero.
299 */
Tomi Valkeinenfc013872011-06-09 16:56:23 +0300300int omap_device_get_context_loss_count(struct platform_device *pdev)
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700301{
302 struct omap_device *od;
303 u32 ret = 0;
304
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600305 od = to_omap_device(pdev);
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700306
307 if (od->hwmods_cnt)
308 ret = omap_hwmod_get_context_loss_count(od->hwmods[0]);
309
310 return ret;
311}
312
313/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300314 * omap_device_count_resources - count number of struct resource entries needed
315 * @od: struct omap_device *
Peter Ujfalusidad41912012-11-21 16:15:17 -0700316 * @flags: Type of resources to include when counting (IRQ/DMA/MEM)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300317 *
318 * Count the number of struct resource entries needed for this
319 * omap_device @od. Used by omap_device_build_ss() to determine how
320 * much memory to allocate before calling
321 * omap_device_fill_resources(). Returns the count.
322 */
Peter Ujfalusidad41912012-11-21 16:15:17 -0700323static int omap_device_count_resources(struct omap_device *od,
324 unsigned long flags)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300325{
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300326 int c = 0;
327 int i;
328
Kishon Vijay Abraham If39f4892010-09-24 10:23:18 -0600329 for (i = 0; i < od->hwmods_cnt; i++)
Peter Ujfalusidad41912012-11-21 16:15:17 -0700330 c += omap_hwmod_count_resources(od->hwmods[i], flags);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300331
Paul Walmsley7852ec02012-07-26 00:54:26 -0600332 pr_debug("omap_device: %s: counted %d total resources across %d hwmods\n",
333 od->pdev->name, c, od->hwmods_cnt);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300334
335 return c;
336}
337
338/**
339 * omap_device_fill_resources - fill in array of struct resource
340 * @od: struct omap_device *
341 * @res: pointer to an array of struct resource to be filled in
342 *
343 * Populate one or more empty struct resource pointed to by @res with
344 * the resource data for this omap_device @od. Used by
345 * omap_device_build_ss() after calling omap_device_count_resources().
346 * Ideally this function would not be needed at all. If omap_device
347 * replaces platform_device, then we can specify our own
348 * get_resource()/ get_irq()/etc functions that use the underlying
349 * omap_hwmod information. Or if platform_device is extended to use
350 * subarchitecture-specific function pointers, the various
351 * platform_device functions can simply call omap_device internal
352 * functions to get device resources. Hacking around the existing
353 * platform_device code wastes memory. Returns 0.
354 */
Kevin Hilmana2a28ad2011-07-21 14:14:35 -0700355static int omap_device_fill_resources(struct omap_device *od,
356 struct resource *res)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300357{
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300358 int i, r;
359
Kishon Vijay Abraham If39f4892010-09-24 10:23:18 -0600360 for (i = 0; i < od->hwmods_cnt; i++) {
361 r = omap_hwmod_fill_resources(od->hwmods[i], res);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300362 res += r;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300363 }
364
365 return 0;
366}
367
368/**
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530369 * _od_fill_dma_resources - fill in array of struct resource with dma resources
370 * @od: struct omap_device *
371 * @res: pointer to an array of struct resource to be filled in
372 *
373 * Populate one or more empty struct resource pointed to by @res with
374 * the dma resource data for this omap_device @od. Used by
375 * omap_device_alloc() after calling omap_device_count_resources().
376 *
377 * Ideally this function would not be needed at all. If we have
378 * mechanism to get dma resources from DT.
379 *
380 * Returns 0.
381 */
382static int _od_fill_dma_resources(struct omap_device *od,
383 struct resource *res)
384{
385 int i, r;
386
387 for (i = 0; i < od->hwmods_cnt; i++) {
388 r = omap_hwmod_fill_dma_resources(od->hwmods[i], res);
389 res += r;
390 }
391
392 return 0;
393}
394
395/**
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200396 * omap_device_alloc - allocate an omap_device
397 * @pdev: platform_device that will be included in this omap_device
398 * @oh: ptr to the single omap_hwmod that backs this omap_device
399 * @pdata: platform_data ptr to associate with the platform_device
400 * @pdata_len: amount of memory pointed to by @pdata
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200401 *
402 * Convenience function for allocating an omap_device structure and filling
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700403 * hwmods, and resources.
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200404 *
405 * Returns an struct omap_device pointer or ERR_PTR() on error;
406 */
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800407struct omap_device *omap_device_alloc(struct platform_device *pdev,
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700408 struct omap_hwmod **ohs, int oh_cnt)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200409{
410 int ret = -ENOMEM;
411 struct omap_device *od;
412 struct resource *res = NULL;
413 int i, res_count;
414 struct omap_hwmod **hwmods;
415
416 od = kzalloc(sizeof(struct omap_device), GFP_KERNEL);
417 if (!od) {
418 ret = -ENOMEM;
419 goto oda_exit1;
420 }
421 od->hwmods_cnt = oh_cnt;
422
423 hwmods = kmemdup(ohs, sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
424 if (!hwmods)
425 goto oda_exit2;
426
427 od->hwmods = hwmods;
428 od->pdev = pdev;
429
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530430 /*
Peter Ujfalusic567b052012-11-21 16:15:18 -0700431 * Non-DT Boot:
432 * Here, pdev->num_resources = 0, and we should get all the
433 * resources from hwmod.
434 *
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530435 * DT Boot:
436 * OF framework will construct the resource structure (currently
437 * does for MEM & IRQ resource) and we should respect/use these
438 * resources, killing hwmod dependency.
439 * If pdev->num_resources > 0, we assume that MEM & IRQ resources
440 * have been allocated by OF layer already (through DTB).
Peter Ujfalusic567b052012-11-21 16:15:18 -0700441 * As preparation for the future we examine the OF provided resources
442 * to see if we have DMA resources provided already. In this case
443 * there is no need to update the resources for the device, we use the
444 * OF provided ones.
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530445 *
446 * TODO: Once DMA resource is available from OF layer, we should
447 * kill filling any resources from hwmod.
448 */
Peter Ujfalusic567b052012-11-21 16:15:18 -0700449 if (!pdev->num_resources) {
450 /* Count all resources for the device */
451 res_count = omap_device_count_resources(od, IORESOURCE_IRQ |
452 IORESOURCE_DMA |
453 IORESOURCE_MEM);
454 } else {
455 /* Take a look if we already have DMA resource via DT */
456 for (i = 0; i < pdev->num_resources; i++) {
457 struct resource *r = &pdev->resource[i];
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200458
Peter Ujfalusic567b052012-11-21 16:15:18 -0700459 /* We have it, no need to touch the resources */
460 if (r->flags == IORESOURCE_DMA)
461 goto have_everything;
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530462 }
Peter Ujfalusic567b052012-11-21 16:15:18 -0700463 /* Count only DMA resources for the device */
464 res_count = omap_device_count_resources(od, IORESOURCE_DMA);
465 /* The device has no DMA resource, no need for update */
466 if (!res_count)
467 goto have_everything;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200468
Peter Ujfalusic567b052012-11-21 16:15:18 -0700469 res_count += pdev->num_resources;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200470 }
471
Peter Ujfalusic567b052012-11-21 16:15:18 -0700472 /* Allocate resources memory to account for new resources */
473 res = kzalloc(sizeof(struct resource) * res_count, GFP_KERNEL);
474 if (!res)
475 goto oda_exit3;
476
477 if (!pdev->num_resources) {
478 dev_dbg(&pdev->dev, "%s: using %d resources from hwmod\n",
479 __func__, res_count);
480 omap_device_fill_resources(od, res);
481 } else {
482 dev_dbg(&pdev->dev,
483 "%s: appending %d DMA resources from hwmod\n",
484 __func__, res_count - pdev->num_resources);
485 memcpy(res, pdev->resource,
486 sizeof(struct resource) * pdev->num_resources);
487 _od_fill_dma_resources(od, &res[pdev->num_resources]);
488 }
489
490 ret = platform_device_add_resources(pdev, res, res_count);
491 kfree(res);
492
493 if (ret)
494 goto oda_exit3;
495
496have_everything:
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200497 pdev->archdata.od = od;
498
499 for (i = 0; i < oh_cnt; i++) {
500 hwmods[i]->od = od;
501 _add_hwmod_clocks_clkdev(od, hwmods[i]);
502 }
503
504 return od;
505
506oda_exit3:
507 kfree(hwmods);
508oda_exit2:
509 kfree(od);
510oda_exit1:
511 dev_err(&pdev->dev, "omap_device: build failed (%d)\n", ret);
512
513 return ERR_PTR(ret);
514}
515
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800516void omap_device_delete(struct omap_device *od)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200517{
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200518 if (!od)
519 return;
520
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200521 od->pdev->archdata.od = NULL;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200522 kfree(od->hwmods);
523 kfree(od);
524}
525
526/**
Tony Lindgrend85a2d62017-10-10 14:23:35 -0700527 * omap_device_copy_resources - Add legacy IO and IRQ resources
528 * @oh: interconnect target module
529 * @pdev: platform device to copy resources to
530 *
531 * We still have legacy DMA and smartreflex needing resources.
532 * Let's populate what they need until we can eventually just
533 * remove this function. Note that there should be no need to
534 * call this from omap_device_build_from_dt(), nor should there
535 * be any need to call it for other devices.
536 */
537static int
538omap_device_copy_resources(struct omap_hwmod *oh,
539 struct platform_device *pdev)
540{
541 struct device_node *np, *child;
542 struct property *prop;
543 struct resource *res;
544 const char *name;
545 int error, irq = 0;
546
547 if (!oh || !oh->od || !oh->od->pdev) {
548 error = -EINVAL;
549 goto error;
550 }
551
552 np = oh->od->pdev->dev.of_node;
553 if (!np) {
554 error = -ENODEV;
555 goto error;
556 }
557
558 res = kzalloc(sizeof(*res) * 2, GFP_KERNEL);
559 if (!res)
560 return -ENOMEM;
561
562 /* Do we have a dts range for the interconnect target module? */
563 error = omap_hwmod_parse_module_range(oh, np, res);
564
565 /* No ranges, rely on device reg entry */
566 if (error)
567 error = of_address_to_resource(np, 0, res);
568 if (error)
569 goto free;
570
571 /* SmartReflex needs first IO resource name to be "mpu" */
572 res[0].name = "mpu";
573
574 /*
575 * We may have a configured "ti,sysc" interconnect target with a
576 * dts child with the interrupt. If so use the first child's
577 * first interrupt for "ti-hwmods" legacy support.
578 */
579 of_property_for_each_string(np, "compatible", prop, name)
580 if (!strncmp("ti,sysc-", name, 8))
581 break;
582
583 child = of_get_next_available_child(np, NULL);
584
585 if (name)
586 irq = irq_of_parse_and_map(child, 0);
587 if (!irq)
588 irq = irq_of_parse_and_map(np, 0);
589 if (!irq)
590 goto free;
591
592 /* Legacy DMA code needs interrupt name to be "0" */
593 res[1].start = irq;
594 res[1].end = irq;
595 res[1].flags = IORESOURCE_IRQ;
596 res[1].name = "0";
597
598 error = platform_device_add_resources(pdev, res, 2);
599
600free:
601 kfree(res);
602
603error:
604 WARN(error, "%s: %s device %s failed: %i\n",
605 __func__, oh->name, dev_name(&pdev->dev),
606 error);
607
608 return error;
609}
610
611/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300612 * omap_device_build - build and register an omap_device with one omap_hwmod
613 * @pdev_name: name of the platform_device driver to use
614 * @pdev_id: this platform_device's connection ID
615 * @oh: ptr to the single omap_hwmod that backs this omap_device
616 * @pdata: platform_data ptr to associate with the platform_device
617 * @pdata_len: amount of memory pointed to by @pdata
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300618 *
619 * Convenience function for building and registering a single
620 * omap_device record, which in turn builds and registers a
621 * platform_device record. See omap_device_build_ss() for more
622 * information. Returns ERR_PTR(-EINVAL) if @oh is NULL; otherwise,
623 * passes along the return value of omap_device_build_ss().
624 */
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700625struct platform_device __init *omap_device_build(const char *pdev_name,
626 int pdev_id,
627 struct omap_hwmod *oh,
628 void *pdata, int pdata_len)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300629{
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300630 int ret = -ENOMEM;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700631 struct platform_device *pdev;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300632 struct omap_device *od;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300633
Tony Lindgrend85a2d62017-10-10 14:23:35 -0700634 if (!oh || !pdev_name)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300635 return ERR_PTR(-EINVAL);
636
637 if (!pdata && pdata_len > 0)
638 return ERR_PTR(-EINVAL);
639
Tony Lindgrend85a2d62017-10-10 14:23:35 -0700640 if (strncmp(oh->name, "smartreflex", 11) &&
641 strncmp(oh->name, "dma", 3)) {
642 pr_warn("%s need to update %s to probe with dt\na",
643 __func__, pdev_name);
644 ret = -ENODEV;
645 goto odbs_exit;
646 }
647
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700648 pdev = platform_device_alloc(pdev_name, pdev_id);
649 if (!pdev) {
650 ret = -ENOMEM;
651 goto odbs_exit;
652 }
653
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200654 /* Set the dev_name early to allow dev_xxx in omap_device_alloc */
655 if (pdev->id != -1)
656 dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
657 else
658 dev_set_name(&pdev->dev, "%s", pdev->name);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300659
Tony Lindgrend85a2d62017-10-10 14:23:35 -0700660 /*
661 * Must be called before omap_device_alloc() as oh->od
662 * only contains the currently registered omap_device
663 * and will get overwritten by omap_device_alloc().
664 */
665 ret = omap_device_copy_resources(oh, pdev);
666 if (ret)
667 goto odbs_exit1;
668
669 od = omap_device_alloc(pdev, &oh, 1);
Wei Yongjuna87e6622012-09-21 14:32:04 +0800670 if (IS_ERR(od))
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700671 goto odbs_exit1;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300672
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700673 ret = platform_device_add_data(pdev, pdata, pdata_len);
Artem Bityutskiy49b368a2010-07-12 13:38:07 +0000674 if (ret)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200675 goto odbs_exit2;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700676
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700677 ret = omap_device_register(pdev);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700678 if (ret)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200679 goto odbs_exit2;
Kevin Hilman06563582010-07-26 16:34:30 -0600680
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700681 return pdev;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300682
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700683odbs_exit2:
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200684 omap_device_delete(od);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700685odbs_exit1:
686 platform_device_put(pdev);
687odbs_exit:
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300688
689 pr_err("omap_device: %s: build failed (%d)\n", pdev_name, ret);
690
691 return ERR_PTR(ret);
692}
693
Rafael J. Wysockibf7c5442014-12-13 00:42:49 +0100694#ifdef CONFIG_PM
Kevin Hilman638080c2011-04-29 00:36:42 +0200695static int _od_runtime_suspend(struct device *dev)
696{
697 struct platform_device *pdev = to_platform_device(dev);
Kevin Hilman345f79b2011-05-31 16:08:09 -0700698 int ret;
Kevin Hilman638080c2011-04-29 00:36:42 +0200699
Kevin Hilman345f79b2011-05-31 16:08:09 -0700700 ret = pm_generic_runtime_suspend(dev);
Pali Rohár6da23352015-02-26 14:49:51 +0100701 if (ret)
702 return ret;
Kevin Hilman345f79b2011-05-31 16:08:09 -0700703
Pali Rohár6da23352015-02-26 14:49:51 +0100704 return omap_device_idle(pdev);
Kevin Hilman345f79b2011-05-31 16:08:09 -0700705}
706
Kevin Hilman638080c2011-04-29 00:36:42 +0200707static int _od_runtime_resume(struct device *dev)
708{
709 struct platform_device *pdev = to_platform_device(dev);
Pali Rohár6da23352015-02-26 14:49:51 +0100710 int ret;
Kevin Hilman638080c2011-04-29 00:36:42 +0200711
Pali Rohár6da23352015-02-26 14:49:51 +0100712 ret = omap_device_enable(pdev);
Tony Lindgren08c78e92016-02-12 08:56:52 -0800713 if (ret) {
714 dev_err(dev, "use pm_runtime_put_sync_suspend() in driver?\n");
Pali Rohár6da23352015-02-26 14:49:51 +0100715 return ret;
Tony Lindgren08c78e92016-02-12 08:56:52 -0800716 }
Kevin Hilman345f79b2011-05-31 16:08:09 -0700717
718 return pm_generic_runtime_resume(dev);
Kevin Hilman638080c2011-04-29 00:36:42 +0200719}
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600720
721static int _od_fail_runtime_suspend(struct device *dev)
722{
723 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
724 return -ENODEV;
725}
726
727static int _od_fail_runtime_resume(struct device *dev)
728{
729 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
730 return -ENODEV;
731}
732
Kevin Hilman256a5432011-07-12 22:48:03 +0200733#endif
Kevin Hilman638080c2011-04-29 00:36:42 +0200734
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200735#ifdef CONFIG_SUSPEND
736static int _od_suspend_noirq(struct device *dev)
737{
738 struct platform_device *pdev = to_platform_device(dev);
739 struct omap_device *od = to_omap_device(pdev);
740 int ret;
741
Kevin Hilman72bb6f92012-07-10 15:29:04 -0700742 /* Don't attempt late suspend on a driver that is not bound */
743 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER)
744 return 0;
745
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200746 ret = pm_generic_suspend_noirq(dev);
747
748 if (!ret && !pm_runtime_status_suspended(dev)) {
749 if (pm_generic_runtime_suspend(dev) == 0) {
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530750 omap_device_idle(pdev);
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200751 od->flags |= OMAP_DEVICE_SUSPENDED;
752 }
753 }
754
755 return ret;
756}
757
758static int _od_resume_noirq(struct device *dev)
759{
760 struct platform_device *pdev = to_platform_device(dev);
761 struct omap_device *od = to_omap_device(pdev);
762
Nishanth Menon3522bf72013-11-14 11:05:16 -0600763 if (od->flags & OMAP_DEVICE_SUSPENDED) {
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200764 od->flags &= ~OMAP_DEVICE_SUSPENDED;
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530765 omap_device_enable(pdev);
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200766 pm_generic_runtime_resume(dev);
767 }
768
769 return pm_generic_resume_noirq(dev);
770}
Kevin Hilman126caf12011-09-01 10:59:36 -0700771#else
772#define _od_suspend_noirq NULL
773#define _od_resume_noirq NULL
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200774#endif
775
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600776struct dev_pm_domain omap_device_fail_pm_domain = {
777 .ops = {
778 SET_RUNTIME_PM_OPS(_od_fail_runtime_suspend,
779 _od_fail_runtime_resume, NULL)
780 }
781};
782
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800783struct dev_pm_domain omap_device_pm_domain = {
Kevin Hilman638080c2011-04-29 00:36:42 +0200784 .ops = {
Kevin Hilman256a5432011-07-12 22:48:03 +0200785 SET_RUNTIME_PM_OPS(_od_runtime_suspend, _od_runtime_resume,
Rafael J. Wysocki45f0a852013-06-03 21:49:52 +0200786 NULL)
Kevin Hilman638080c2011-04-29 00:36:42 +0200787 USE_PLATFORM_PM_SLEEP_OPS
Grygorii Strashkoc381f222015-04-27 21:24:32 +0300788 SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(_od_suspend_noirq,
789 _od_resume_noirq)
Kevin Hilman638080c2011-04-29 00:36:42 +0200790 }
791};
792
Thara Gopinathc23a97d2010-02-24 12:05:58 -0700793/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300794 * omap_device_register - register an omap_device with one omap_hwmod
795 * @od: struct omap_device * to register
796 *
797 * Register the omap_device structure. This currently just calls
798 * platform_device_register() on the underlying platform_device.
799 * Returns the return value of platform_device_register().
800 */
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800801int omap_device_register(struct platform_device *pdev)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300802{
Kevin Hilmanbfae4f82011-07-21 14:47:53 -0700803 pr_debug("omap_device: %s: registering\n", pdev->name);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300804
Tomeu Vizoso989561d2016-01-07 16:46:13 +0100805 dev_pm_domain_set(&pdev->dev, &omap_device_pm_domain);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700806 return platform_device_add(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300807}
808
809
810/* Public functions for use by device drivers through struct platform_data */
811
812/**
813 * omap_device_enable - fully activate an omap_device
814 * @od: struct omap_device * to activate
815 *
816 * Do whatever is necessary for the hwmods underlying omap_device @od
817 * to be accessible and ready to operate. This generally involves
818 * enabling clocks, setting SYSCONFIG registers; and in the future may
819 * involve remuxing pins. Device drivers should call this function
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700820 * indirectly via pm_runtime_get*(). Returns -EINVAL if called when
821 * the omap_device is already enabled, or passes along the return
822 * value of _omap_device_enable_hwmods().
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300823 */
824int omap_device_enable(struct platform_device *pdev)
825{
826 int ret;
827 struct omap_device *od;
828
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600829 od = to_omap_device(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300830
831 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
Kevin Hilman49882c92011-07-21 09:58:36 -0700832 dev_warn(&pdev->dev,
833 "omap_device: %s() called from invalid state %d\n",
834 __func__, od->_state);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300835 return -EINVAL;
836 }
837
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700838 ret = _omap_device_enable_hwmods(od);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300839
Pali Rohár6da23352015-02-26 14:49:51 +0100840 if (ret == 0)
841 od->_state = OMAP_DEVICE_STATE_ENABLED;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300842
843 return ret;
844}
845
846/**
847 * omap_device_idle - idle an omap_device
848 * @od: struct omap_device * to idle
849 *
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700850 * Idle omap_device @od. Device drivers call this function indirectly
851 * via pm_runtime_put*(). Returns -EINVAL if the omap_device is not
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300852 * currently enabled, or passes along the return value of
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700853 * _omap_device_idle_hwmods().
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300854 */
855int omap_device_idle(struct platform_device *pdev)
856{
857 int ret;
858 struct omap_device *od;
859
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600860 od = to_omap_device(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300861
862 if (od->_state != OMAP_DEVICE_STATE_ENABLED) {
Kevin Hilman49882c92011-07-21 09:58:36 -0700863 dev_warn(&pdev->dev,
864 "omap_device: %s() called from invalid state %d\n",
865 __func__, od->_state);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300866 return -EINVAL;
867 }
868
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700869 ret = _omap_device_idle_hwmods(od);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300870
Pali Rohár6da23352015-02-26 14:49:51 +0100871 if (ret == 0)
872 od->_state = OMAP_DEVICE_STATE_IDLE;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300873
874 return ret;
875}
876
877/**
Omar Ramirez Luna8bb9fde2012-09-23 17:28:18 -0600878 * omap_device_assert_hardreset - set a device's hardreset line
879 * @pdev: struct platform_device * to reset
880 * @name: const char * name of the reset line
881 *
882 * Set the hardreset line identified by @name on the IP blocks
883 * associated with the hwmods backing the platform_device @pdev. All
884 * of the hwmods associated with @pdev must have the same hardreset
885 * line linked to them for this to work. Passes along the return value
886 * of omap_hwmod_assert_hardreset() in the event of any failure, or
887 * returns 0 upon success.
888 */
889int omap_device_assert_hardreset(struct platform_device *pdev, const char *name)
890{
891 struct omap_device *od = to_omap_device(pdev);
892 int ret = 0;
893 int i;
894
895 for (i = 0; i < od->hwmods_cnt; i++) {
896 ret = omap_hwmod_assert_hardreset(od->hwmods[i], name);
897 if (ret)
898 break;
899 }
900
901 return ret;
902}
903
904/**
905 * omap_device_deassert_hardreset - release a device's hardreset line
906 * @pdev: struct platform_device * to reset
907 * @name: const char * name of the reset line
908 *
909 * Release the hardreset line identified by @name on the IP blocks
910 * associated with the hwmods backing the platform_device @pdev. All
911 * of the hwmods associated with @pdev must have the same hardreset
912 * line linked to them for this to work. Passes along the return
913 * value of omap_hwmod_deassert_hardreset() in the event of any
914 * failure, or returns 0 upon success.
915 */
916int omap_device_deassert_hardreset(struct platform_device *pdev,
917 const char *name)
918{
919 struct omap_device *od = to_omap_device(pdev);
920 int ret = 0;
921 int i;
922
923 for (i = 0; i < od->hwmods_cnt; i++) {
924 ret = omap_hwmod_deassert_hardreset(od->hwmods[i], name);
925 if (ret)
926 break;
927 }
928
929 return ret;
930}
931
932/**
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500933 * omap_device_get_by_hwmod_name() - convert a hwmod name to
934 * device pointer.
935 * @oh_name: name of the hwmod device
936 *
937 * Returns back a struct device * pointer associated with a hwmod
938 * device represented by a hwmod_name
939 */
940struct device *omap_device_get_by_hwmod_name(const char *oh_name)
941{
942 struct omap_hwmod *oh;
943
944 if (!oh_name) {
945 WARN(1, "%s: no hwmod name!\n", __func__);
946 return ERR_PTR(-EINVAL);
947 }
948
949 oh = omap_hwmod_lookup(oh_name);
Russell King857835c2013-02-24 10:56:59 +0000950 if (!oh) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500951 WARN(1, "%s: no hwmod for %s\n", __func__,
952 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000953 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500954 }
Russell King857835c2013-02-24 10:56:59 +0000955 if (!oh->od) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500956 WARN(1, "%s: no omap_device for %s\n", __func__,
957 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000958 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500959 }
960
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500961 return &oh->od->pdev->dev;
962}
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700963
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200964static struct notifier_block platform_nb = {
965 .notifier_call = _omap_device_notifier_call,
966};
967
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700968static int __init omap_device_init(void)
969{
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200970 bus_register_notifier(&platform_bus_type, &platform_nb);
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800971 return 0;
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700972}
Tony Lindgren8dd5ea72015-12-03 11:38:09 -0800973omap_postcore_initcall(omap_device_init);
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700974
975/**
976 * omap_device_late_idle - idle devices without drivers
977 * @dev: struct device * associated with omap_device
978 * @data: unused
979 *
980 * Check the driver bound status of this device, and idle it
981 * if there is no driver attached.
982 */
983static int __init omap_device_late_idle(struct device *dev, void *data)
984{
985 struct platform_device *pdev = to_platform_device(dev);
986 struct omap_device *od = to_omap_device(pdev);
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600987 int i;
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700988
989 if (!od)
990 return 0;
991
992 /*
993 * If omap_device state is enabled, but has no driver bound,
994 * idle it.
995 */
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600996
997 /*
998 * Some devices (like memory controllers) are always kept
999 * enabled, and should not be idled even with no drivers.
1000 */
1001 for (i = 0; i < od->hwmods_cnt; i++)
1002 if (od->hwmods[i]->flags & HWMOD_INIT_NO_IDLE)
1003 return 0;
1004
Grygorii Strashkofe8291e2015-09-01 13:59:24 -07001005 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER &&
1006 od->_driver_status != BUS_NOTIFY_BIND_DRIVER) {
Kevin Hilman9634c8d2012-07-10 15:06:11 -07001007 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
1008 dev_warn(dev, "%s: enabled but no driver. Idling\n",
1009 __func__);
1010 omap_device_idle(pdev);
1011 }
1012 }
1013
1014 return 0;
1015}
1016
1017static int __init omap_device_late_init(void)
1018{
1019 bus_for_each_dev(&platform_bus_type, NULL, NULL, omap_device_late_idle);
Tony Lindgren4b91f7f2014-10-27 13:05:54 -07001020
Kevin Hilman9634c8d2012-07-10 15:06:11 -07001021 return 0;
1022}
Kevin Hilmane7e17c52013-05-08 16:48:01 -07001023omap_late_initcall_sync(omap_device_late_init);