omap_device.c 31 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141
  1. /*
  2. * omap_device implementation
  3. *
  4. * Copyright (C) 2009-2010 Nokia Corporation
  5. * Paul Walmsley, Kevin Hilman
  6. *
  7. * Developed in collaboration with (alphabetical order): Benoit
  8. * Cousson, Thara Gopinath, Tony Lindgren, Rajendra Nayak, Vikram
  9. * 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. *
  20. * In the medium- to long-term, this code should either be
  21. * a) implemented via arch-specific pointers in platform_data
  22. * or
  23. * b) implemented as a proper omap_bus/omap_device in Linux, no more
  24. * platform_data func pointers
  25. *
  26. *
  27. * Guidelines for usage by driver authors:
  28. *
  29. * 1. These functions are intended to be used by device drivers via
  30. * function pointers in struct platform_data. As an example,
  31. * omap_device_enable() should be passed to the driver as
  32. *
  33. * struct foo_driver_platform_data {
  34. * ...
  35. * int (*device_enable)(struct platform_device *pdev);
  36. * ...
  37. * }
  38. *
  39. * Note that the generic "device_enable" name is used, rather than
  40. * "omap_device_enable". This is so other architectures can pass in their
  41. * own enable/disable functions here.
  42. *
  43. * This should be populated during device setup:
  44. *
  45. * ...
  46. * pdata->device_enable = omap_device_enable;
  47. * ...
  48. *
  49. * 2. Drivers should first check to ensure the function pointer is not null
  50. * before calling it, as in:
  51. *
  52. * if (pdata->device_enable)
  53. * pdata->device_enable(pdev);
  54. *
  55. * This allows other architectures that don't use similar device_enable()/
  56. * device_shutdown() functions to execute normally.
  57. *
  58. * ...
  59. *
  60. * Suggested usage by device drivers:
  61. *
  62. * During device initialization:
  63. * device_enable()
  64. *
  65. * During device idle:
  66. * (save remaining device context if necessary)
  67. * device_idle();
  68. *
  69. * During device resume:
  70. * device_enable();
  71. * (restore context if necessary)
  72. *
  73. * During device shutdown:
  74. * device_shutdown()
  75. * (device must be reinitialized at this point to use it again)
  76. *
  77. */
  78. #undef DEBUG
  79. #include <linux/kernel.h>
  80. #include <linux/export.h>
  81. #include <linux/platform_device.h>
  82. #include <linux/slab.h>
  83. #include <linux/err.h>
  84. #include <linux/io.h>
  85. #include <linux/clk.h>
  86. #include <linux/clkdev.h>
  87. #include <linux/pm_runtime.h>
  88. #include <linux/of.h>
  89. #include <linux/notifier.h>
  90. #include <plat/omap_device.h>
  91. #include <plat/omap_hwmod.h>
  92. #include <plat/clock.h>
  93. /* These parameters are passed to _omap_device_{de,}activate() */
  94. #define USE_WAKEUP_LAT 0
  95. #define IGNORE_WAKEUP_LAT 1
  96. static int omap_early_device_register(struct platform_device *pdev);
  97. static struct omap_device_pm_latency omap_default_latency[] = {
  98. {
  99. .deactivate_func = omap_device_idle_hwmods,
  100. .activate_func = omap_device_enable_hwmods,
  101. .flags = OMAP_DEVICE_LATENCY_AUTO_ADJUST,
  102. }
  103. };
  104. /* Private functions */
  105. /**
  106. * _omap_device_activate - increase device readiness
  107. * @od: struct omap_device *
  108. * @ignore_lat: increase to latency target (0) or full readiness (1)?
  109. *
  110. * Increase readiness of omap_device @od (thus decreasing device
  111. * wakeup latency, but consuming more power). If @ignore_lat is
  112. * IGNORE_WAKEUP_LAT, make the omap_device fully active. Otherwise,
  113. * if @ignore_lat is USE_WAKEUP_LAT, and the device's maximum wakeup
  114. * latency is greater than the requested maximum wakeup latency, step
  115. * backwards in the omap_device_pm_latency table to ensure the
  116. * device's maximum wakeup latency is less than or equal to the
  117. * requested maximum wakeup latency. Returns 0.
  118. */
  119. static int _omap_device_activate(struct omap_device *od, u8 ignore_lat)
  120. {
  121. struct timespec a, b, c;
  122. dev_dbg(&od->pdev->dev, "omap_device: activating\n");
  123. while (od->pm_lat_level > 0) {
  124. struct omap_device_pm_latency *odpl;
  125. unsigned long long act_lat = 0;
  126. od->pm_lat_level--;
  127. odpl = od->pm_lats + od->pm_lat_level;
  128. if (!ignore_lat &&
  129. (od->dev_wakeup_lat <= od->_dev_wakeup_lat_limit))
  130. break;
  131. read_persistent_clock(&a);
  132. /* XXX check return code */
  133. odpl->activate_func(od);
  134. read_persistent_clock(&b);
  135. c = timespec_sub(b, a);
  136. act_lat = timespec_to_ns(&c);
  137. dev_dbg(&od->pdev->dev,
  138. "omap_device: pm_lat %d: activate: elapsed time "
  139. "%llu nsec\n", od->pm_lat_level, act_lat);
  140. if (act_lat > odpl->activate_lat) {
  141. odpl->activate_lat_worst = act_lat;
  142. if (odpl->flags & OMAP_DEVICE_LATENCY_AUTO_ADJUST) {
  143. odpl->activate_lat = act_lat;
  144. dev_dbg(&od->pdev->dev,
  145. "new worst case activate latency "
  146. "%d: %llu\n",
  147. od->pm_lat_level, act_lat);
  148. } else
  149. dev_warn(&od->pdev->dev,
  150. "activate latency %d "
  151. "higher than exptected. (%llu > %d)\n",
  152. od->pm_lat_level, act_lat,
  153. odpl->activate_lat);
  154. }
  155. od->dev_wakeup_lat -= odpl->activate_lat;
  156. }
  157. return 0;
  158. }
  159. /**
  160. * _omap_device_deactivate - decrease device readiness
  161. * @od: struct omap_device *
  162. * @ignore_lat: decrease to latency target (0) or full inactivity (1)?
  163. *
  164. * Decrease readiness of omap_device @od (thus increasing device
  165. * wakeup latency, but conserving power). If @ignore_lat is
  166. * IGNORE_WAKEUP_LAT, make the omap_device fully inactive. Otherwise,
  167. * if @ignore_lat is USE_WAKEUP_LAT, and the device's maximum wakeup
  168. * latency is less than the requested maximum wakeup latency, step
  169. * forwards in the omap_device_pm_latency table to ensure the device's
  170. * maximum wakeup latency is less than or equal to the requested
  171. * maximum wakeup latency. Returns 0.
  172. */
  173. static int _omap_device_deactivate(struct omap_device *od, u8 ignore_lat)
  174. {
  175. struct timespec a, b, c;
  176. dev_dbg(&od->pdev->dev, "omap_device: deactivating\n");
  177. while (od->pm_lat_level < od->pm_lats_cnt) {
  178. struct omap_device_pm_latency *odpl;
  179. unsigned long long deact_lat = 0;
  180. odpl = od->pm_lats + od->pm_lat_level;
  181. if (!ignore_lat &&
  182. ((od->dev_wakeup_lat + odpl->activate_lat) >
  183. od->_dev_wakeup_lat_limit))
  184. break;
  185. read_persistent_clock(&a);
  186. /* XXX check return code */
  187. odpl->deactivate_func(od);
  188. read_persistent_clock(&b);
  189. c = timespec_sub(b, a);
  190. deact_lat = timespec_to_ns(&c);
  191. dev_dbg(&od->pdev->dev,
  192. "omap_device: pm_lat %d: deactivate: elapsed time "
  193. "%llu nsec\n", od->pm_lat_level, deact_lat);
  194. if (deact_lat > odpl->deactivate_lat) {
  195. odpl->deactivate_lat_worst = deact_lat;
  196. if (odpl->flags & OMAP_DEVICE_LATENCY_AUTO_ADJUST) {
  197. odpl->deactivate_lat = deact_lat;
  198. dev_dbg(&od->pdev->dev,
  199. "new worst case deactivate latency "
  200. "%d: %llu\n",
  201. od->pm_lat_level, deact_lat);
  202. } else
  203. dev_warn(&od->pdev->dev,
  204. "deactivate latency %d "
  205. "higher than exptected. (%llu > %d)\n",
  206. od->pm_lat_level, deact_lat,
  207. odpl->deactivate_lat);
  208. }
  209. od->dev_wakeup_lat += odpl->activate_lat;
  210. od->pm_lat_level++;
  211. }
  212. return 0;
  213. }
  214. static void _add_clkdev(struct omap_device *od, const char *clk_alias,
  215. const char *clk_name)
  216. {
  217. struct clk *r;
  218. struct clk_lookup *l;
  219. if (!clk_alias || !clk_name)
  220. return;
  221. dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
  222. r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
  223. if (!IS_ERR(r)) {
  224. dev_warn(&od->pdev->dev,
  225. "alias %s already exists\n", clk_alias);
  226. clk_put(r);
  227. return;
  228. }
  229. r = omap_clk_get_by_name(clk_name);
  230. if (IS_ERR(r)) {
  231. dev_err(&od->pdev->dev,
  232. "omap_clk_get_by_name for %s failed\n", clk_name);
  233. return;
  234. }
  235. l = clkdev_alloc(r, clk_alias, dev_name(&od->pdev->dev));
  236. if (!l) {
  237. dev_err(&od->pdev->dev,
  238. "clkdev_alloc for %s failed\n", clk_alias);
  239. return;
  240. }
  241. clkdev_add(l);
  242. }
  243. /**
  244. * _add_hwmod_clocks_clkdev - Add clkdev entry for hwmod optional clocks
  245. * and main clock
  246. * @od: struct omap_device *od
  247. * @oh: struct omap_hwmod *oh
  248. *
  249. * For the main clock and every optional clock present per hwmod per
  250. * omap_device, this function adds an entry in the clkdev table of the
  251. * form <dev-id=dev_name, con-id=role> if it does not exist already.
  252. *
  253. * The function is called from inside omap_device_build_ss(), after
  254. * omap_device_register.
  255. *
  256. * This allows drivers to get a pointer to its optional clocks based on its role
  257. * by calling clk_get(<dev*>, <role>).
  258. * In the case of the main clock, a "fck" alias is used.
  259. *
  260. * No return value.
  261. */
  262. static void _add_hwmod_clocks_clkdev(struct omap_device *od,
  263. struct omap_hwmod *oh)
  264. {
  265. int i;
  266. _add_clkdev(od, "fck", oh->main_clk);
  267. for (i = 0; i < oh->opt_clks_cnt; i++)
  268. _add_clkdev(od, oh->opt_clks[i].role, oh->opt_clks[i].clk);
  269. }
  270. static struct dev_pm_domain omap_device_pm_domain;
  271. /**
  272. * omap_device_build_from_dt - build an omap_device with multiple hwmods
  273. * @pdev_name: name of the platform_device driver to use
  274. * @pdev_id: this platform_device's connection ID
  275. * @oh: ptr to the single omap_hwmod that backs this omap_device
  276. * @pdata: platform_data ptr to associate with the platform_device
  277. * @pdata_len: amount of memory pointed to by @pdata
  278. * @pm_lats: pointer to a omap_device_pm_latency array for this device
  279. * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
  280. * @is_early_device: should the device be registered as an early device or not
  281. *
  282. * Function for building an omap_device already registered from device-tree
  283. *
  284. * Returns 0 or PTR_ERR() on error.
  285. */
  286. static int omap_device_build_from_dt(struct platform_device *pdev)
  287. {
  288. struct omap_hwmod **hwmods;
  289. struct omap_device *od;
  290. struct omap_hwmod *oh;
  291. struct device_node *node = pdev->dev.of_node;
  292. const char *oh_name;
  293. int oh_cnt, i, ret = 0;
  294. oh_cnt = of_property_count_strings(node, "ti,hwmods");
  295. if (!oh_cnt || IS_ERR_VALUE(oh_cnt)) {
  296. dev_warn(&pdev->dev, "No 'hwmods' to build omap_device\n");
  297. return -ENODEV;
  298. }
  299. hwmods = kzalloc(sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
  300. if (!hwmods) {
  301. ret = -ENOMEM;
  302. goto odbfd_exit;
  303. }
  304. for (i = 0; i < oh_cnt; i++) {
  305. of_property_read_string_index(node, "ti,hwmods", i, &oh_name);
  306. oh = omap_hwmod_lookup(oh_name);
  307. if (!oh) {
  308. dev_err(&pdev->dev, "Cannot lookup hwmod '%s'\n",
  309. oh_name);
  310. ret = -EINVAL;
  311. goto odbfd_exit1;
  312. }
  313. hwmods[i] = oh;
  314. }
  315. od = omap_device_alloc(pdev, hwmods, oh_cnt, NULL, 0);
  316. if (!od) {
  317. dev_err(&pdev->dev, "Cannot allocate omap_device for :%s\n",
  318. oh_name);
  319. ret = PTR_ERR(od);
  320. goto odbfd_exit1;
  321. }
  322. if (of_get_property(node, "ti,no_idle_on_suspend", NULL))
  323. omap_device_disable_idle_on_suspend(pdev);
  324. pdev->dev.pm_domain = &omap_device_pm_domain;
  325. odbfd_exit1:
  326. kfree(hwmods);
  327. odbfd_exit:
  328. return ret;
  329. }
  330. static int _omap_device_notifier_call(struct notifier_block *nb,
  331. unsigned long event, void *dev)
  332. {
  333. struct platform_device *pdev = to_platform_device(dev);
  334. switch (event) {
  335. case BUS_NOTIFY_ADD_DEVICE:
  336. if (pdev->dev.of_node)
  337. omap_device_build_from_dt(pdev);
  338. break;
  339. case BUS_NOTIFY_DEL_DEVICE:
  340. if (pdev->archdata.od)
  341. omap_device_delete(pdev->archdata.od);
  342. break;
  343. }
  344. return NOTIFY_DONE;
  345. }
  346. /* Public functions for use by core code */
  347. /**
  348. * omap_device_get_context_loss_count - get lost context count
  349. * @od: struct omap_device *
  350. *
  351. * Using the primary hwmod, query the context loss count for this
  352. * device.
  353. *
  354. * Callers should consider context for this device lost any time this
  355. * function returns a value different than the value the caller got
  356. * the last time it called this function.
  357. *
  358. * If any hwmods exist for the omap_device assoiated with @pdev,
  359. * return the context loss counter for that hwmod, otherwise return
  360. * zero.
  361. */
  362. int omap_device_get_context_loss_count(struct platform_device *pdev)
  363. {
  364. struct omap_device *od;
  365. u32 ret = 0;
  366. od = to_omap_device(pdev);
  367. if (od->hwmods_cnt)
  368. ret = omap_hwmod_get_context_loss_count(od->hwmods[0]);
  369. return ret;
  370. }
  371. /**
  372. * omap_device_count_resources - count number of struct resource entries needed
  373. * @od: struct omap_device *
  374. *
  375. * Count the number of struct resource entries needed for this
  376. * omap_device @od. Used by omap_device_build_ss() to determine how
  377. * much memory to allocate before calling
  378. * omap_device_fill_resources(). Returns the count.
  379. */
  380. static int omap_device_count_resources(struct omap_device *od)
  381. {
  382. int c = 0;
  383. int i;
  384. for (i = 0; i < od->hwmods_cnt; i++)
  385. c += omap_hwmod_count_resources(od->hwmods[i]);
  386. pr_debug("omap_device: %s: counted %d total resources across %d "
  387. "hwmods\n", od->pdev->name, c, od->hwmods_cnt);
  388. return c;
  389. }
  390. /**
  391. * omap_device_fill_resources - fill in array of struct resource
  392. * @od: struct omap_device *
  393. * @res: pointer to an array of struct resource to be filled in
  394. *
  395. * Populate one or more empty struct resource pointed to by @res with
  396. * the resource data for this omap_device @od. Used by
  397. * omap_device_build_ss() after calling omap_device_count_resources().
  398. * Ideally this function would not be needed at all. If omap_device
  399. * replaces platform_device, then we can specify our own
  400. * get_resource()/ get_irq()/etc functions that use the underlying
  401. * omap_hwmod information. Or if platform_device is extended to use
  402. * subarchitecture-specific function pointers, the various
  403. * platform_device functions can simply call omap_device internal
  404. * functions to get device resources. Hacking around the existing
  405. * platform_device code wastes memory. Returns 0.
  406. */
  407. static int omap_device_fill_resources(struct omap_device *od,
  408. struct resource *res)
  409. {
  410. int c = 0;
  411. int i, r;
  412. for (i = 0; i < od->hwmods_cnt; i++) {
  413. r = omap_hwmod_fill_resources(od->hwmods[i], res);
  414. res += r;
  415. c += r;
  416. }
  417. return 0;
  418. }
  419. /**
  420. * omap_device_alloc - allocate an omap_device
  421. * @pdev: platform_device that will be included in this omap_device
  422. * @oh: ptr to the single omap_hwmod that backs this omap_device
  423. * @pdata: platform_data ptr to associate with the platform_device
  424. * @pdata_len: amount of memory pointed to by @pdata
  425. * @pm_lats: pointer to a omap_device_pm_latency array for this device
  426. * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
  427. *
  428. * Convenience function for allocating an omap_device structure and filling
  429. * hwmods, resources and pm_latency attributes.
  430. *
  431. * Returns an struct omap_device pointer or ERR_PTR() on error;
  432. */
  433. struct omap_device *omap_device_alloc(struct platform_device *pdev,
  434. struct omap_hwmod **ohs, int oh_cnt,
  435. struct omap_device_pm_latency *pm_lats,
  436. int pm_lats_cnt)
  437. {
  438. int ret = -ENOMEM;
  439. struct omap_device *od;
  440. struct resource *res = NULL;
  441. int i, res_count;
  442. struct omap_hwmod **hwmods;
  443. od = kzalloc(sizeof(struct omap_device), GFP_KERNEL);
  444. if (!od) {
  445. ret = -ENOMEM;
  446. goto oda_exit1;
  447. }
  448. od->hwmods_cnt = oh_cnt;
  449. hwmods = kmemdup(ohs, sizeof(struct omap_hwmod *) * oh_cnt, GFP_KERNEL);
  450. if (!hwmods)
  451. goto oda_exit2;
  452. od->hwmods = hwmods;
  453. od->pdev = pdev;
  454. /*
  455. * HACK: Ideally the resources from DT should match, and hwmod
  456. * should just add the missing ones. Since the name is not
  457. * properly populated by DT, stick to hwmod resources only.
  458. */
  459. if (pdev->num_resources && pdev->resource)
  460. dev_warn(&pdev->dev, "%s(): resources already allocated %d\n",
  461. __func__, pdev->num_resources);
  462. res_count = omap_device_count_resources(od);
  463. if (res_count > 0) {
  464. dev_dbg(&pdev->dev, "%s(): resources allocated from hwmod %d\n",
  465. __func__, res_count);
  466. res = kzalloc(sizeof(struct resource) * res_count, GFP_KERNEL);
  467. if (!res)
  468. goto oda_exit3;
  469. omap_device_fill_resources(od, res);
  470. ret = platform_device_add_resources(pdev, res, res_count);
  471. kfree(res);
  472. if (ret)
  473. goto oda_exit3;
  474. }
  475. if (!pm_lats) {
  476. pm_lats = omap_default_latency;
  477. pm_lats_cnt = ARRAY_SIZE(omap_default_latency);
  478. }
  479. od->pm_lats_cnt = pm_lats_cnt;
  480. od->pm_lats = kmemdup(pm_lats,
  481. sizeof(struct omap_device_pm_latency) * pm_lats_cnt,
  482. GFP_KERNEL);
  483. if (!od->pm_lats)
  484. goto oda_exit3;
  485. pdev->archdata.od = od;
  486. for (i = 0; i < oh_cnt; i++) {
  487. hwmods[i]->od = od;
  488. _add_hwmod_clocks_clkdev(od, hwmods[i]);
  489. }
  490. return od;
  491. oda_exit3:
  492. kfree(hwmods);
  493. oda_exit2:
  494. kfree(od);
  495. oda_exit1:
  496. dev_err(&pdev->dev, "omap_device: build failed (%d)\n", ret);
  497. return ERR_PTR(ret);
  498. }
  499. void omap_device_delete(struct omap_device *od)
  500. {
  501. if (!od)
  502. return;
  503. od->pdev->archdata.od = NULL;
  504. kfree(od->pm_lats);
  505. kfree(od->hwmods);
  506. kfree(od);
  507. }
  508. /**
  509. * omap_device_build - build and register an omap_device with one omap_hwmod
  510. * @pdev_name: name of the platform_device driver to use
  511. * @pdev_id: this platform_device's connection ID
  512. * @oh: ptr to the single omap_hwmod that backs this omap_device
  513. * @pdata: platform_data ptr to associate with the platform_device
  514. * @pdata_len: amount of memory pointed to by @pdata
  515. * @pm_lats: pointer to a omap_device_pm_latency array for this device
  516. * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
  517. * @is_early_device: should the device be registered as an early device or not
  518. *
  519. * Convenience function for building and registering a single
  520. * omap_device record, which in turn builds and registers a
  521. * platform_device record. See omap_device_build_ss() for more
  522. * information. Returns ERR_PTR(-EINVAL) if @oh is NULL; otherwise,
  523. * passes along the return value of omap_device_build_ss().
  524. */
  525. struct platform_device __init *omap_device_build(const char *pdev_name, int pdev_id,
  526. struct omap_hwmod *oh, void *pdata,
  527. int pdata_len,
  528. struct omap_device_pm_latency *pm_lats,
  529. int pm_lats_cnt, int is_early_device)
  530. {
  531. struct omap_hwmod *ohs[] = { oh };
  532. if (!oh)
  533. return ERR_PTR(-EINVAL);
  534. return omap_device_build_ss(pdev_name, pdev_id, ohs, 1, pdata,
  535. pdata_len, pm_lats, pm_lats_cnt,
  536. is_early_device);
  537. }
  538. /**
  539. * omap_device_build_ss - build and register an omap_device with multiple hwmods
  540. * @pdev_name: name of the platform_device driver to use
  541. * @pdev_id: this platform_device's connection ID
  542. * @oh: ptr to the single omap_hwmod that backs this omap_device
  543. * @pdata: platform_data ptr to associate with the platform_device
  544. * @pdata_len: amount of memory pointed to by @pdata
  545. * @pm_lats: pointer to a omap_device_pm_latency array for this device
  546. * @pm_lats_cnt: ARRAY_SIZE() of @pm_lats
  547. * @is_early_device: should the device be registered as an early device or not
  548. *
  549. * Convenience function for building and registering an omap_device
  550. * subsystem record. Subsystem records consist of multiple
  551. * omap_hwmods. This function in turn builds and registers a
  552. * platform_device record. Returns an ERR_PTR() on error, or passes
  553. * along the return value of omap_device_register().
  554. */
  555. struct platform_device __init *omap_device_build_ss(const char *pdev_name, int pdev_id,
  556. struct omap_hwmod **ohs, int oh_cnt,
  557. void *pdata, int pdata_len,
  558. struct omap_device_pm_latency *pm_lats,
  559. int pm_lats_cnt, int is_early_device)
  560. {
  561. int ret = -ENOMEM;
  562. struct platform_device *pdev;
  563. struct omap_device *od;
  564. if (!ohs || oh_cnt == 0 || !pdev_name)
  565. return ERR_PTR(-EINVAL);
  566. if (!pdata && pdata_len > 0)
  567. return ERR_PTR(-EINVAL);
  568. pdev = platform_device_alloc(pdev_name, pdev_id);
  569. if (!pdev) {
  570. ret = -ENOMEM;
  571. goto odbs_exit;
  572. }
  573. /* Set the dev_name early to allow dev_xxx in omap_device_alloc */
  574. if (pdev->id != -1)
  575. dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
  576. else
  577. dev_set_name(&pdev->dev, "%s", pdev->name);
  578. od = omap_device_alloc(pdev, ohs, oh_cnt, pm_lats, pm_lats_cnt);
  579. if (!od)
  580. goto odbs_exit1;
  581. ret = platform_device_add_data(pdev, pdata, pdata_len);
  582. if (ret)
  583. goto odbs_exit2;
  584. if (is_early_device)
  585. ret = omap_early_device_register(pdev);
  586. else
  587. ret = omap_device_register(pdev);
  588. if (ret)
  589. goto odbs_exit2;
  590. return pdev;
  591. odbs_exit2:
  592. omap_device_delete(od);
  593. odbs_exit1:
  594. platform_device_put(pdev);
  595. odbs_exit:
  596. pr_err("omap_device: %s: build failed (%d)\n", pdev_name, ret);
  597. return ERR_PTR(ret);
  598. }
  599. /**
  600. * omap_early_device_register - register an omap_device as an early platform
  601. * device.
  602. * @od: struct omap_device * to register
  603. *
  604. * Register the omap_device structure. This currently just calls
  605. * platform_early_add_device() on the underlying platform_device.
  606. * Returns 0 by default.
  607. */
  608. static int __init omap_early_device_register(struct platform_device *pdev)
  609. {
  610. struct platform_device *devices[1];
  611. devices[0] = pdev;
  612. early_platform_add_devices(devices, 1);
  613. return 0;
  614. }
  615. #ifdef CONFIG_PM_RUNTIME
  616. static int _od_runtime_suspend(struct device *dev)
  617. {
  618. struct platform_device *pdev = to_platform_device(dev);
  619. int ret;
  620. ret = pm_generic_runtime_suspend(dev);
  621. if (!ret)
  622. omap_device_idle(pdev);
  623. return ret;
  624. }
  625. static int _od_runtime_idle(struct device *dev)
  626. {
  627. return pm_generic_runtime_idle(dev);
  628. }
  629. static int _od_runtime_resume(struct device *dev)
  630. {
  631. struct platform_device *pdev = to_platform_device(dev);
  632. omap_device_enable(pdev);
  633. return pm_generic_runtime_resume(dev);
  634. }
  635. #endif
  636. #ifdef CONFIG_SUSPEND
  637. static int _od_suspend_noirq(struct device *dev)
  638. {
  639. struct platform_device *pdev = to_platform_device(dev);
  640. struct omap_device *od = to_omap_device(pdev);
  641. int ret;
  642. if (od->flags & OMAP_DEVICE_NO_IDLE_ON_SUSPEND)
  643. return pm_generic_suspend_noirq(dev);
  644. ret = pm_generic_suspend_noirq(dev);
  645. if (!ret && !pm_runtime_status_suspended(dev)) {
  646. if (pm_generic_runtime_suspend(dev) == 0) {
  647. omap_device_idle(pdev);
  648. od->flags |= OMAP_DEVICE_SUSPENDED;
  649. }
  650. }
  651. return ret;
  652. }
  653. static int _od_resume_noirq(struct device *dev)
  654. {
  655. struct platform_device *pdev = to_platform_device(dev);
  656. struct omap_device *od = to_omap_device(pdev);
  657. if (od->flags & OMAP_DEVICE_NO_IDLE_ON_SUSPEND)
  658. return pm_generic_resume_noirq(dev);
  659. if ((od->flags & OMAP_DEVICE_SUSPENDED) &&
  660. !pm_runtime_status_suspended(dev)) {
  661. od->flags &= ~OMAP_DEVICE_SUSPENDED;
  662. omap_device_enable(pdev);
  663. pm_generic_runtime_resume(dev);
  664. }
  665. return pm_generic_resume_noirq(dev);
  666. }
  667. #else
  668. #define _od_suspend_noirq NULL
  669. #define _od_resume_noirq NULL
  670. #endif
  671. static struct dev_pm_domain omap_device_pm_domain = {
  672. .ops = {
  673. SET_RUNTIME_PM_OPS(_od_runtime_suspend, _od_runtime_resume,
  674. _od_runtime_idle)
  675. USE_PLATFORM_PM_SLEEP_OPS
  676. .suspend_noirq = _od_suspend_noirq,
  677. .resume_noirq = _od_resume_noirq,
  678. }
  679. };
  680. /**
  681. * omap_device_register - register an omap_device with one omap_hwmod
  682. * @od: struct omap_device * to register
  683. *
  684. * Register the omap_device structure. This currently just calls
  685. * platform_device_register() on the underlying platform_device.
  686. * Returns the return value of platform_device_register().
  687. */
  688. int omap_device_register(struct platform_device *pdev)
  689. {
  690. pr_debug("omap_device: %s: registering\n", pdev->name);
  691. pdev->dev.parent = &omap_device_parent;
  692. pdev->dev.pm_domain = &omap_device_pm_domain;
  693. return platform_device_add(pdev);
  694. }
  695. /* Public functions for use by device drivers through struct platform_data */
  696. /**
  697. * omap_device_enable - fully activate an omap_device
  698. * @od: struct omap_device * to activate
  699. *
  700. * Do whatever is necessary for the hwmods underlying omap_device @od
  701. * to be accessible and ready to operate. This generally involves
  702. * enabling clocks, setting SYSCONFIG registers; and in the future may
  703. * involve remuxing pins. Device drivers should call this function
  704. * (through platform_data function pointers) where they would normally
  705. * enable clocks, etc. Returns -EINVAL if called when the omap_device
  706. * is already enabled, or passes along the return value of
  707. * _omap_device_activate().
  708. */
  709. int omap_device_enable(struct platform_device *pdev)
  710. {
  711. int ret;
  712. struct omap_device *od;
  713. od = to_omap_device(pdev);
  714. if (od->_state == OMAP_DEVICE_STATE_ENABLED) {
  715. dev_warn(&pdev->dev,
  716. "omap_device: %s() called from invalid state %d\n",
  717. __func__, od->_state);
  718. return -EINVAL;
  719. }
  720. /* Enable everything if we're enabling this device from scratch */
  721. if (od->_state == OMAP_DEVICE_STATE_UNKNOWN)
  722. od->pm_lat_level = od->pm_lats_cnt;
  723. ret = _omap_device_activate(od, IGNORE_WAKEUP_LAT);
  724. od->dev_wakeup_lat = 0;
  725. od->_dev_wakeup_lat_limit = UINT_MAX;
  726. od->_state = OMAP_DEVICE_STATE_ENABLED;
  727. return ret;
  728. }
  729. /**
  730. * omap_device_idle - idle an omap_device
  731. * @od: struct omap_device * to idle
  732. *
  733. * Idle omap_device @od by calling as many .deactivate_func() entries
  734. * in the omap_device's pm_lats table as is possible without exceeding
  735. * the device's maximum wakeup latency limit, pm_lat_limit. Device
  736. * drivers should call this function (through platform_data function
  737. * pointers) where they would normally disable clocks after operations
  738. * complete, etc.. Returns -EINVAL if the omap_device is not
  739. * currently enabled, or passes along the return value of
  740. * _omap_device_deactivate().
  741. */
  742. int omap_device_idle(struct platform_device *pdev)
  743. {
  744. int ret;
  745. struct omap_device *od;
  746. od = to_omap_device(pdev);
  747. if (od->_state != OMAP_DEVICE_STATE_ENABLED) {
  748. dev_warn(&pdev->dev,
  749. "omap_device: %s() called from invalid state %d\n",
  750. __func__, od->_state);
  751. return -EINVAL;
  752. }
  753. ret = _omap_device_deactivate(od, USE_WAKEUP_LAT);
  754. od->_state = OMAP_DEVICE_STATE_IDLE;
  755. return ret;
  756. }
  757. /**
  758. * omap_device_shutdown - shut down an omap_device
  759. * @od: struct omap_device * to shut down
  760. *
  761. * Shut down omap_device @od by calling all .deactivate_func() entries
  762. * in the omap_device's pm_lats table and then shutting down all of
  763. * the underlying omap_hwmods. Used when a device is being "removed"
  764. * or a device driver is being unloaded. Returns -EINVAL if the
  765. * omap_device is not currently enabled or idle, or passes along the
  766. * return value of _omap_device_deactivate().
  767. */
  768. int omap_device_shutdown(struct platform_device *pdev)
  769. {
  770. int ret, i;
  771. struct omap_device *od;
  772. od = to_omap_device(pdev);
  773. if (od->_state != OMAP_DEVICE_STATE_ENABLED &&
  774. od->_state != OMAP_DEVICE_STATE_IDLE) {
  775. dev_warn(&pdev->dev,
  776. "omap_device: %s() called from invalid state %d\n",
  777. __func__, od->_state);
  778. return -EINVAL;
  779. }
  780. ret = _omap_device_deactivate(od, IGNORE_WAKEUP_LAT);
  781. for (i = 0; i < od->hwmods_cnt; i++)
  782. omap_hwmod_shutdown(od->hwmods[i]);
  783. od->_state = OMAP_DEVICE_STATE_SHUTDOWN;
  784. return ret;
  785. }
  786. /**
  787. * omap_device_align_pm_lat - activate/deactivate device to match wakeup lat lim
  788. * @od: struct omap_device *
  789. *
  790. * When a device's maximum wakeup latency limit changes, call some of
  791. * the .activate_func or .deactivate_func function pointers in the
  792. * omap_device's pm_lats array to ensure that the device's maximum
  793. * wakeup latency is less than or equal to the new latency limit.
  794. * Intended to be called by OMAP PM code whenever a device's maximum
  795. * wakeup latency limit changes (e.g., via
  796. * omap_pm_set_dev_wakeup_lat()). Returns 0 if nothing needs to be
  797. * done (e.g., if the omap_device is not currently idle, or if the
  798. * wakeup latency is already current with the new limit) or passes
  799. * along the return value of _omap_device_deactivate() or
  800. * _omap_device_activate().
  801. */
  802. int omap_device_align_pm_lat(struct platform_device *pdev,
  803. u32 new_wakeup_lat_limit)
  804. {
  805. int ret = -EINVAL;
  806. struct omap_device *od;
  807. od = to_omap_device(pdev);
  808. if (new_wakeup_lat_limit == od->dev_wakeup_lat)
  809. return 0;
  810. od->_dev_wakeup_lat_limit = new_wakeup_lat_limit;
  811. if (od->_state != OMAP_DEVICE_STATE_IDLE)
  812. return 0;
  813. else if (new_wakeup_lat_limit > od->dev_wakeup_lat)
  814. ret = _omap_device_deactivate(od, USE_WAKEUP_LAT);
  815. else if (new_wakeup_lat_limit < od->dev_wakeup_lat)
  816. ret = _omap_device_activate(od, USE_WAKEUP_LAT);
  817. return ret;
  818. }
  819. /**
  820. * omap_device_get_pwrdm - return the powerdomain * associated with @od
  821. * @od: struct omap_device *
  822. *
  823. * Return the powerdomain associated with the first underlying
  824. * omap_hwmod for this omap_device. Intended for use by core OMAP PM
  825. * code. Returns NULL on error or a struct powerdomain * upon
  826. * success.
  827. */
  828. struct powerdomain *omap_device_get_pwrdm(struct omap_device *od)
  829. {
  830. /*
  831. * XXX Assumes that all omap_hwmod powerdomains are identical.
  832. * This may not necessarily be true. There should be a sanity
  833. * check in here to WARN() if any difference appears.
  834. */
  835. if (!od->hwmods_cnt)
  836. return NULL;
  837. return omap_hwmod_get_pwrdm(od->hwmods[0]);
  838. }
  839. /**
  840. * omap_device_get_mpu_rt_va - return the MPU's virtual addr for the hwmod base
  841. * @od: struct omap_device *
  842. *
  843. * Return the MPU's virtual address for the base of the hwmod, from
  844. * the ioremap() that the hwmod code does. Only valid if there is one
  845. * hwmod associated with this device. Returns NULL if there are zero
  846. * or more than one hwmods associated with this omap_device;
  847. * otherwise, passes along the return value from
  848. * omap_hwmod_get_mpu_rt_va().
  849. */
  850. void __iomem *omap_device_get_rt_va(struct omap_device *od)
  851. {
  852. if (od->hwmods_cnt != 1)
  853. return NULL;
  854. return omap_hwmod_get_mpu_rt_va(od->hwmods[0]);
  855. }
  856. /**
  857. * omap_device_get_by_hwmod_name() - convert a hwmod name to
  858. * device pointer.
  859. * @oh_name: name of the hwmod device
  860. *
  861. * Returns back a struct device * pointer associated with a hwmod
  862. * device represented by a hwmod_name
  863. */
  864. struct device *omap_device_get_by_hwmod_name(const char *oh_name)
  865. {
  866. struct omap_hwmod *oh;
  867. if (!oh_name) {
  868. WARN(1, "%s: no hwmod name!\n", __func__);
  869. return ERR_PTR(-EINVAL);
  870. }
  871. oh = omap_hwmod_lookup(oh_name);
  872. if (IS_ERR_OR_NULL(oh)) {
  873. WARN(1, "%s: no hwmod for %s\n", __func__,
  874. oh_name);
  875. return ERR_PTR(oh ? PTR_ERR(oh) : -ENODEV);
  876. }
  877. if (IS_ERR_OR_NULL(oh->od)) {
  878. WARN(1, "%s: no omap_device for %s\n", __func__,
  879. oh_name);
  880. return ERR_PTR(oh->od ? PTR_ERR(oh->od) : -ENODEV);
  881. }
  882. if (IS_ERR_OR_NULL(oh->od->pdev))
  883. return ERR_PTR(oh->od->pdev ? PTR_ERR(oh->od->pdev) : -ENODEV);
  884. return &oh->od->pdev->dev;
  885. }
  886. EXPORT_SYMBOL(omap_device_get_by_hwmod_name);
  887. /*
  888. * Public functions intended for use in omap_device_pm_latency
  889. * .activate_func and .deactivate_func function pointers
  890. */
  891. /**
  892. * omap_device_enable_hwmods - call omap_hwmod_enable() on all hwmods
  893. * @od: struct omap_device *od
  894. *
  895. * Enable all underlying hwmods. Returns 0.
  896. */
  897. int omap_device_enable_hwmods(struct omap_device *od)
  898. {
  899. int i;
  900. for (i = 0; i < od->hwmods_cnt; i++)
  901. omap_hwmod_enable(od->hwmods[i]);
  902. /* XXX pass along return value here? */
  903. return 0;
  904. }
  905. /**
  906. * omap_device_idle_hwmods - call omap_hwmod_idle() on all hwmods
  907. * @od: struct omap_device *od
  908. *
  909. * Idle all underlying hwmods. Returns 0.
  910. */
  911. int omap_device_idle_hwmods(struct omap_device *od)
  912. {
  913. int i;
  914. for (i = 0; i < od->hwmods_cnt; i++)
  915. omap_hwmod_idle(od->hwmods[i]);
  916. /* XXX pass along return value here? */
  917. return 0;
  918. }
  919. /**
  920. * omap_device_disable_clocks - disable all main and interface clocks
  921. * @od: struct omap_device *od
  922. *
  923. * Disable the main functional clock and interface clock for all of the
  924. * omap_hwmods associated with the omap_device. Returns 0.
  925. */
  926. int omap_device_disable_clocks(struct omap_device *od)
  927. {
  928. int i;
  929. for (i = 0; i < od->hwmods_cnt; i++)
  930. omap_hwmod_disable_clocks(od->hwmods[i]);
  931. /* XXX pass along return value here? */
  932. return 0;
  933. }
  934. /**
  935. * omap_device_enable_clocks - enable all main and interface clocks
  936. * @od: struct omap_device *od
  937. *
  938. * Enable the main functional clock and interface clock for all of the
  939. * omap_hwmods associated with the omap_device. Returns 0.
  940. */
  941. int omap_device_enable_clocks(struct omap_device *od)
  942. {
  943. int i;
  944. for (i = 0; i < od->hwmods_cnt; i++)
  945. omap_hwmod_enable_clocks(od->hwmods[i]);
  946. /* XXX pass along return value here? */
  947. return 0;
  948. }
  949. struct device omap_device_parent = {
  950. .init_name = "omap",
  951. .parent = &platform_bus,
  952. };
  953. static struct notifier_block platform_nb = {
  954. .notifier_call = _omap_device_notifier_call,
  955. };
  956. static int __init omap_device_init(void)
  957. {
  958. bus_register_notifier(&platform_bus_type, &platform_nb);
  959. return device_register(&omap_device_parent);
  960. }
  961. core_initcall(omap_device_init);