blob: ef9ffb8ac9126d6cc744475d9a12f2f90994404e [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>
38#include <linux/notifier.h>
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030039
Tony Lindgrendad12d12013-12-06 10:52:58 -080040#include "common.h"
Tony Lindgrenb76c8b12013-01-11 11:24:18 -080041#include "soc.h"
Tony Lindgren25c7d492012-10-02 17:25:48 -070042#include "omap_device.h"
Tony Lindgren2a296c82012-10-02 17:41:35 -070043#include "omap_hwmod.h"
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030044
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030045/* Private functions */
46
Benoit Coussonbf1e0772011-07-10 05:54:12 -060047static void _add_clkdev(struct omap_device *od, const char *clk_alias,
48 const char *clk_name)
49{
50 struct clk *r;
Russell King1ca90bd2015-03-02 15:46:03 +000051 int rc;
Benoit Coussonbf1e0772011-07-10 05:54:12 -060052
53 if (!clk_alias || !clk_name)
54 return;
55
Kevin Hilmand66b3fe2011-07-21 13:58:51 -070056 dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060057
Kevin Hilmand66b3fe2011-07-21 13:58:51 -070058 r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060059 if (!IS_ERR(r)) {
Markus Pargmann9a02ae42014-08-25 16:15:34 -070060 dev_dbg(&od->pdev->dev,
Kevin Hilman49882c92011-07-21 09:58:36 -070061 "alias %s already exists\n", clk_alias);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060062 clk_put(r);
63 return;
64 }
65
Tero Kristo59dcfc42016-06-30 16:14:59 +030066 r = clk_get_sys(NULL, clk_name);
67
Tony Lindgren1aa8f0c2017-05-31 15:51:37 -070068 if (IS_ERR(r)) {
Tero Kristo59dcfc42016-06-30 16:14:59 +030069 struct of_phandle_args clkspec;
70
71 clkspec.np = of_find_node_by_name(NULL, clk_name);
72
73 r = of_clk_get_from_provider(&clkspec);
74
75 rc = clk_register_clkdev(r, clk_alias,
76 dev_name(&od->pdev->dev));
77 } else {
78 rc = clk_add_alias(clk_alias, dev_name(&od->pdev->dev),
79 clk_name, NULL);
80 }
81
Russell King1ca90bd2015-03-02 15:46:03 +000082 if (rc) {
83 if (rc == -ENODEV || rc == -ENOMEM)
84 dev_err(&od->pdev->dev,
85 "clkdev_alloc for %s failed\n", clk_alias);
86 else
87 dev_err(&od->pdev->dev,
88 "clk_get for %s failed\n", clk_name);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060089 }
Benoit Coussonbf1e0772011-07-10 05:54:12 -060090}
91
Partha Basak4ef7aca2010-09-21 19:23:04 +020092/**
Benoit Coussonbf1e0772011-07-10 05:54:12 -060093 * _add_hwmod_clocks_clkdev - Add clkdev entry for hwmod optional clocks
94 * and main clock
Partha Basak4ef7aca2010-09-21 19:23:04 +020095 * @od: struct omap_device *od
Benoit Coussonbf1e0772011-07-10 05:54:12 -060096 * @oh: struct omap_hwmod *oh
Partha Basak4ef7aca2010-09-21 19:23:04 +020097 *
Benoit Coussonbf1e0772011-07-10 05:54:12 -060098 * For the main clock and every optional clock present per hwmod per
99 * omap_device, this function adds an entry in the clkdev table of the
100 * form <dev-id=dev_name, con-id=role> if it does not exist already.
Partha Basak4ef7aca2010-09-21 19:23:04 +0200101 *
102 * The function is called from inside omap_device_build_ss(), after
103 * omap_device_register.
104 *
105 * This allows drivers to get a pointer to its optional clocks based on its role
106 * by calling clk_get(<dev*>, <role>).
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600107 * In the case of the main clock, a "fck" alias is used.
Partha Basak4ef7aca2010-09-21 19:23:04 +0200108 *
109 * No return value.
110 */
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600111static void _add_hwmod_clocks_clkdev(struct omap_device *od,
112 struct omap_hwmod *oh)
Partha Basak4ef7aca2010-09-21 19:23:04 +0200113{
114 int i;
115
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600116 _add_clkdev(od, "fck", oh->main_clk);
Partha Basak4ef7aca2010-09-21 19:23:04 +0200117
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600118 for (i = 0; i < oh->opt_clks_cnt; i++)
119 _add_clkdev(od, oh->opt_clks[i].role, oh->opt_clks[i].clk);
Partha Basak4ef7aca2010-09-21 19:23:04 +0200120}
121
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300122
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200123/**
124 * omap_device_build_from_dt - build an omap_device with multiple hwmods
125 * @pdev_name: name of the platform_device driver to use
126 * @pdev_id: this platform_device's connection ID
127 * @oh: ptr to the single omap_hwmod that backs this omap_device
128 * @pdata: platform_data ptr to associate with the platform_device
129 * @pdata_len: amount of memory pointed to by @pdata
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200130 *
131 * Function for building an omap_device already registered from device-tree
132 *
133 * Returns 0 or PTR_ERR() on error.
134 */
135static int omap_device_build_from_dt(struct platform_device *pdev)
136{
137 struct omap_hwmod **hwmods;
138 struct omap_device *od;
139 struct omap_hwmod *oh;
140 struct device_node *node = pdev->dev.of_node;
141 const char *oh_name;
142 int oh_cnt, i, ret = 0;
Rajendra Nayak72680322013-07-28 23:01:51 -0600143 bool device_active = false;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200144
145 oh_cnt = of_property_count_strings(node, "ti,hwmods");
Russell Kingc48cd652013-03-13 20:44:21 +0000146 if (oh_cnt <= 0) {
Benoit Cousson5dc06b72012-01-20 18:14:00 +0100147 dev_dbg(&pdev->dev, "No 'hwmods' to build omap_device\n");
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200148 return -ENODEV;
149 }
150
151 hwmods = kzalloc(sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
152 if (!hwmods) {
153 ret = -ENOMEM;
154 goto odbfd_exit;
155 }
156
157 for (i = 0; i < oh_cnt; i++) {
158 of_property_read_string_index(node, "ti,hwmods", i, &oh_name);
159 oh = omap_hwmod_lookup(oh_name);
160 if (!oh) {
161 dev_err(&pdev->dev, "Cannot lookup hwmod '%s'\n",
162 oh_name);
163 ret = -EINVAL;
164 goto odbfd_exit1;
165 }
166 hwmods[i] = oh;
Rajendra Nayak72680322013-07-28 23:01:51 -0600167 if (oh->flags & HWMOD_INIT_NO_IDLE)
168 device_active = true;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200169 }
170
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700171 od = omap_device_alloc(pdev, hwmods, oh_cnt);
Wei Yongjun4cf9cf82013-09-18 12:01:58 -0700172 if (IS_ERR(od)) {
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200173 dev_err(&pdev->dev, "Cannot allocate omap_device for :%s\n",
174 oh_name);
175 ret = PTR_ERR(od);
176 goto odbfd_exit1;
177 }
178
Peter Ujfalusi3956a1a2012-08-23 16:54:09 +0300179 /* Fix up missing resource names */
180 for (i = 0; i < pdev->num_resources; i++) {
181 struct resource *r = &pdev->resource[i];
182
183 if (r->name == NULL)
184 r->name = dev_name(&pdev->dev);
185 }
186
Tomeu Vizoso989561d2016-01-07 16:46:13 +0100187 dev_pm_domain_set(&pdev->dev, &omap_device_pm_domain);
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200188
Rajendra Nayak72680322013-07-28 23:01:51 -0600189 if (device_active) {
190 omap_device_enable(pdev);
191 pm_runtime_set_active(&pdev->dev);
192 }
193
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200194odbfd_exit1:
195 kfree(hwmods);
196odbfd_exit:
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600197 /* if data/we are at fault.. load up a fail handler */
198 if (ret)
Tomeu Vizoso989561d2016-01-07 16:46:13 +0100199 dev_pm_domain_set(&pdev->dev, &omap_device_fail_pm_domain);
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600200
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200201 return ret;
202}
203
204static int _omap_device_notifier_call(struct notifier_block *nb,
205 unsigned long event, void *dev)
206{
207 struct platform_device *pdev = to_platform_device(dev);
Kevin Hilmane7533452012-07-10 11:13:16 -0700208 struct omap_device *od;
Tony Lindgrencf26f112016-02-12 08:56:52 -0800209 int err;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200210
211 switch (event) {
Grygorii Strashko213fa102016-07-28 20:50:37 +0300212 case BUS_NOTIFY_REMOVED_DEVICE:
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200213 if (pdev->archdata.od)
214 omap_device_delete(pdev->archdata.od);
215 break;
Tony Lindgrencf26f112016-02-12 08:56:52 -0800216 case BUS_NOTIFY_UNBOUND_DRIVER:
217 od = to_omap_device(pdev);
218 if (od && (od->_state == OMAP_DEVICE_STATE_ENABLED)) {
219 dev_info(dev, "enabled after unload, idling\n");
220 err = omap_device_idle(pdev);
221 if (err)
222 dev_err(dev, "failed to idle\n");
223 }
224 break;
Dave Gerlach04abaf02017-03-30 14:58:18 -0500225 case BUS_NOTIFY_BIND_DRIVER:
226 od = to_omap_device(pdev);
227 if (od && (od->_state == OMAP_DEVICE_STATE_ENABLED) &&
228 pm_runtime_status_suspended(dev)) {
229 od->_driver_status = BUS_NOTIFY_BIND_DRIVER;
230 pm_runtime_set_active(dev);
231 }
232 break;
Kevin Hilmane7533452012-07-10 11:13:16 -0700233 case BUS_NOTIFY_ADD_DEVICE:
234 if (pdev->dev.of_node)
235 omap_device_build_from_dt(pdev);
Tony Lindgrendad12d12013-12-06 10:52:58 -0800236 omap_auxdata_legacy_init(dev);
Kevin Hilmane7533452012-07-10 11:13:16 -0700237 /* fall through */
238 default:
239 od = to_omap_device(pdev);
240 if (od)
241 od->_driver_status = event;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200242 }
243
244 return NOTIFY_DONE;
245}
246
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700247/**
248 * _omap_device_enable_hwmods - call omap_hwmod_enable() on all hwmods
249 * @od: struct omap_device *od
250 *
251 * Enable all underlying hwmods. Returns 0.
252 */
253static int _omap_device_enable_hwmods(struct omap_device *od)
254{
Pali Rohár6da23352015-02-26 14:49:51 +0100255 int ret = 0;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700256 int i;
257
258 for (i = 0; i < od->hwmods_cnt; i++)
Pali Rohár6da23352015-02-26 14:49:51 +0100259 ret |= omap_hwmod_enable(od->hwmods[i]);
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700260
Pali Rohár6da23352015-02-26 14:49:51 +0100261 return ret;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700262}
263
264/**
265 * _omap_device_idle_hwmods - call omap_hwmod_idle() on all hwmods
266 * @od: struct omap_device *od
267 *
268 * Idle all underlying hwmods. Returns 0.
269 */
270static int _omap_device_idle_hwmods(struct omap_device *od)
271{
Pali Rohár6da23352015-02-26 14:49:51 +0100272 int ret = 0;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700273 int i;
274
275 for (i = 0; i < od->hwmods_cnt; i++)
Pali Rohár6da23352015-02-26 14:49:51 +0100276 ret |= omap_hwmod_idle(od->hwmods[i]);
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700277
Pali Rohár6da23352015-02-26 14:49:51 +0100278 return ret;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700279}
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200280
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300281/* Public functions for use by core code */
282
283/**
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700284 * omap_device_get_context_loss_count - get lost context count
285 * @od: struct omap_device *
286 *
287 * Using the primary hwmod, query the context loss count for this
288 * device.
289 *
290 * Callers should consider context for this device lost any time this
291 * function returns a value different than the value the caller got
292 * the last time it called this function.
293 *
Andrea Gelminif733e7c2016-05-21 13:50:25 +0200294 * If any hwmods exist for the omap_device associated with @pdev,
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700295 * return the context loss counter for that hwmod, otherwise return
296 * zero.
297 */
Tomi Valkeinenfc013872011-06-09 16:56:23 +0300298int omap_device_get_context_loss_count(struct platform_device *pdev)
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700299{
300 struct omap_device *od;
301 u32 ret = 0;
302
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600303 od = to_omap_device(pdev);
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700304
305 if (od->hwmods_cnt)
306 ret = omap_hwmod_get_context_loss_count(od->hwmods[0]);
307
308 return ret;
309}
310
311/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300312 * omap_device_count_resources - count number of struct resource entries needed
313 * @od: struct omap_device *
Peter Ujfalusidad41912012-11-21 16:15:17 -0700314 * @flags: Type of resources to include when counting (IRQ/DMA/MEM)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300315 *
316 * Count the number of struct resource entries needed for this
317 * omap_device @od. Used by omap_device_build_ss() to determine how
318 * much memory to allocate before calling
319 * omap_device_fill_resources(). Returns the count.
320 */
Peter Ujfalusidad41912012-11-21 16:15:17 -0700321static int omap_device_count_resources(struct omap_device *od,
322 unsigned long flags)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300323{
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300324 int c = 0;
325 int i;
326
Kishon Vijay Abraham If39f4892010-09-24 10:23:18 -0600327 for (i = 0; i < od->hwmods_cnt; i++)
Peter Ujfalusidad41912012-11-21 16:15:17 -0700328 c += omap_hwmod_count_resources(od->hwmods[i], flags);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300329
Paul Walmsley7852ec02012-07-26 00:54:26 -0600330 pr_debug("omap_device: %s: counted %d total resources across %d hwmods\n",
331 od->pdev->name, c, od->hwmods_cnt);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300332
333 return c;
334}
335
336/**
337 * omap_device_fill_resources - fill in array of struct resource
338 * @od: struct omap_device *
339 * @res: pointer to an array of struct resource to be filled in
340 *
341 * Populate one or more empty struct resource pointed to by @res with
342 * the resource data for this omap_device @od. Used by
343 * omap_device_build_ss() after calling omap_device_count_resources().
344 * Ideally this function would not be needed at all. If omap_device
345 * replaces platform_device, then we can specify our own
346 * get_resource()/ get_irq()/etc functions that use the underlying
347 * omap_hwmod information. Or if platform_device is extended to use
348 * subarchitecture-specific function pointers, the various
349 * platform_device functions can simply call omap_device internal
350 * functions to get device resources. Hacking around the existing
351 * platform_device code wastes memory. Returns 0.
352 */
Kevin Hilmana2a28ad2011-07-21 14:14:35 -0700353static int omap_device_fill_resources(struct omap_device *od,
354 struct resource *res)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300355{
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300356 int i, r;
357
Kishon Vijay Abraham If39f4892010-09-24 10:23:18 -0600358 for (i = 0; i < od->hwmods_cnt; i++) {
359 r = omap_hwmod_fill_resources(od->hwmods[i], res);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300360 res += r;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300361 }
362
363 return 0;
364}
365
366/**
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530367 * _od_fill_dma_resources - fill in array of struct resource with dma resources
368 * @od: struct omap_device *
369 * @res: pointer to an array of struct resource to be filled in
370 *
371 * Populate one or more empty struct resource pointed to by @res with
372 * the dma resource data for this omap_device @od. Used by
373 * omap_device_alloc() after calling omap_device_count_resources().
374 *
375 * Ideally this function would not be needed at all. If we have
376 * mechanism to get dma resources from DT.
377 *
378 * Returns 0.
379 */
380static int _od_fill_dma_resources(struct omap_device *od,
381 struct resource *res)
382{
383 int i, r;
384
385 for (i = 0; i < od->hwmods_cnt; i++) {
386 r = omap_hwmod_fill_dma_resources(od->hwmods[i], res);
387 res += r;
388 }
389
390 return 0;
391}
392
393/**
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200394 * omap_device_alloc - allocate an omap_device
395 * @pdev: platform_device that will be included in this omap_device
396 * @oh: ptr to the single omap_hwmod that backs this omap_device
397 * @pdata: platform_data ptr to associate with the platform_device
398 * @pdata_len: amount of memory pointed to by @pdata
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200399 *
400 * Convenience function for allocating an omap_device structure and filling
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700401 * hwmods, and resources.
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200402 *
403 * Returns an struct omap_device pointer or ERR_PTR() on error;
404 */
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800405struct omap_device *omap_device_alloc(struct platform_device *pdev,
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700406 struct omap_hwmod **ohs, int oh_cnt)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200407{
408 int ret = -ENOMEM;
409 struct omap_device *od;
410 struct resource *res = NULL;
411 int i, res_count;
412 struct omap_hwmod **hwmods;
413
414 od = kzalloc(sizeof(struct omap_device), GFP_KERNEL);
415 if (!od) {
416 ret = -ENOMEM;
417 goto oda_exit1;
418 }
419 od->hwmods_cnt = oh_cnt;
420
421 hwmods = kmemdup(ohs, sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
422 if (!hwmods)
423 goto oda_exit2;
424
425 od->hwmods = hwmods;
426 od->pdev = pdev;
427
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530428 /*
Peter Ujfalusic567b052012-11-21 16:15:18 -0700429 * Non-DT Boot:
430 * Here, pdev->num_resources = 0, and we should get all the
431 * resources from hwmod.
432 *
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530433 * DT Boot:
434 * OF framework will construct the resource structure (currently
435 * does for MEM & IRQ resource) and we should respect/use these
436 * resources, killing hwmod dependency.
437 * If pdev->num_resources > 0, we assume that MEM & IRQ resources
438 * have been allocated by OF layer already (through DTB).
Peter Ujfalusic567b052012-11-21 16:15:18 -0700439 * As preparation for the future we examine the OF provided resources
440 * to see if we have DMA resources provided already. In this case
441 * there is no need to update the resources for the device, we use the
442 * OF provided ones.
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530443 *
444 * TODO: Once DMA resource is available from OF layer, we should
445 * kill filling any resources from hwmod.
446 */
Peter Ujfalusic567b052012-11-21 16:15:18 -0700447 if (!pdev->num_resources) {
448 /* Count all resources for the device */
449 res_count = omap_device_count_resources(od, IORESOURCE_IRQ |
450 IORESOURCE_DMA |
451 IORESOURCE_MEM);
452 } else {
453 /* Take a look if we already have DMA resource via DT */
454 for (i = 0; i < pdev->num_resources; i++) {
455 struct resource *r = &pdev->resource[i];
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200456
Peter Ujfalusic567b052012-11-21 16:15:18 -0700457 /* We have it, no need to touch the resources */
458 if (r->flags == IORESOURCE_DMA)
459 goto have_everything;
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530460 }
Peter Ujfalusic567b052012-11-21 16:15:18 -0700461 /* Count only DMA resources for the device */
462 res_count = omap_device_count_resources(od, IORESOURCE_DMA);
463 /* The device has no DMA resource, no need for update */
464 if (!res_count)
465 goto have_everything;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200466
Peter Ujfalusic567b052012-11-21 16:15:18 -0700467 res_count += pdev->num_resources;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200468 }
469
Peter Ujfalusic567b052012-11-21 16:15:18 -0700470 /* Allocate resources memory to account for new resources */
471 res = kzalloc(sizeof(struct resource) * res_count, GFP_KERNEL);
472 if (!res)
473 goto oda_exit3;
474
475 if (!pdev->num_resources) {
476 dev_dbg(&pdev->dev, "%s: using %d resources from hwmod\n",
477 __func__, res_count);
478 omap_device_fill_resources(od, res);
479 } else {
480 dev_dbg(&pdev->dev,
481 "%s: appending %d DMA resources from hwmod\n",
482 __func__, res_count - pdev->num_resources);
483 memcpy(res, pdev->resource,
484 sizeof(struct resource) * pdev->num_resources);
485 _od_fill_dma_resources(od, &res[pdev->num_resources]);
486 }
487
488 ret = platform_device_add_resources(pdev, res, res_count);
489 kfree(res);
490
491 if (ret)
492 goto oda_exit3;
493
494have_everything:
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200495 pdev->archdata.od = od;
496
497 for (i = 0; i < oh_cnt; i++) {
498 hwmods[i]->od = od;
499 _add_hwmod_clocks_clkdev(od, hwmods[i]);
500 }
501
502 return od;
503
504oda_exit3:
505 kfree(hwmods);
506oda_exit2:
507 kfree(od);
508oda_exit1:
509 dev_err(&pdev->dev, "omap_device: build failed (%d)\n", ret);
510
511 return ERR_PTR(ret);
512}
513
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800514void omap_device_delete(struct omap_device *od)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200515{
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200516 if (!od)
517 return;
518
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200519 od->pdev->archdata.od = NULL;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200520 kfree(od->hwmods);
521 kfree(od);
522}
523
524/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300525 * omap_device_build - build and register an omap_device with one omap_hwmod
526 * @pdev_name: name of the platform_device driver to use
527 * @pdev_id: this platform_device's connection ID
528 * @oh: ptr to the single omap_hwmod that backs this omap_device
529 * @pdata: platform_data ptr to associate with the platform_device
530 * @pdata_len: amount of memory pointed to by @pdata
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300531 *
532 * Convenience function for building and registering a single
533 * omap_device record, which in turn builds and registers a
534 * platform_device record. See omap_device_build_ss() for more
535 * information. Returns ERR_PTR(-EINVAL) if @oh is NULL; otherwise,
536 * passes along the return value of omap_device_build_ss().
537 */
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700538struct platform_device __init *omap_device_build(const char *pdev_name,
539 int pdev_id,
540 struct omap_hwmod *oh,
541 void *pdata, int pdata_len)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300542{
543 struct omap_hwmod *ohs[] = { oh };
544
545 if (!oh)
546 return ERR_PTR(-EINVAL);
547
548 return omap_device_build_ss(pdev_name, pdev_id, ohs, 1, pdata,
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700549 pdata_len);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300550}
551
552/**
553 * omap_device_build_ss - build and register an omap_device with multiple hwmods
554 * @pdev_name: name of the platform_device driver to use
555 * @pdev_id: this platform_device's connection ID
556 * @oh: ptr to the single omap_hwmod that backs this omap_device
557 * @pdata: platform_data ptr to associate with the platform_device
558 * @pdata_len: amount of memory pointed to by @pdata
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300559 *
560 * Convenience function for building and registering an omap_device
561 * subsystem record. Subsystem records consist of multiple
562 * omap_hwmods. This function in turn builds and registers a
563 * platform_device record. Returns an ERR_PTR() on error, or passes
564 * along the return value of omap_device_register().
565 */
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700566struct platform_device __init *omap_device_build_ss(const char *pdev_name,
567 int pdev_id,
568 struct omap_hwmod **ohs,
569 int oh_cnt, void *pdata,
570 int pdata_len)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300571{
572 int ret = -ENOMEM;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700573 struct platform_device *pdev;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300574 struct omap_device *od;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300575
576 if (!ohs || oh_cnt == 0 || !pdev_name)
577 return ERR_PTR(-EINVAL);
578
579 if (!pdata && pdata_len > 0)
580 return ERR_PTR(-EINVAL);
581
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700582 pdev = platform_device_alloc(pdev_name, pdev_id);
583 if (!pdev) {
584 ret = -ENOMEM;
585 goto odbs_exit;
586 }
587
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200588 /* Set the dev_name early to allow dev_xxx in omap_device_alloc */
589 if (pdev->id != -1)
590 dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
591 else
592 dev_set_name(&pdev->dev, "%s", pdev->name);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300593
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700594 od = omap_device_alloc(pdev, ohs, oh_cnt);
Wei Yongjuna87e6622012-09-21 14:32:04 +0800595 if (IS_ERR(od))
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700596 goto odbs_exit1;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300597
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700598 ret = platform_device_add_data(pdev, pdata, pdata_len);
Artem Bityutskiy49b368a2010-07-12 13:38:07 +0000599 if (ret)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200600 goto odbs_exit2;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700601
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700602 ret = omap_device_register(pdev);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700603 if (ret)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200604 goto odbs_exit2;
Kevin Hilman06563582010-07-26 16:34:30 -0600605
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700606 return pdev;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300607
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700608odbs_exit2:
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200609 omap_device_delete(od);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700610odbs_exit1:
611 platform_device_put(pdev);
612odbs_exit:
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300613
614 pr_err("omap_device: %s: build failed (%d)\n", pdev_name, ret);
615
616 return ERR_PTR(ret);
617}
618
Rafael J. Wysockibf7c5442014-12-13 00:42:49 +0100619#ifdef CONFIG_PM
Kevin Hilman638080c2011-04-29 00:36:42 +0200620static int _od_runtime_suspend(struct device *dev)
621{
622 struct platform_device *pdev = to_platform_device(dev);
Kevin Hilman345f79b2011-05-31 16:08:09 -0700623 int ret;
Kevin Hilman638080c2011-04-29 00:36:42 +0200624
Kevin Hilman345f79b2011-05-31 16:08:09 -0700625 ret = pm_generic_runtime_suspend(dev);
Pali Rohár6da23352015-02-26 14:49:51 +0100626 if (ret)
627 return ret;
Kevin Hilman345f79b2011-05-31 16:08:09 -0700628
Pali Rohár6da23352015-02-26 14:49:51 +0100629 return omap_device_idle(pdev);
Kevin Hilman345f79b2011-05-31 16:08:09 -0700630}
631
Kevin Hilman638080c2011-04-29 00:36:42 +0200632static int _od_runtime_resume(struct device *dev)
633{
634 struct platform_device *pdev = to_platform_device(dev);
Pali Rohár6da23352015-02-26 14:49:51 +0100635 int ret;
Kevin Hilman638080c2011-04-29 00:36:42 +0200636
Pali Rohár6da23352015-02-26 14:49:51 +0100637 ret = omap_device_enable(pdev);
Tony Lindgren08c78e92016-02-12 08:56:52 -0800638 if (ret) {
639 dev_err(dev, "use pm_runtime_put_sync_suspend() in driver?\n");
Pali Rohár6da23352015-02-26 14:49:51 +0100640 return ret;
Tony Lindgren08c78e92016-02-12 08:56:52 -0800641 }
Kevin Hilman345f79b2011-05-31 16:08:09 -0700642
643 return pm_generic_runtime_resume(dev);
Kevin Hilman638080c2011-04-29 00:36:42 +0200644}
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600645
646static int _od_fail_runtime_suspend(struct device *dev)
647{
648 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
649 return -ENODEV;
650}
651
652static int _od_fail_runtime_resume(struct device *dev)
653{
654 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
655 return -ENODEV;
656}
657
Kevin Hilman256a5432011-07-12 22:48:03 +0200658#endif
Kevin Hilman638080c2011-04-29 00:36:42 +0200659
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200660#ifdef CONFIG_SUSPEND
661static int _od_suspend_noirq(struct device *dev)
662{
663 struct platform_device *pdev = to_platform_device(dev);
664 struct omap_device *od = to_omap_device(pdev);
665 int ret;
666
Kevin Hilman72bb6f92012-07-10 15:29:04 -0700667 /* Don't attempt late suspend on a driver that is not bound */
668 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER)
669 return 0;
670
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200671 ret = pm_generic_suspend_noirq(dev);
672
673 if (!ret && !pm_runtime_status_suspended(dev)) {
674 if (pm_generic_runtime_suspend(dev) == 0) {
Nishanth Menon3522bf72013-11-14 11:05:16 -0600675 pm_runtime_set_suspended(dev);
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530676 omap_device_idle(pdev);
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200677 od->flags |= OMAP_DEVICE_SUSPENDED;
678 }
679 }
680
681 return ret;
682}
683
684static int _od_resume_noirq(struct device *dev)
685{
686 struct platform_device *pdev = to_platform_device(dev);
687 struct omap_device *od = to_omap_device(pdev);
688
Nishanth Menon3522bf72013-11-14 11:05:16 -0600689 if (od->flags & OMAP_DEVICE_SUSPENDED) {
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200690 od->flags &= ~OMAP_DEVICE_SUSPENDED;
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530691 omap_device_enable(pdev);
Nishanth Menon3522bf72013-11-14 11:05:16 -0600692 /*
693 * XXX: we run before core runtime pm has resumed itself. At
694 * this point in time, we just restore the runtime pm state and
695 * considering symmetric operations in resume, we donot expect
696 * to fail. If we failed, something changed in core runtime_pm
697 * framework OR some device driver messed things up, hence, WARN
698 */
699 WARN(pm_runtime_set_active(dev),
700 "Could not set %s runtime state active\n", dev_name(dev));
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200701 pm_generic_runtime_resume(dev);
702 }
703
704 return pm_generic_resume_noirq(dev);
705}
Kevin Hilman126caf12011-09-01 10:59:36 -0700706#else
707#define _od_suspend_noirq NULL
708#define _od_resume_noirq NULL
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200709#endif
710
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600711struct dev_pm_domain omap_device_fail_pm_domain = {
712 .ops = {
713 SET_RUNTIME_PM_OPS(_od_fail_runtime_suspend,
714 _od_fail_runtime_resume, NULL)
715 }
716};
717
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800718struct dev_pm_domain omap_device_pm_domain = {
Kevin Hilman638080c2011-04-29 00:36:42 +0200719 .ops = {
Kevin Hilman256a5432011-07-12 22:48:03 +0200720 SET_RUNTIME_PM_OPS(_od_runtime_suspend, _od_runtime_resume,
Rafael J. Wysocki45f0a852013-06-03 21:49:52 +0200721 NULL)
Kevin Hilman638080c2011-04-29 00:36:42 +0200722 USE_PLATFORM_PM_SLEEP_OPS
Grygorii Strashkoc381f222015-04-27 21:24:32 +0300723 SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(_od_suspend_noirq,
724 _od_resume_noirq)
Kevin Hilman638080c2011-04-29 00:36:42 +0200725 }
726};
727
Thara Gopinathc23a97d2010-02-24 12:05:58 -0700728/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300729 * omap_device_register - register an omap_device with one omap_hwmod
730 * @od: struct omap_device * to register
731 *
732 * Register the omap_device structure. This currently just calls
733 * platform_device_register() on the underlying platform_device.
734 * Returns the return value of platform_device_register().
735 */
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800736int omap_device_register(struct platform_device *pdev)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300737{
Kevin Hilmanbfae4f82011-07-21 14:47:53 -0700738 pr_debug("omap_device: %s: registering\n", pdev->name);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300739
Tomeu Vizoso989561d2016-01-07 16:46:13 +0100740 dev_pm_domain_set(&pdev->dev, &omap_device_pm_domain);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700741 return platform_device_add(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300742}
743
744
745/* Public functions for use by device drivers through struct platform_data */
746
747/**
748 * omap_device_enable - fully activate an omap_device
749 * @od: struct omap_device * to activate
750 *
751 * Do whatever is necessary for the hwmods underlying omap_device @od
752 * to be accessible and ready to operate. This generally involves
753 * enabling clocks, setting SYSCONFIG registers; and in the future may
754 * involve remuxing pins. Device drivers should call this function
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700755 * indirectly via pm_runtime_get*(). Returns -EINVAL if called when
756 * the omap_device is already enabled, or passes along the return
757 * value of _omap_device_enable_hwmods().
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300758 */
759int omap_device_enable(struct platform_device *pdev)
760{
761 int ret;
762 struct omap_device *od;
763
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600764 od = to_omap_device(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300765
766 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
Kevin Hilman49882c92011-07-21 09:58:36 -0700767 dev_warn(&pdev->dev,
768 "omap_device: %s() called from invalid state %d\n",
769 __func__, od->_state);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300770 return -EINVAL;
771 }
772
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700773 ret = _omap_device_enable_hwmods(od);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300774
Pali Rohár6da23352015-02-26 14:49:51 +0100775 if (ret == 0)
776 od->_state = OMAP_DEVICE_STATE_ENABLED;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300777
778 return ret;
779}
780
781/**
782 * omap_device_idle - idle an omap_device
783 * @od: struct omap_device * to idle
784 *
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700785 * Idle omap_device @od. Device drivers call this function indirectly
786 * via pm_runtime_put*(). Returns -EINVAL if the omap_device is not
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300787 * currently enabled, or passes along the return value of
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700788 * _omap_device_idle_hwmods().
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300789 */
790int omap_device_idle(struct platform_device *pdev)
791{
792 int ret;
793 struct omap_device *od;
794
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600795 od = to_omap_device(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300796
797 if (od->_state != OMAP_DEVICE_STATE_ENABLED) {
Kevin Hilman49882c92011-07-21 09:58:36 -0700798 dev_warn(&pdev->dev,
799 "omap_device: %s() called from invalid state %d\n",
800 __func__, od->_state);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300801 return -EINVAL;
802 }
803
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700804 ret = _omap_device_idle_hwmods(od);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300805
Pali Rohár6da23352015-02-26 14:49:51 +0100806 if (ret == 0)
807 od->_state = OMAP_DEVICE_STATE_IDLE;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300808
809 return ret;
810}
811
812/**
Omar Ramirez Luna8bb9fde2012-09-23 17:28:18 -0600813 * omap_device_assert_hardreset - set a device's hardreset line
814 * @pdev: struct platform_device * to reset
815 * @name: const char * name of the reset line
816 *
817 * Set the hardreset line identified by @name on the IP blocks
818 * associated with the hwmods backing the platform_device @pdev. All
819 * of the hwmods associated with @pdev must have the same hardreset
820 * line linked to them for this to work. Passes along the return value
821 * of omap_hwmod_assert_hardreset() in the event of any failure, or
822 * returns 0 upon success.
823 */
824int omap_device_assert_hardreset(struct platform_device *pdev, const char *name)
825{
826 struct omap_device *od = to_omap_device(pdev);
827 int ret = 0;
828 int i;
829
830 for (i = 0; i < od->hwmods_cnt; i++) {
831 ret = omap_hwmod_assert_hardreset(od->hwmods[i], name);
832 if (ret)
833 break;
834 }
835
836 return ret;
837}
838
839/**
840 * omap_device_deassert_hardreset - release a device's hardreset line
841 * @pdev: struct platform_device * to reset
842 * @name: const char * name of the reset line
843 *
844 * Release the hardreset line identified by @name on the IP blocks
845 * associated with the hwmods backing the platform_device @pdev. All
846 * of the hwmods associated with @pdev must have the same hardreset
847 * line linked to them for this to work. Passes along the return
848 * value of omap_hwmod_deassert_hardreset() in the event of any
849 * failure, or returns 0 upon success.
850 */
851int omap_device_deassert_hardreset(struct platform_device *pdev,
852 const char *name)
853{
854 struct omap_device *od = to_omap_device(pdev);
855 int ret = 0;
856 int i;
857
858 for (i = 0; i < od->hwmods_cnt; i++) {
859 ret = omap_hwmod_deassert_hardreset(od->hwmods[i], name);
860 if (ret)
861 break;
862 }
863
864 return ret;
865}
866
867/**
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500868 * omap_device_get_by_hwmod_name() - convert a hwmod name to
869 * device pointer.
870 * @oh_name: name of the hwmod device
871 *
872 * Returns back a struct device * pointer associated with a hwmod
873 * device represented by a hwmod_name
874 */
875struct device *omap_device_get_by_hwmod_name(const char *oh_name)
876{
877 struct omap_hwmod *oh;
878
879 if (!oh_name) {
880 WARN(1, "%s: no hwmod name!\n", __func__);
881 return ERR_PTR(-EINVAL);
882 }
883
884 oh = omap_hwmod_lookup(oh_name);
Russell King857835c2013-02-24 10:56:59 +0000885 if (!oh) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500886 WARN(1, "%s: no hwmod for %s\n", __func__,
887 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000888 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500889 }
Russell King857835c2013-02-24 10:56:59 +0000890 if (!oh->od) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500891 WARN(1, "%s: no omap_device for %s\n", __func__,
892 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000893 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500894 }
895
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500896 return &oh->od->pdev->dev;
897}
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700898
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200899static struct notifier_block platform_nb = {
900 .notifier_call = _omap_device_notifier_call,
901};
902
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700903static int __init omap_device_init(void)
904{
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200905 bus_register_notifier(&platform_bus_type, &platform_nb);
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800906 return 0;
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700907}
Tony Lindgren8dd5ea72015-12-03 11:38:09 -0800908omap_postcore_initcall(omap_device_init);
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700909
910/**
911 * omap_device_late_idle - idle devices without drivers
912 * @dev: struct device * associated with omap_device
913 * @data: unused
914 *
915 * Check the driver bound status of this device, and idle it
916 * if there is no driver attached.
917 */
918static int __init omap_device_late_idle(struct device *dev, void *data)
919{
920 struct platform_device *pdev = to_platform_device(dev);
921 struct omap_device *od = to_omap_device(pdev);
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600922 int i;
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700923
924 if (!od)
925 return 0;
926
927 /*
928 * If omap_device state is enabled, but has no driver bound,
929 * idle it.
930 */
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600931
932 /*
933 * Some devices (like memory controllers) are always kept
934 * enabled, and should not be idled even with no drivers.
935 */
936 for (i = 0; i < od->hwmods_cnt; i++)
937 if (od->hwmods[i]->flags & HWMOD_INIT_NO_IDLE)
938 return 0;
939
Grygorii Strashkofe8291e2015-09-01 13:59:24 -0700940 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER &&
941 od->_driver_status != BUS_NOTIFY_BIND_DRIVER) {
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700942 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
943 dev_warn(dev, "%s: enabled but no driver. Idling\n",
944 __func__);
945 omap_device_idle(pdev);
946 }
947 }
948
949 return 0;
950}
951
952static int __init omap_device_late_init(void)
953{
954 bus_for_each_dev(&platform_bus_type, NULL, NULL, omap_device_late_idle);
Tony Lindgren4b91f7f2014-10-27 13:05:54 -0700955
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700956 return 0;
957}
Kevin Hilmane7e17c52013-05-08 16:48:01 -0700958omap_late_initcall_sync(omap_device_late_init);