blob: 72ebc4c16bae7e55a69775b02bfc534b9c56fda4 [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>
Kevin Hilman345f79b2011-05-31 16:08:09 -070035#include <linux/pm_runtime.h>
Benoit Coussondc2d07e2011-08-10 13:32:08 +020036#include <linux/of.h>
37#include <linux/notifier.h>
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030038
Tony Lindgrendad12d12013-12-06 10:52:58 -080039#include "common.h"
Tony Lindgrenb76c8b12013-01-11 11:24:18 -080040#include "soc.h"
Tony Lindgren25c7d492012-10-02 17:25:48 -070041#include "omap_device.h"
Tony Lindgren2a296c82012-10-02 17:41:35 -070042#include "omap_hwmod.h"
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030043
Paul Walmsleyb04b65a2009-09-03 20:14:05 +030044/* Private functions */
45
Benoit Coussonbf1e0772011-07-10 05:54:12 -060046static void _add_clkdev(struct omap_device *od, const char *clk_alias,
47 const char *clk_name)
48{
49 struct clk *r;
Russell King1ca90bd2015-03-02 15:46:03 +000050 int rc;
Benoit Coussonbf1e0772011-07-10 05:54:12 -060051
52 if (!clk_alias || !clk_name)
53 return;
54
Kevin Hilmand66b3fe2011-07-21 13:58:51 -070055 dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060056
Kevin Hilmand66b3fe2011-07-21 13:58:51 -070057 r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060058 if (!IS_ERR(r)) {
Markus Pargmann9a02ae42014-08-25 16:15:34 -070059 dev_dbg(&od->pdev->dev,
Kevin Hilman49882c92011-07-21 09:58:36 -070060 "alias %s already exists\n", clk_alias);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060061 clk_put(r);
62 return;
63 }
64
Russell King1ca90bd2015-03-02 15:46:03 +000065 rc = clk_add_alias(clk_alias, dev_name(&od->pdev->dev), clk_name, NULL);
66 if (rc) {
67 if (rc == -ENODEV || rc == -ENOMEM)
68 dev_err(&od->pdev->dev,
69 "clkdev_alloc for %s failed\n", clk_alias);
70 else
71 dev_err(&od->pdev->dev,
72 "clk_get for %s failed\n", clk_name);
Benoit Coussonbf1e0772011-07-10 05:54:12 -060073 }
Benoit Coussonbf1e0772011-07-10 05:54:12 -060074}
75
Partha Basak4ef7aca2010-09-21 19:23:04 +020076/**
Benoit Coussonbf1e0772011-07-10 05:54:12 -060077 * _add_hwmod_clocks_clkdev - Add clkdev entry for hwmod optional clocks
78 * and main clock
Partha Basak4ef7aca2010-09-21 19:23:04 +020079 * @od: struct omap_device *od
Benoit Coussonbf1e0772011-07-10 05:54:12 -060080 * @oh: struct omap_hwmod *oh
Partha Basak4ef7aca2010-09-21 19:23:04 +020081 *
Benoit Coussonbf1e0772011-07-10 05:54:12 -060082 * For the main clock and every optional clock present per hwmod per
83 * omap_device, this function adds an entry in the clkdev table of the
84 * form <dev-id=dev_name, con-id=role> if it does not exist already.
Partha Basak4ef7aca2010-09-21 19:23:04 +020085 *
86 * The function is called from inside omap_device_build_ss(), after
87 * omap_device_register.
88 *
89 * This allows drivers to get a pointer to its optional clocks based on its role
90 * by calling clk_get(<dev*>, <role>).
Benoit Coussonbf1e0772011-07-10 05:54:12 -060091 * In the case of the main clock, a "fck" alias is used.
Partha Basak4ef7aca2010-09-21 19:23:04 +020092 *
93 * No return value.
94 */
Benoit Coussonbf1e0772011-07-10 05:54:12 -060095static void _add_hwmod_clocks_clkdev(struct omap_device *od,
96 struct omap_hwmod *oh)
Partha Basak4ef7aca2010-09-21 19:23:04 +020097{
98 int i;
99
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600100 _add_clkdev(od, "fck", oh->main_clk);
Partha Basak4ef7aca2010-09-21 19:23:04 +0200101
Benoit Coussonbf1e0772011-07-10 05:54:12 -0600102 for (i = 0; i < oh->opt_clks_cnt; i++)
103 _add_clkdev(od, oh->opt_clks[i].role, oh->opt_clks[i].clk);
Partha Basak4ef7aca2010-09-21 19:23:04 +0200104}
105
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300106
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200107/**
108 * omap_device_build_from_dt - build an omap_device with multiple hwmods
109 * @pdev_name: name of the platform_device driver to use
110 * @pdev_id: this platform_device's connection ID
111 * @oh: ptr to the single omap_hwmod that backs this omap_device
112 * @pdata: platform_data ptr to associate with the platform_device
113 * @pdata_len: amount of memory pointed to by @pdata
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200114 *
115 * Function for building an omap_device already registered from device-tree
116 *
117 * Returns 0 or PTR_ERR() on error.
118 */
119static int omap_device_build_from_dt(struct platform_device *pdev)
120{
121 struct omap_hwmod **hwmods;
122 struct omap_device *od;
123 struct omap_hwmod *oh;
124 struct device_node *node = pdev->dev.of_node;
125 const char *oh_name;
126 int oh_cnt, i, ret = 0;
Rajendra Nayak72680322013-07-28 23:01:51 -0600127 bool device_active = false;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200128
129 oh_cnt = of_property_count_strings(node, "ti,hwmods");
Russell Kingc48cd652013-03-13 20:44:21 +0000130 if (oh_cnt <= 0) {
Benoit Cousson5dc06b72012-01-20 18:14:00 +0100131 dev_dbg(&pdev->dev, "No 'hwmods' to build omap_device\n");
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200132 return -ENODEV;
133 }
134
135 hwmods = kzalloc(sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
136 if (!hwmods) {
137 ret = -ENOMEM;
138 goto odbfd_exit;
139 }
140
141 for (i = 0; i < oh_cnt; i++) {
142 of_property_read_string_index(node, "ti,hwmods", i, &oh_name);
143 oh = omap_hwmod_lookup(oh_name);
144 if (!oh) {
145 dev_err(&pdev->dev, "Cannot lookup hwmod '%s'\n",
146 oh_name);
147 ret = -EINVAL;
148 goto odbfd_exit1;
149 }
150 hwmods[i] = oh;
Rajendra Nayak72680322013-07-28 23:01:51 -0600151 if (oh->flags & HWMOD_INIT_NO_IDLE)
152 device_active = true;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200153 }
154
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700155 od = omap_device_alloc(pdev, hwmods, oh_cnt);
Wei Yongjun4cf9cf82013-09-18 12:01:58 -0700156 if (IS_ERR(od)) {
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200157 dev_err(&pdev->dev, "Cannot allocate omap_device for :%s\n",
158 oh_name);
159 ret = PTR_ERR(od);
160 goto odbfd_exit1;
161 }
162
Peter Ujfalusi3956a1a2012-08-23 16:54:09 +0300163 /* Fix up missing resource names */
164 for (i = 0; i < pdev->num_resources; i++) {
165 struct resource *r = &pdev->resource[i];
166
167 if (r->name == NULL)
168 r->name = dev_name(&pdev->dev);
169 }
170
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200171 pdev->dev.pm_domain = &omap_device_pm_domain;
172
Rajendra Nayak72680322013-07-28 23:01:51 -0600173 if (device_active) {
174 omap_device_enable(pdev);
175 pm_runtime_set_active(&pdev->dev);
176 }
177
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200178odbfd_exit1:
179 kfree(hwmods);
180odbfd_exit:
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600181 /* if data/we are at fault.. load up a fail handler */
182 if (ret)
183 pdev->dev.pm_domain = &omap_device_fail_pm_domain;
184
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200185 return ret;
186}
187
188static int _omap_device_notifier_call(struct notifier_block *nb,
189 unsigned long event, void *dev)
190{
191 struct platform_device *pdev = to_platform_device(dev);
Kevin Hilmane7533452012-07-10 11:13:16 -0700192 struct omap_device *od;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200193
194 switch (event) {
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200195 case BUS_NOTIFY_DEL_DEVICE:
196 if (pdev->archdata.od)
197 omap_device_delete(pdev->archdata.od);
198 break;
Kevin Hilmane7533452012-07-10 11:13:16 -0700199 case BUS_NOTIFY_ADD_DEVICE:
200 if (pdev->dev.of_node)
201 omap_device_build_from_dt(pdev);
Tony Lindgrendad12d12013-12-06 10:52:58 -0800202 omap_auxdata_legacy_init(dev);
Kevin Hilmane7533452012-07-10 11:13:16 -0700203 /* fall through */
204 default:
205 od = to_omap_device(pdev);
206 if (od)
207 od->_driver_status = event;
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200208 }
209
210 return NOTIFY_DONE;
211}
212
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700213/**
214 * _omap_device_enable_hwmods - call omap_hwmod_enable() on all hwmods
215 * @od: struct omap_device *od
216 *
217 * Enable all underlying hwmods. Returns 0.
218 */
219static int _omap_device_enable_hwmods(struct omap_device *od)
220{
Pali Rohár6da23352015-02-26 14:49:51 +0100221 int ret = 0;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700222 int i;
223
224 for (i = 0; i < od->hwmods_cnt; i++)
Pali Rohár6da23352015-02-26 14:49:51 +0100225 ret |= omap_hwmod_enable(od->hwmods[i]);
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700226
Pali Rohár6da23352015-02-26 14:49:51 +0100227 return ret;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700228}
229
230/**
231 * _omap_device_idle_hwmods - call omap_hwmod_idle() on all hwmods
232 * @od: struct omap_device *od
233 *
234 * Idle all underlying hwmods. Returns 0.
235 */
236static int _omap_device_idle_hwmods(struct omap_device *od)
237{
Pali Rohár6da23352015-02-26 14:49:51 +0100238 int ret = 0;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700239 int i;
240
241 for (i = 0; i < od->hwmods_cnt; i++)
Pali Rohár6da23352015-02-26 14:49:51 +0100242 ret |= omap_hwmod_idle(od->hwmods[i]);
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700243
Pali Rohár6da23352015-02-26 14:49:51 +0100244 return ret;
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700245}
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200246
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300247/* Public functions for use by core code */
248
249/**
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700250 * omap_device_get_context_loss_count - get lost context count
251 * @od: struct omap_device *
252 *
253 * Using the primary hwmod, query the context loss count for this
254 * device.
255 *
256 * Callers should consider context for this device lost any time this
257 * function returns a value different than the value the caller got
258 * the last time it called this function.
259 *
260 * If any hwmods exist for the omap_device assoiated with @pdev,
261 * return the context loss counter for that hwmod, otherwise return
262 * zero.
263 */
Tomi Valkeinenfc013872011-06-09 16:56:23 +0300264int omap_device_get_context_loss_count(struct platform_device *pdev)
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700265{
266 struct omap_device *od;
267 u32 ret = 0;
268
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600269 od = to_omap_device(pdev);
Kevin Hilmanc80705a2010-12-21 21:31:55 -0700270
271 if (od->hwmods_cnt)
272 ret = omap_hwmod_get_context_loss_count(od->hwmods[0]);
273
274 return ret;
275}
276
277/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300278 * omap_device_count_resources - count number of struct resource entries needed
279 * @od: struct omap_device *
Peter Ujfalusidad41912012-11-21 16:15:17 -0700280 * @flags: Type of resources to include when counting (IRQ/DMA/MEM)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300281 *
282 * Count the number of struct resource entries needed for this
283 * omap_device @od. Used by omap_device_build_ss() to determine how
284 * much memory to allocate before calling
285 * omap_device_fill_resources(). Returns the count.
286 */
Peter Ujfalusidad41912012-11-21 16:15:17 -0700287static int omap_device_count_resources(struct omap_device *od,
288 unsigned long flags)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300289{
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300290 int c = 0;
291 int i;
292
Kishon Vijay Abraham If39f4892010-09-24 10:23:18 -0600293 for (i = 0; i < od->hwmods_cnt; i++)
Peter Ujfalusidad41912012-11-21 16:15:17 -0700294 c += omap_hwmod_count_resources(od->hwmods[i], flags);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300295
Paul Walmsley7852ec02012-07-26 00:54:26 -0600296 pr_debug("omap_device: %s: counted %d total resources across %d hwmods\n",
297 od->pdev->name, c, od->hwmods_cnt);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300298
299 return c;
300}
301
302/**
303 * omap_device_fill_resources - fill in array of struct resource
304 * @od: struct omap_device *
305 * @res: pointer to an array of struct resource to be filled in
306 *
307 * Populate one or more empty struct resource pointed to by @res with
308 * the resource data for this omap_device @od. Used by
309 * omap_device_build_ss() after calling omap_device_count_resources().
310 * Ideally this function would not be needed at all. If omap_device
311 * replaces platform_device, then we can specify our own
312 * get_resource()/ get_irq()/etc functions that use the underlying
313 * omap_hwmod information. Or if platform_device is extended to use
314 * subarchitecture-specific function pointers, the various
315 * platform_device functions can simply call omap_device internal
316 * functions to get device resources. Hacking around the existing
317 * platform_device code wastes memory. Returns 0.
318 */
Kevin Hilmana2a28ad2011-07-21 14:14:35 -0700319static int omap_device_fill_resources(struct omap_device *od,
320 struct resource *res)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300321{
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300322 int i, r;
323
Kishon Vijay Abraham If39f4892010-09-24 10:23:18 -0600324 for (i = 0; i < od->hwmods_cnt; i++) {
325 r = omap_hwmod_fill_resources(od->hwmods[i], res);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300326 res += r;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300327 }
328
329 return 0;
330}
331
332/**
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530333 * _od_fill_dma_resources - fill in array of struct resource with dma resources
334 * @od: struct omap_device *
335 * @res: pointer to an array of struct resource to be filled in
336 *
337 * Populate one or more empty struct resource pointed to by @res with
338 * the dma resource data for this omap_device @od. Used by
339 * omap_device_alloc() after calling omap_device_count_resources().
340 *
341 * Ideally this function would not be needed at all. If we have
342 * mechanism to get dma resources from DT.
343 *
344 * Returns 0.
345 */
346static int _od_fill_dma_resources(struct omap_device *od,
347 struct resource *res)
348{
349 int i, r;
350
351 for (i = 0; i < od->hwmods_cnt; i++) {
352 r = omap_hwmod_fill_dma_resources(od->hwmods[i], res);
353 res += r;
354 }
355
356 return 0;
357}
358
359/**
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200360 * omap_device_alloc - allocate an omap_device
361 * @pdev: platform_device that will be included in this omap_device
362 * @oh: ptr to the single omap_hwmod that backs this omap_device
363 * @pdata: platform_data ptr to associate with the platform_device
364 * @pdata_len: amount of memory pointed to by @pdata
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200365 *
366 * Convenience function for allocating an omap_device structure and filling
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700367 * hwmods, and resources.
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200368 *
369 * Returns an struct omap_device pointer or ERR_PTR() on error;
370 */
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800371struct omap_device *omap_device_alloc(struct platform_device *pdev,
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700372 struct omap_hwmod **ohs, int oh_cnt)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200373{
374 int ret = -ENOMEM;
375 struct omap_device *od;
376 struct resource *res = NULL;
377 int i, res_count;
378 struct omap_hwmod **hwmods;
379
380 od = kzalloc(sizeof(struct omap_device), GFP_KERNEL);
381 if (!od) {
382 ret = -ENOMEM;
383 goto oda_exit1;
384 }
385 od->hwmods_cnt = oh_cnt;
386
387 hwmods = kmemdup(ohs, sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
388 if (!hwmods)
389 goto oda_exit2;
390
391 od->hwmods = hwmods;
392 od->pdev = pdev;
393
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530394 /*
Peter Ujfalusic567b052012-11-21 16:15:18 -0700395 * Non-DT Boot:
396 * Here, pdev->num_resources = 0, and we should get all the
397 * resources from hwmod.
398 *
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530399 * DT Boot:
400 * OF framework will construct the resource structure (currently
401 * does for MEM & IRQ resource) and we should respect/use these
402 * resources, killing hwmod dependency.
403 * If pdev->num_resources > 0, we assume that MEM & IRQ resources
404 * have been allocated by OF layer already (through DTB).
Peter Ujfalusic567b052012-11-21 16:15:18 -0700405 * As preparation for the future we examine the OF provided resources
406 * to see if we have DMA resources provided already. In this case
407 * there is no need to update the resources for the device, we use the
408 * OF provided ones.
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530409 *
410 * TODO: Once DMA resource is available from OF layer, we should
411 * kill filling any resources from hwmod.
412 */
Peter Ujfalusic567b052012-11-21 16:15:18 -0700413 if (!pdev->num_resources) {
414 /* Count all resources for the device */
415 res_count = omap_device_count_resources(od, IORESOURCE_IRQ |
416 IORESOURCE_DMA |
417 IORESOURCE_MEM);
418 } else {
419 /* Take a look if we already have DMA resource via DT */
420 for (i = 0; i < pdev->num_resources; i++) {
421 struct resource *r = &pdev->resource[i];
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200422
Peter Ujfalusic567b052012-11-21 16:15:18 -0700423 /* We have it, no need to touch the resources */
424 if (r->flags == IORESOURCE_DMA)
425 goto have_everything;
Vaibhav Hiremathb82b04e2012-08-29 15:18:11 +0530426 }
Peter Ujfalusic567b052012-11-21 16:15:18 -0700427 /* Count only DMA resources for the device */
428 res_count = omap_device_count_resources(od, IORESOURCE_DMA);
429 /* The device has no DMA resource, no need for update */
430 if (!res_count)
431 goto have_everything;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200432
Peter Ujfalusic567b052012-11-21 16:15:18 -0700433 res_count += pdev->num_resources;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200434 }
435
Peter Ujfalusic567b052012-11-21 16:15:18 -0700436 /* Allocate resources memory to account for new resources */
437 res = kzalloc(sizeof(struct resource) * res_count, GFP_KERNEL);
438 if (!res)
439 goto oda_exit3;
440
441 if (!pdev->num_resources) {
442 dev_dbg(&pdev->dev, "%s: using %d resources from hwmod\n",
443 __func__, res_count);
444 omap_device_fill_resources(od, res);
445 } else {
446 dev_dbg(&pdev->dev,
447 "%s: appending %d DMA resources from hwmod\n",
448 __func__, res_count - pdev->num_resources);
449 memcpy(res, pdev->resource,
450 sizeof(struct resource) * pdev->num_resources);
451 _od_fill_dma_resources(od, &res[pdev->num_resources]);
452 }
453
454 ret = platform_device_add_resources(pdev, res, res_count);
455 kfree(res);
456
457 if (ret)
458 goto oda_exit3;
459
460have_everything:
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200461 pdev->archdata.od = od;
462
463 for (i = 0; i < oh_cnt; i++) {
464 hwmods[i]->od = od;
465 _add_hwmod_clocks_clkdev(od, hwmods[i]);
466 }
467
468 return od;
469
470oda_exit3:
471 kfree(hwmods);
472oda_exit2:
473 kfree(od);
474oda_exit1:
475 dev_err(&pdev->dev, "omap_device: build failed (%d)\n", ret);
476
477 return ERR_PTR(ret);
478}
479
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800480void omap_device_delete(struct omap_device *od)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200481{
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200482 if (!od)
483 return;
484
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200485 od->pdev->archdata.od = NULL;
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200486 kfree(od->hwmods);
487 kfree(od);
488}
489
490/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300491 * omap_device_build - build and register an omap_device with one omap_hwmod
492 * @pdev_name: name of the platform_device driver to use
493 * @pdev_id: this platform_device's connection ID
494 * @oh: ptr to the single omap_hwmod that backs this omap_device
495 * @pdata: platform_data ptr to associate with the platform_device
496 * @pdata_len: amount of memory pointed to by @pdata
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300497 *
498 * Convenience function for building and registering a single
499 * omap_device record, which in turn builds and registers a
500 * platform_device record. See omap_device_build_ss() for more
501 * information. Returns ERR_PTR(-EINVAL) if @oh is NULL; otherwise,
502 * passes along the return value of omap_device_build_ss().
503 */
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700504struct platform_device __init *omap_device_build(const char *pdev_name,
505 int pdev_id,
506 struct omap_hwmod *oh,
507 void *pdata, int pdata_len)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300508{
509 struct omap_hwmod *ohs[] = { oh };
510
511 if (!oh)
512 return ERR_PTR(-EINVAL);
513
514 return omap_device_build_ss(pdev_name, pdev_id, ohs, 1, pdata,
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700515 pdata_len);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300516}
517
518/**
519 * omap_device_build_ss - build and register an omap_device with multiple hwmods
520 * @pdev_name: name of the platform_device driver to use
521 * @pdev_id: this platform_device's connection ID
522 * @oh: ptr to the single omap_hwmod that backs this omap_device
523 * @pdata: platform_data ptr to associate with the platform_device
524 * @pdata_len: amount of memory pointed to by @pdata
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300525 *
526 * Convenience function for building and registering an omap_device
527 * subsystem record. Subsystem records consist of multiple
528 * omap_hwmods. This function in turn builds and registers a
529 * platform_device record. Returns an ERR_PTR() on error, or passes
530 * along the return value of omap_device_register().
531 */
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700532struct platform_device __init *omap_device_build_ss(const char *pdev_name,
533 int pdev_id,
534 struct omap_hwmod **ohs,
535 int oh_cnt, void *pdata,
536 int pdata_len)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300537{
538 int ret = -ENOMEM;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700539 struct platform_device *pdev;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300540 struct omap_device *od;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300541
542 if (!ohs || oh_cnt == 0 || !pdev_name)
543 return ERR_PTR(-EINVAL);
544
545 if (!pdata && pdata_len > 0)
546 return ERR_PTR(-EINVAL);
547
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700548 pdev = platform_device_alloc(pdev_name, pdev_id);
549 if (!pdev) {
550 ret = -ENOMEM;
551 goto odbs_exit;
552 }
553
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200554 /* Set the dev_name early to allow dev_xxx in omap_device_alloc */
555 if (pdev->id != -1)
556 dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
557 else
558 dev_set_name(&pdev->dev, "%s", pdev->name);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300559
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700560 od = omap_device_alloc(pdev, ohs, oh_cnt);
Wei Yongjuna87e6622012-09-21 14:32:04 +0800561 if (IS_ERR(od))
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700562 goto odbs_exit1;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300563
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700564 ret = platform_device_add_data(pdev, pdata, pdata_len);
Artem Bityutskiy49b368a2010-07-12 13:38:07 +0000565 if (ret)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200566 goto odbs_exit2;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700567
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700568 ret = omap_device_register(pdev);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700569 if (ret)
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200570 goto odbs_exit2;
Kevin Hilman06563582010-07-26 16:34:30 -0600571
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700572 return pdev;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300573
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700574odbs_exit2:
Benoit Coussona4f6cdb2011-08-09 16:47:01 +0200575 omap_device_delete(od);
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700576odbs_exit1:
577 platform_device_put(pdev);
578odbs_exit:
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300579
580 pr_err("omap_device: %s: build failed (%d)\n", pdev_name, ret);
581
582 return ERR_PTR(ret);
583}
584
Rafael J. Wysockibf7c5442014-12-13 00:42:49 +0100585#ifdef CONFIG_PM
Kevin Hilman638080c2011-04-29 00:36:42 +0200586static int _od_runtime_suspend(struct device *dev)
587{
588 struct platform_device *pdev = to_platform_device(dev);
Kevin Hilman345f79b2011-05-31 16:08:09 -0700589 int ret;
Kevin Hilman638080c2011-04-29 00:36:42 +0200590
Kevin Hilman345f79b2011-05-31 16:08:09 -0700591 ret = pm_generic_runtime_suspend(dev);
Pali Rohár6da23352015-02-26 14:49:51 +0100592 if (ret)
593 return ret;
Kevin Hilman345f79b2011-05-31 16:08:09 -0700594
Pali Rohár6da23352015-02-26 14:49:51 +0100595 return omap_device_idle(pdev);
Kevin Hilman345f79b2011-05-31 16:08:09 -0700596}
597
Kevin Hilman638080c2011-04-29 00:36:42 +0200598static int _od_runtime_resume(struct device *dev)
599{
600 struct platform_device *pdev = to_platform_device(dev);
Pali Rohár6da23352015-02-26 14:49:51 +0100601 int ret;
Kevin Hilman638080c2011-04-29 00:36:42 +0200602
Pali Rohár6da23352015-02-26 14:49:51 +0100603 ret = omap_device_enable(pdev);
604 if (ret)
605 return ret;
Kevin Hilman345f79b2011-05-31 16:08:09 -0700606
607 return pm_generic_runtime_resume(dev);
Kevin Hilman638080c2011-04-29 00:36:42 +0200608}
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600609
610static int _od_fail_runtime_suspend(struct device *dev)
611{
612 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
613 return -ENODEV;
614}
615
616static int _od_fail_runtime_resume(struct device *dev)
617{
618 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
619 return -ENODEV;
620}
621
Kevin Hilman256a5432011-07-12 22:48:03 +0200622#endif
Kevin Hilman638080c2011-04-29 00:36:42 +0200623
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200624#ifdef CONFIG_SUSPEND
625static int _od_suspend_noirq(struct device *dev)
626{
627 struct platform_device *pdev = to_platform_device(dev);
628 struct omap_device *od = to_omap_device(pdev);
629 int ret;
630
Kevin Hilman72bb6f92012-07-10 15:29:04 -0700631 /* Don't attempt late suspend on a driver that is not bound */
632 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER)
633 return 0;
634
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200635 ret = pm_generic_suspend_noirq(dev);
636
637 if (!ret && !pm_runtime_status_suspended(dev)) {
638 if (pm_generic_runtime_suspend(dev) == 0) {
Nishanth Menon3522bf72013-11-14 11:05:16 -0600639 pm_runtime_set_suspended(dev);
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530640 omap_device_idle(pdev);
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200641 od->flags |= OMAP_DEVICE_SUSPENDED;
642 }
643 }
644
645 return ret;
646}
647
648static int _od_resume_noirq(struct device *dev)
649{
650 struct platform_device *pdev = to_platform_device(dev);
651 struct omap_device *od = to_omap_device(pdev);
652
Nishanth Menon3522bf72013-11-14 11:05:16 -0600653 if (od->flags & OMAP_DEVICE_SUSPENDED) {
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200654 od->flags &= ~OMAP_DEVICE_SUSPENDED;
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530655 omap_device_enable(pdev);
Nishanth Menon3522bf72013-11-14 11:05:16 -0600656 /*
657 * XXX: we run before core runtime pm has resumed itself. At
658 * this point in time, we just restore the runtime pm state and
659 * considering symmetric operations in resume, we donot expect
660 * to fail. If we failed, something changed in core runtime_pm
661 * framework OR some device driver messed things up, hence, WARN
662 */
663 WARN(pm_runtime_set_active(dev),
664 "Could not set %s runtime state active\n", dev_name(dev));
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200665 pm_generic_runtime_resume(dev);
666 }
667
668 return pm_generic_resume_noirq(dev);
669}
Kevin Hilman126caf12011-09-01 10:59:36 -0700670#else
671#define _od_suspend_noirq NULL
672#define _od_resume_noirq NULL
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200673#endif
674
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600675struct dev_pm_domain omap_device_fail_pm_domain = {
676 .ops = {
677 SET_RUNTIME_PM_OPS(_od_fail_runtime_suspend,
678 _od_fail_runtime_resume, NULL)
679 }
680};
681
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800682struct dev_pm_domain omap_device_pm_domain = {
Kevin Hilman638080c2011-04-29 00:36:42 +0200683 .ops = {
Kevin Hilman256a5432011-07-12 22:48:03 +0200684 SET_RUNTIME_PM_OPS(_od_runtime_suspend, _od_runtime_resume,
Rafael J. Wysocki45f0a852013-06-03 21:49:52 +0200685 NULL)
Kevin Hilman638080c2011-04-29 00:36:42 +0200686 USE_PLATFORM_PM_SLEEP_OPS
Grygorii Strashkoc381f222015-04-27 21:24:32 +0300687 SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(_od_suspend_noirq,
688 _od_resume_noirq)
Kevin Hilman638080c2011-04-29 00:36:42 +0200689 }
690};
691
Thara Gopinathc23a97d2010-02-24 12:05:58 -0700692/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300693 * omap_device_register - register an omap_device with one omap_hwmod
694 * @od: struct omap_device * to register
695 *
696 * Register the omap_device structure. This currently just calls
697 * platform_device_register() on the underlying platform_device.
698 * Returns the return value of platform_device_register().
699 */
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800700int omap_device_register(struct platform_device *pdev)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300701{
Kevin Hilmanbfae4f82011-07-21 14:47:53 -0700702 pr_debug("omap_device: %s: registering\n", pdev->name);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300703
Kevin Hilmanbfae4f82011-07-21 14:47:53 -0700704 pdev->dev.pm_domain = &omap_device_pm_domain;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700705 return platform_device_add(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300706}
707
708
709/* Public functions for use by device drivers through struct platform_data */
710
711/**
712 * omap_device_enable - fully activate an omap_device
713 * @od: struct omap_device * to activate
714 *
715 * Do whatever is necessary for the hwmods underlying omap_device @od
716 * to be accessible and ready to operate. This generally involves
717 * enabling clocks, setting SYSCONFIG registers; and in the future may
718 * involve remuxing pins. Device drivers should call this function
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700719 * indirectly via pm_runtime_get*(). Returns -EINVAL if called when
720 * the omap_device is already enabled, or passes along the return
721 * value of _omap_device_enable_hwmods().
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300722 */
723int omap_device_enable(struct platform_device *pdev)
724{
725 int ret;
726 struct omap_device *od;
727
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600728 od = to_omap_device(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300729
730 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
Kevin Hilman49882c92011-07-21 09:58:36 -0700731 dev_warn(&pdev->dev,
732 "omap_device: %s() called from invalid state %d\n",
733 __func__, od->_state);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300734 return -EINVAL;
735 }
736
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700737 ret = _omap_device_enable_hwmods(od);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300738
Pali Rohár6da23352015-02-26 14:49:51 +0100739 if (ret == 0)
740 od->_state = OMAP_DEVICE_STATE_ENABLED;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300741
742 return ret;
743}
744
745/**
746 * omap_device_idle - idle an omap_device
747 * @od: struct omap_device * to idle
748 *
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700749 * Idle omap_device @od. Device drivers call this function indirectly
750 * via pm_runtime_put*(). Returns -EINVAL if the omap_device is not
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300751 * currently enabled, or passes along the return value of
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700752 * _omap_device_idle_hwmods().
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300753 */
754int omap_device_idle(struct platform_device *pdev)
755{
756 int ret;
757 struct omap_device *od;
758
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600759 od = to_omap_device(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300760
761 if (od->_state != OMAP_DEVICE_STATE_ENABLED) {
Kevin Hilman49882c92011-07-21 09:58:36 -0700762 dev_warn(&pdev->dev,
763 "omap_device: %s() called from invalid state %d\n",
764 __func__, od->_state);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300765 return -EINVAL;
766 }
767
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700768 ret = _omap_device_idle_hwmods(od);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300769
Pali Rohár6da23352015-02-26 14:49:51 +0100770 if (ret == 0)
771 od->_state = OMAP_DEVICE_STATE_IDLE;
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300772
773 return ret;
774}
775
776/**
Omar Ramirez Luna8bb9fde2012-09-23 17:28:18 -0600777 * omap_device_assert_hardreset - set a device's hardreset line
778 * @pdev: struct platform_device * to reset
779 * @name: const char * name of the reset line
780 *
781 * Set the hardreset line identified by @name on the IP blocks
782 * associated with the hwmods backing the platform_device @pdev. All
783 * of the hwmods associated with @pdev must have the same hardreset
784 * line linked to them for this to work. Passes along the return value
785 * of omap_hwmod_assert_hardreset() in the event of any failure, or
786 * returns 0 upon success.
787 */
788int omap_device_assert_hardreset(struct platform_device *pdev, const char *name)
789{
790 struct omap_device *od = to_omap_device(pdev);
791 int ret = 0;
792 int i;
793
794 for (i = 0; i < od->hwmods_cnt; i++) {
795 ret = omap_hwmod_assert_hardreset(od->hwmods[i], name);
796 if (ret)
797 break;
798 }
799
800 return ret;
801}
802
803/**
804 * omap_device_deassert_hardreset - release a device's hardreset line
805 * @pdev: struct platform_device * to reset
806 * @name: const char * name of the reset line
807 *
808 * Release the hardreset line identified by @name on the IP blocks
809 * associated with the hwmods backing the platform_device @pdev. All
810 * of the hwmods associated with @pdev must have the same hardreset
811 * line linked to them for this to work. Passes along the return
812 * value of omap_hwmod_deassert_hardreset() in the event of any
813 * failure, or returns 0 upon success.
814 */
815int omap_device_deassert_hardreset(struct platform_device *pdev,
816 const char *name)
817{
818 struct omap_device *od = to_omap_device(pdev);
819 int ret = 0;
820 int i;
821
822 for (i = 0; i < od->hwmods_cnt; i++) {
823 ret = omap_hwmod_deassert_hardreset(od->hwmods[i], name);
824 if (ret)
825 break;
826 }
827
828 return ret;
829}
830
831/**
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500832 * omap_device_get_by_hwmod_name() - convert a hwmod name to
833 * device pointer.
834 * @oh_name: name of the hwmod device
835 *
836 * Returns back a struct device * pointer associated with a hwmod
837 * device represented by a hwmod_name
838 */
839struct device *omap_device_get_by_hwmod_name(const char *oh_name)
840{
841 struct omap_hwmod *oh;
842
843 if (!oh_name) {
844 WARN(1, "%s: no hwmod name!\n", __func__);
845 return ERR_PTR(-EINVAL);
846 }
847
848 oh = omap_hwmod_lookup(oh_name);
Russell King857835c2013-02-24 10:56:59 +0000849 if (!oh) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500850 WARN(1, "%s: no hwmod for %s\n", __func__,
851 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000852 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500853 }
Russell King857835c2013-02-24 10:56:59 +0000854 if (!oh->od) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500855 WARN(1, "%s: no omap_device for %s\n", __func__,
856 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000857 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500858 }
859
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500860 return &oh->od->pdev->dev;
861}
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700862
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200863static struct notifier_block platform_nb = {
864 .notifier_call = _omap_device_notifier_call,
865};
866
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700867static int __init omap_device_init(void)
868{
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200869 bus_register_notifier(&platform_bus_type, &platform_nb);
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800870 return 0;
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700871}
Tony Lindgrenb76c8b12013-01-11 11:24:18 -0800872omap_core_initcall(omap_device_init);
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700873
874/**
875 * omap_device_late_idle - idle devices without drivers
876 * @dev: struct device * associated with omap_device
877 * @data: unused
878 *
879 * Check the driver bound status of this device, and idle it
880 * if there is no driver attached.
881 */
882static int __init omap_device_late_idle(struct device *dev, void *data)
883{
884 struct platform_device *pdev = to_platform_device(dev);
885 struct omap_device *od = to_omap_device(pdev);
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600886 int i;
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700887
888 if (!od)
889 return 0;
890
891 /*
892 * If omap_device state is enabled, but has no driver bound,
893 * idle it.
894 */
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600895
896 /*
897 * Some devices (like memory controllers) are always kept
898 * enabled, and should not be idled even with no drivers.
899 */
900 for (i = 0; i < od->hwmods_cnt; i++)
901 if (od->hwmods[i]->flags & HWMOD_INIT_NO_IDLE)
902 return 0;
903
Grygorii Strashkofe8291e2015-09-01 13:59:24 -0700904 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER &&
905 od->_driver_status != BUS_NOTIFY_BIND_DRIVER) {
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700906 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
907 dev_warn(dev, "%s: enabled but no driver. Idling\n",
908 __func__);
909 omap_device_idle(pdev);
910 }
911 }
912
913 return 0;
914}
915
916static int __init omap_device_late_init(void)
917{
918 bus_for_each_dev(&platform_bus_type, NULL, NULL, omap_device_late_idle);
Tony Lindgren4b91f7f2014-10-27 13:05:54 -0700919
920 WARN(!of_have_populated_dt(),
921 "legacy booting deprecated, please update to boot with .dts\n");
922
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700923 return 0;
924}
Kevin Hilmane7e17c52013-05-08 16:48:01 -0700925omap_late_initcall_sync(omap_device_late_init);