blob: 02da3655d288d769b734f453fb92329ef9511a3d [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{
221 int i;
222
223 for (i = 0; i < od->hwmods_cnt; i++)
224 omap_hwmod_enable(od->hwmods[i]);
225
226 /* XXX pass along return value here? */
227 return 0;
228}
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{
238 int i;
239
240 for (i = 0; i < od->hwmods_cnt; i++)
241 omap_hwmod_idle(od->hwmods[i]);
242
243 /* XXX pass along return value here? */
244 return 0;
245}
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);
592
593 if (!ret)
594 omap_device_idle(pdev);
595
596 return ret;
597}
598
Kevin Hilman638080c2011-04-29 00:36:42 +0200599static int _od_runtime_resume(struct device *dev)
600{
601 struct platform_device *pdev = to_platform_device(dev);
602
Kevin Hilman345f79b2011-05-31 16:08:09 -0700603 omap_device_enable(pdev);
604
605 return pm_generic_runtime_resume(dev);
Kevin Hilman638080c2011-04-29 00:36:42 +0200606}
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600607
608static int _od_fail_runtime_suspend(struct device *dev)
609{
610 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
611 return -ENODEV;
612}
613
614static int _od_fail_runtime_resume(struct device *dev)
615{
616 dev_warn(dev, "%s: FIXME: missing hwmod/omap_dev info\n", __func__);
617 return -ENODEV;
618}
619
Kevin Hilman256a5432011-07-12 22:48:03 +0200620#endif
Kevin Hilman638080c2011-04-29 00:36:42 +0200621
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200622#ifdef CONFIG_SUSPEND
623static int _od_suspend_noirq(struct device *dev)
624{
625 struct platform_device *pdev = to_platform_device(dev);
626 struct omap_device *od = to_omap_device(pdev);
627 int ret;
628
Kevin Hilman72bb6f92012-07-10 15:29:04 -0700629 /* Don't attempt late suspend on a driver that is not bound */
630 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER)
631 return 0;
632
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200633 ret = pm_generic_suspend_noirq(dev);
634
635 if (!ret && !pm_runtime_status_suspended(dev)) {
636 if (pm_generic_runtime_suspend(dev) == 0) {
Nishanth Menon3522bf72013-11-14 11:05:16 -0600637 pm_runtime_set_suspended(dev);
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530638 omap_device_idle(pdev);
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200639 od->flags |= OMAP_DEVICE_SUSPENDED;
640 }
641 }
642
643 return ret;
644}
645
646static int _od_resume_noirq(struct device *dev)
647{
648 struct platform_device *pdev = to_platform_device(dev);
649 struct omap_device *od = to_omap_device(pdev);
650
Nishanth Menon3522bf72013-11-14 11:05:16 -0600651 if (od->flags & OMAP_DEVICE_SUSPENDED) {
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200652 od->flags &= ~OMAP_DEVICE_SUSPENDED;
Sourav Poddar4b7ec5a2013-04-27 01:55:34 +0530653 omap_device_enable(pdev);
Nishanth Menon3522bf72013-11-14 11:05:16 -0600654 /*
655 * XXX: we run before core runtime pm has resumed itself. At
656 * this point in time, we just restore the runtime pm state and
657 * considering symmetric operations in resume, we donot expect
658 * to fail. If we failed, something changed in core runtime_pm
659 * framework OR some device driver messed things up, hence, WARN
660 */
661 WARN(pm_runtime_set_active(dev),
662 "Could not set %s runtime state active\n", dev_name(dev));
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200663 pm_generic_runtime_resume(dev);
664 }
665
666 return pm_generic_resume_noirq(dev);
667}
Kevin Hilman126caf12011-09-01 10:59:36 -0700668#else
669#define _od_suspend_noirq NULL
670#define _od_resume_noirq NULL
Kevin Hilmanc03f0072011-07-12 22:48:19 +0200671#endif
672
Nishanth Menonf5c33b02013-12-03 19:39:13 -0600673struct dev_pm_domain omap_device_fail_pm_domain = {
674 .ops = {
675 SET_RUNTIME_PM_OPS(_od_fail_runtime_suspend,
676 _od_fail_runtime_resume, NULL)
677 }
678};
679
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800680struct dev_pm_domain omap_device_pm_domain = {
Kevin Hilman638080c2011-04-29 00:36:42 +0200681 .ops = {
Kevin Hilman256a5432011-07-12 22:48:03 +0200682 SET_RUNTIME_PM_OPS(_od_runtime_suspend, _od_runtime_resume,
Rafael J. Wysocki45f0a852013-06-03 21:49:52 +0200683 NULL)
Kevin Hilman638080c2011-04-29 00:36:42 +0200684 USE_PLATFORM_PM_SLEEP_OPS
Kevin Hilmanff353362011-08-25 15:31:14 +0200685 .suspend_noirq = _od_suspend_noirq,
686 .resume_noirq = _od_resume_noirq,
Grygorii Strashko62480152015-02-25 16:13:50 +0200687 .freeze_noirq = _od_suspend_noirq,
688 .thaw_noirq = _od_resume_noirq,
689 .restore_noirq = _od_resume_noirq,
Kevin Hilman638080c2011-04-29 00:36:42 +0200690 }
691};
692
Thara Gopinathc23a97d2010-02-24 12:05:58 -0700693/**
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300694 * omap_device_register - register an omap_device with one omap_hwmod
695 * @od: struct omap_device * to register
696 *
697 * Register the omap_device structure. This currently just calls
698 * platform_device_register() on the underlying platform_device.
699 * Returns the return value of platform_device_register().
700 */
Ohad Ben-Cohen993e4fb2012-02-20 09:43:29 -0800701int omap_device_register(struct platform_device *pdev)
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300702{
Kevin Hilmanbfae4f82011-07-21 14:47:53 -0700703 pr_debug("omap_device: %s: registering\n", pdev->name);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300704
Kevin Hilmanbfae4f82011-07-21 14:47:53 -0700705 pdev->dev.pm_domain = &omap_device_pm_domain;
Kevin Hilmand66b3fe2011-07-21 13:58:51 -0700706 return platform_device_add(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300707}
708
709
710/* Public functions for use by device drivers through struct platform_data */
711
712/**
713 * omap_device_enable - fully activate an omap_device
714 * @od: struct omap_device * to activate
715 *
716 * Do whatever is necessary for the hwmods underlying omap_device @od
717 * to be accessible and ready to operate. This generally involves
718 * enabling clocks, setting SYSCONFIG registers; and in the future may
719 * involve remuxing pins. Device drivers should call this function
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700720 * indirectly via pm_runtime_get*(). Returns -EINVAL if called when
721 * the omap_device is already enabled, or passes along the return
722 * value of _omap_device_enable_hwmods().
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300723 */
724int omap_device_enable(struct platform_device *pdev)
725{
726 int ret;
727 struct omap_device *od;
728
Kevin Hilman8f0d69d2011-07-09 19:15:20 -0600729 od = to_omap_device(pdev);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300730
731 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
Kevin Hilman49882c92011-07-21 09:58:36 -0700732 dev_warn(&pdev->dev,
733 "omap_device: %s() called from invalid state %d\n",
734 __func__, od->_state);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300735 return -EINVAL;
736 }
737
Paul Walmsleyc1d1cd52013-01-26 00:48:53 -0700738 ret = _omap_device_enable_hwmods(od);
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300739
Paul Walmsleyb04b65a2009-09-03 20:14:05 +0300740 od->_state = OMAP_DEVICE_STATE_ENABLED;
741
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
770 od->_state = OMAP_DEVICE_STATE_IDLE;
771
772 return ret;
773}
774
775/**
Omar Ramirez Luna8bb9fde2012-09-23 17:28:18 -0600776 * omap_device_assert_hardreset - set a device's hardreset line
777 * @pdev: struct platform_device * to reset
778 * @name: const char * name of the reset line
779 *
780 * Set the hardreset line identified by @name on the IP blocks
781 * associated with the hwmods backing the platform_device @pdev. All
782 * of the hwmods associated with @pdev must have the same hardreset
783 * line linked to them for this to work. Passes along the return value
784 * of omap_hwmod_assert_hardreset() in the event of any failure, or
785 * returns 0 upon success.
786 */
787int omap_device_assert_hardreset(struct platform_device *pdev, const char *name)
788{
789 struct omap_device *od = to_omap_device(pdev);
790 int ret = 0;
791 int i;
792
793 for (i = 0; i < od->hwmods_cnt; i++) {
794 ret = omap_hwmod_assert_hardreset(od->hwmods[i], name);
795 if (ret)
796 break;
797 }
798
799 return ret;
800}
801
802/**
803 * omap_device_deassert_hardreset - release a device's hardreset line
804 * @pdev: struct platform_device * to reset
805 * @name: const char * name of the reset line
806 *
807 * Release the hardreset line identified by @name on the IP blocks
808 * associated with the hwmods backing the platform_device @pdev. All
809 * of the hwmods associated with @pdev must have the same hardreset
810 * line linked to them for this to work. Passes along the return
811 * value of omap_hwmod_deassert_hardreset() in the event of any
812 * failure, or returns 0 upon success.
813 */
814int omap_device_deassert_hardreset(struct platform_device *pdev,
815 const char *name)
816{
817 struct omap_device *od = to_omap_device(pdev);
818 int ret = 0;
819 int i;
820
821 for (i = 0; i < od->hwmods_cnt; i++) {
822 ret = omap_hwmod_deassert_hardreset(od->hwmods[i], name);
823 if (ret)
824 break;
825 }
826
827 return ret;
828}
829
830/**
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500831 * omap_device_get_by_hwmod_name() - convert a hwmod name to
832 * device pointer.
833 * @oh_name: name of the hwmod device
834 *
835 * Returns back a struct device * pointer associated with a hwmod
836 * device represented by a hwmod_name
837 */
838struct device *omap_device_get_by_hwmod_name(const char *oh_name)
839{
840 struct omap_hwmod *oh;
841
842 if (!oh_name) {
843 WARN(1, "%s: no hwmod name!\n", __func__);
844 return ERR_PTR(-EINVAL);
845 }
846
847 oh = omap_hwmod_lookup(oh_name);
Russell King857835c2013-02-24 10:56:59 +0000848 if (!oh) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500849 WARN(1, "%s: no hwmod for %s\n", __func__,
850 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000851 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500852 }
Russell King857835c2013-02-24 10:56:59 +0000853 if (!oh->od) {
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500854 WARN(1, "%s: no omap_device for %s\n", __func__,
855 oh_name);
Russell King857835c2013-02-24 10:56:59 +0000856 return ERR_PTR(-ENODEV);
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500857 }
858
Nishanth Menon1f8a7d52011-07-27 15:02:32 -0500859 return &oh->od->pdev->dev;
860}
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700861
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200862static struct notifier_block platform_nb = {
863 .notifier_call = _omap_device_notifier_call,
864};
865
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700866static int __init omap_device_init(void)
867{
Benoit Coussondc2d07e2011-08-10 13:32:08 +0200868 bus_register_notifier(&platform_bus_type, &platform_nb);
Kevin Hilman3ec2dec2012-02-15 11:47:45 -0800869 return 0;
Kevin Hilman0d5e8252010-08-23 08:10:55 -0700870}
Tony Lindgrenb76c8b12013-01-11 11:24:18 -0800871omap_core_initcall(omap_device_init);
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700872
873/**
874 * omap_device_late_idle - idle devices without drivers
875 * @dev: struct device * associated with omap_device
876 * @data: unused
877 *
878 * Check the driver bound status of this device, and idle it
879 * if there is no driver attached.
880 */
881static int __init omap_device_late_idle(struct device *dev, void *data)
882{
883 struct platform_device *pdev = to_platform_device(dev);
884 struct omap_device *od = to_omap_device(pdev);
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600885 int i;
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700886
887 if (!od)
888 return 0;
889
890 /*
891 * If omap_device state is enabled, but has no driver bound,
892 * idle it.
893 */
Rajendra Nayakf66e3292013-07-28 23:01:50 -0600894
895 /*
896 * Some devices (like memory controllers) are always kept
897 * enabled, and should not be idled even with no drivers.
898 */
899 for (i = 0; i < od->hwmods_cnt; i++)
900 if (od->hwmods[i]->flags & HWMOD_INIT_NO_IDLE)
901 return 0;
902
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700903 if (od->_driver_status != BUS_NOTIFY_BOUND_DRIVER) {
904 if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
905 dev_warn(dev, "%s: enabled but no driver. Idling\n",
906 __func__);
907 omap_device_idle(pdev);
908 }
909 }
910
911 return 0;
912}
913
914static int __init omap_device_late_init(void)
915{
916 bus_for_each_dev(&platform_bus_type, NULL, NULL, omap_device_late_idle);
Tony Lindgren4b91f7f2014-10-27 13:05:54 -0700917
918 WARN(!of_have_populated_dt(),
919 "legacy booting deprecated, please update to boot with .dts\n");
920
Kevin Hilman9634c8d2012-07-10 15:06:11 -0700921 return 0;
922}
Kevin Hilmane7e17c52013-05-08 16:48:01 -0700923omap_late_initcall_sync(omap_device_late_init);