platform.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988
  1. /*
  2. * platform.c - platform 'pseudo' bus for legacy devices
  3. *
  4. * Copyright (c) 2002-3 Patrick Mochel
  5. * Copyright (c) 2002-3 Open Source Development Labs
  6. *
  7. * This file is released under the GPLv2
  8. *
  9. * Please see Documentation/driver-model/platform.txt for more
  10. * information.
  11. */
  12. #include <linux/platform_device.h>
  13. #include <linux/module.h>
  14. #include <linux/init.h>
  15. #include <linux/dma-mapping.h>
  16. #include <linux/bootmem.h>
  17. #include <linux/err.h>
  18. #include <linux/slab.h>
  19. #include "base.h"
  20. #define to_platform_driver(drv) (container_of((drv), struct platform_driver, \
  21. driver))
  22. struct device platform_bus = {
  23. .init_name = "platform",
  24. };
  25. EXPORT_SYMBOL_GPL(platform_bus);
  26. /**
  27. * platform_get_resource - get a resource for a device
  28. * @dev: platform device
  29. * @type: resource type
  30. * @num: resource index
  31. */
  32. struct resource *platform_get_resource(struct platform_device *dev,
  33. unsigned int type, unsigned int num)
  34. {
  35. int i;
  36. for (i = 0; i < dev->num_resources; i++) {
  37. struct resource *r = &dev->resource[i];
  38. if (type == resource_type(r) && num-- == 0)
  39. return r;
  40. }
  41. return NULL;
  42. }
  43. EXPORT_SYMBOL_GPL(platform_get_resource);
  44. /**
  45. * platform_get_irq - get an IRQ for a device
  46. * @dev: platform device
  47. * @num: IRQ number index
  48. */
  49. int platform_get_irq(struct platform_device *dev, unsigned int num)
  50. {
  51. struct resource *r = platform_get_resource(dev, IORESOURCE_IRQ, num);
  52. return r ? r->start : -ENXIO;
  53. }
  54. EXPORT_SYMBOL_GPL(platform_get_irq);
  55. /**
  56. * platform_get_resource_byname - get a resource for a device by name
  57. * @dev: platform device
  58. * @type: resource type
  59. * @name: resource name
  60. */
  61. struct resource *platform_get_resource_byname(struct platform_device *dev,
  62. unsigned int type, char *name)
  63. {
  64. int i;
  65. for (i = 0; i < dev->num_resources; i++) {
  66. struct resource *r = &dev->resource[i];
  67. if (type == resource_type(r) && !strcmp(r->name, name))
  68. return r;
  69. }
  70. return NULL;
  71. }
  72. EXPORT_SYMBOL_GPL(platform_get_resource_byname);
  73. /**
  74. * platform_get_irq - get an IRQ for a device
  75. * @dev: platform device
  76. * @name: IRQ name
  77. */
  78. int platform_get_irq_byname(struct platform_device *dev, char *name)
  79. {
  80. struct resource *r = platform_get_resource_byname(dev, IORESOURCE_IRQ,
  81. name);
  82. return r ? r->start : -ENXIO;
  83. }
  84. EXPORT_SYMBOL_GPL(platform_get_irq_byname);
  85. /**
  86. * platform_add_devices - add a numbers of platform devices
  87. * @devs: array of platform devices to add
  88. * @num: number of platform devices in array
  89. */
  90. int platform_add_devices(struct platform_device **devs, int num)
  91. {
  92. int i, ret = 0;
  93. for (i = 0; i < num; i++) {
  94. ret = platform_device_register(devs[i]);
  95. if (ret) {
  96. while (--i >= 0)
  97. platform_device_unregister(devs[i]);
  98. break;
  99. }
  100. }
  101. return ret;
  102. }
  103. EXPORT_SYMBOL_GPL(platform_add_devices);
  104. struct platform_object {
  105. struct platform_device pdev;
  106. char name[1];
  107. };
  108. /**
  109. * platform_device_put
  110. * @pdev: platform device to free
  111. *
  112. * Free all memory associated with a platform device. This function must
  113. * _only_ be externally called in error cases. All other usage is a bug.
  114. */
  115. void platform_device_put(struct platform_device *pdev)
  116. {
  117. if (pdev)
  118. put_device(&pdev->dev);
  119. }
  120. EXPORT_SYMBOL_GPL(platform_device_put);
  121. static void platform_device_release(struct device *dev)
  122. {
  123. struct platform_object *pa = container_of(dev, struct platform_object,
  124. pdev.dev);
  125. kfree(pa->pdev.dev.platform_data);
  126. kfree(pa->pdev.resource);
  127. kfree(pa);
  128. }
  129. /**
  130. * platform_device_alloc
  131. * @name: base name of the device we're adding
  132. * @id: instance id
  133. *
  134. * Create a platform device object which can have other objects attached
  135. * to it, and which will have attached objects freed when it is released.
  136. */
  137. struct platform_device *platform_device_alloc(const char *name, int id)
  138. {
  139. struct platform_object *pa;
  140. pa = kzalloc(sizeof(struct platform_object) + strlen(name), GFP_KERNEL);
  141. if (pa) {
  142. strcpy(pa->name, name);
  143. pa->pdev.name = pa->name;
  144. pa->pdev.id = id;
  145. device_initialize(&pa->pdev.dev);
  146. pa->pdev.dev.release = platform_device_release;
  147. }
  148. return pa ? &pa->pdev : NULL;
  149. }
  150. EXPORT_SYMBOL_GPL(platform_device_alloc);
  151. /**
  152. * platform_device_add_resources
  153. * @pdev: platform device allocated by platform_device_alloc to add resources to
  154. * @res: set of resources that needs to be allocated for the device
  155. * @num: number of resources
  156. *
  157. * Add a copy of the resources to the platform device. The memory
  158. * associated with the resources will be freed when the platform device is
  159. * released.
  160. */
  161. int platform_device_add_resources(struct platform_device *pdev,
  162. struct resource *res, unsigned int num)
  163. {
  164. struct resource *r;
  165. r = kmalloc(sizeof(struct resource) * num, GFP_KERNEL);
  166. if (r) {
  167. memcpy(r, res, sizeof(struct resource) * num);
  168. pdev->resource = r;
  169. pdev->num_resources = num;
  170. }
  171. return r ? 0 : -ENOMEM;
  172. }
  173. EXPORT_SYMBOL_GPL(platform_device_add_resources);
  174. /**
  175. * platform_device_add_data
  176. * @pdev: platform device allocated by platform_device_alloc to add resources to
  177. * @data: platform specific data for this platform device
  178. * @size: size of platform specific data
  179. *
  180. * Add a copy of platform specific data to the platform device's
  181. * platform_data pointer. The memory associated with the platform data
  182. * will be freed when the platform device is released.
  183. */
  184. int platform_device_add_data(struct platform_device *pdev, const void *data,
  185. size_t size)
  186. {
  187. void *d;
  188. d = kmalloc(size, GFP_KERNEL);
  189. if (d) {
  190. memcpy(d, data, size);
  191. pdev->dev.platform_data = d;
  192. }
  193. return d ? 0 : -ENOMEM;
  194. }
  195. EXPORT_SYMBOL_GPL(platform_device_add_data);
  196. /**
  197. * platform_device_add - add a platform device to device hierarchy
  198. * @pdev: platform device we're adding
  199. *
  200. * This is part 2 of platform_device_register(), though may be called
  201. * separately _iff_ pdev was allocated by platform_device_alloc().
  202. */
  203. int platform_device_add(struct platform_device *pdev)
  204. {
  205. int i, ret = 0;
  206. if (!pdev)
  207. return -EINVAL;
  208. if (!pdev->dev.parent)
  209. pdev->dev.parent = &platform_bus;
  210. pdev->dev.bus = &platform_bus_type;
  211. if (pdev->id != -1)
  212. dev_set_name(&pdev->dev, "%s.%d", pdev->name, pdev->id);
  213. else
  214. dev_set_name(&pdev->dev, pdev->name);
  215. for (i = 0; i < pdev->num_resources; i++) {
  216. struct resource *p, *r = &pdev->resource[i];
  217. if (r->name == NULL)
  218. r->name = dev_name(&pdev->dev);
  219. p = r->parent;
  220. if (!p) {
  221. if (resource_type(r) == IORESOURCE_MEM)
  222. p = &iomem_resource;
  223. else if (resource_type(r) == IORESOURCE_IO)
  224. p = &ioport_resource;
  225. }
  226. if (p && insert_resource(p, r)) {
  227. printk(KERN_ERR
  228. "%s: failed to claim resource %d\n",
  229. dev_name(&pdev->dev), i);
  230. ret = -EBUSY;
  231. goto failed;
  232. }
  233. }
  234. pr_debug("Registering platform device '%s'. Parent at %s\n",
  235. dev_name(&pdev->dev), dev_name(pdev->dev.parent));
  236. ret = device_add(&pdev->dev);
  237. if (ret == 0)
  238. return ret;
  239. failed:
  240. while (--i >= 0) {
  241. struct resource *r = &pdev->resource[i];
  242. unsigned long type = resource_type(r);
  243. if (type == IORESOURCE_MEM || type == IORESOURCE_IO)
  244. release_resource(r);
  245. }
  246. return ret;
  247. }
  248. EXPORT_SYMBOL_GPL(platform_device_add);
  249. /**
  250. * platform_device_del - remove a platform-level device
  251. * @pdev: platform device we're removing
  252. *
  253. * Note that this function will also release all memory- and port-based
  254. * resources owned by the device (@dev->resource). This function must
  255. * _only_ be externally called in error cases. All other usage is a bug.
  256. */
  257. void platform_device_del(struct platform_device *pdev)
  258. {
  259. int i;
  260. if (pdev) {
  261. device_del(&pdev->dev);
  262. for (i = 0; i < pdev->num_resources; i++) {
  263. struct resource *r = &pdev->resource[i];
  264. unsigned long type = resource_type(r);
  265. if (type == IORESOURCE_MEM || type == IORESOURCE_IO)
  266. release_resource(r);
  267. }
  268. }
  269. }
  270. EXPORT_SYMBOL_GPL(platform_device_del);
  271. /**
  272. * platform_device_register - add a platform-level device
  273. * @pdev: platform device we're adding
  274. */
  275. int platform_device_register(struct platform_device *pdev)
  276. {
  277. device_initialize(&pdev->dev);
  278. return platform_device_add(pdev);
  279. }
  280. EXPORT_SYMBOL_GPL(platform_device_register);
  281. /**
  282. * platform_device_unregister - unregister a platform-level device
  283. * @pdev: platform device we're unregistering
  284. *
  285. * Unregistration is done in 2 steps. First we release all resources
  286. * and remove it from the subsystem, then we drop reference count by
  287. * calling platform_device_put().
  288. */
  289. void platform_device_unregister(struct platform_device *pdev)
  290. {
  291. platform_device_del(pdev);
  292. platform_device_put(pdev);
  293. }
  294. EXPORT_SYMBOL_GPL(platform_device_unregister);
  295. /**
  296. * platform_device_register_simple
  297. * @name: base name of the device we're adding
  298. * @id: instance id
  299. * @res: set of resources that needs to be allocated for the device
  300. * @num: number of resources
  301. *
  302. * This function creates a simple platform device that requires minimal
  303. * resource and memory management. Canned release function freeing memory
  304. * allocated for the device allows drivers using such devices to be
  305. * unloaded without waiting for the last reference to the device to be
  306. * dropped.
  307. *
  308. * This interface is primarily intended for use with legacy drivers which
  309. * probe hardware directly. Because such drivers create sysfs device nodes
  310. * themselves, rather than letting system infrastructure handle such device
  311. * enumeration tasks, they don't fully conform to the Linux driver model.
  312. * In particular, when such drivers are built as modules, they can't be
  313. * "hotplugged".
  314. */
  315. struct platform_device *platform_device_register_simple(const char *name,
  316. int id,
  317. struct resource *res,
  318. unsigned int num)
  319. {
  320. struct platform_device *pdev;
  321. int retval;
  322. pdev = platform_device_alloc(name, id);
  323. if (!pdev) {
  324. retval = -ENOMEM;
  325. goto error;
  326. }
  327. if (num) {
  328. retval = platform_device_add_resources(pdev, res, num);
  329. if (retval)
  330. goto error;
  331. }
  332. retval = platform_device_add(pdev);
  333. if (retval)
  334. goto error;
  335. return pdev;
  336. error:
  337. platform_device_put(pdev);
  338. return ERR_PTR(retval);
  339. }
  340. EXPORT_SYMBOL_GPL(platform_device_register_simple);
  341. /**
  342. * platform_device_register_data
  343. * @parent: parent device for the device we're adding
  344. * @name: base name of the device we're adding
  345. * @id: instance id
  346. * @data: platform specific data for this platform device
  347. * @size: size of platform specific data
  348. *
  349. * This function creates a simple platform device that requires minimal
  350. * resource and memory management. Canned release function freeing memory
  351. * allocated for the device allows drivers using such devices to be
  352. * unloaded without waiting for the last reference to the device to be
  353. * dropped.
  354. */
  355. struct platform_device *platform_device_register_data(
  356. struct device *parent,
  357. const char *name, int id,
  358. const void *data, size_t size)
  359. {
  360. struct platform_device *pdev;
  361. int retval;
  362. pdev = platform_device_alloc(name, id);
  363. if (!pdev) {
  364. retval = -ENOMEM;
  365. goto error;
  366. }
  367. pdev->dev.parent = parent;
  368. if (size) {
  369. retval = platform_device_add_data(pdev, data, size);
  370. if (retval)
  371. goto error;
  372. }
  373. retval = platform_device_add(pdev);
  374. if (retval)
  375. goto error;
  376. return pdev;
  377. error:
  378. platform_device_put(pdev);
  379. return ERR_PTR(retval);
  380. }
  381. static int platform_drv_probe(struct device *_dev)
  382. {
  383. struct platform_driver *drv = to_platform_driver(_dev->driver);
  384. struct platform_device *dev = to_platform_device(_dev);
  385. return drv->probe(dev);
  386. }
  387. static int platform_drv_probe_fail(struct device *_dev)
  388. {
  389. return -ENXIO;
  390. }
  391. static int platform_drv_remove(struct device *_dev)
  392. {
  393. struct platform_driver *drv = to_platform_driver(_dev->driver);
  394. struct platform_device *dev = to_platform_device(_dev);
  395. return drv->remove(dev);
  396. }
  397. static void platform_drv_shutdown(struct device *_dev)
  398. {
  399. struct platform_driver *drv = to_platform_driver(_dev->driver);
  400. struct platform_device *dev = to_platform_device(_dev);
  401. drv->shutdown(dev);
  402. }
  403. static int platform_drv_suspend(struct device *_dev, pm_message_t state)
  404. {
  405. struct platform_driver *drv = to_platform_driver(_dev->driver);
  406. struct platform_device *dev = to_platform_device(_dev);
  407. return drv->suspend(dev, state);
  408. }
  409. static int platform_drv_resume(struct device *_dev)
  410. {
  411. struct platform_driver *drv = to_platform_driver(_dev->driver);
  412. struct platform_device *dev = to_platform_device(_dev);
  413. return drv->resume(dev);
  414. }
  415. /**
  416. * platform_driver_register
  417. * @drv: platform driver structure
  418. */
  419. int platform_driver_register(struct platform_driver *drv)
  420. {
  421. drv->driver.bus = &platform_bus_type;
  422. if (drv->probe)
  423. drv->driver.probe = platform_drv_probe;
  424. if (drv->remove)
  425. drv->driver.remove = platform_drv_remove;
  426. if (drv->shutdown)
  427. drv->driver.shutdown = platform_drv_shutdown;
  428. if (drv->suspend)
  429. drv->driver.suspend = platform_drv_suspend;
  430. if (drv->resume)
  431. drv->driver.resume = platform_drv_resume;
  432. return driver_register(&drv->driver);
  433. }
  434. EXPORT_SYMBOL_GPL(platform_driver_register);
  435. /**
  436. * platform_driver_unregister
  437. * @drv: platform driver structure
  438. */
  439. void platform_driver_unregister(struct platform_driver *drv)
  440. {
  441. driver_unregister(&drv->driver);
  442. }
  443. EXPORT_SYMBOL_GPL(platform_driver_unregister);
  444. /**
  445. * platform_driver_probe - register driver for non-hotpluggable device
  446. * @drv: platform driver structure
  447. * @probe: the driver probe routine, probably from an __init section
  448. *
  449. * Use this instead of platform_driver_register() when you know the device
  450. * is not hotpluggable and has already been registered, and you want to
  451. * remove its run-once probe() infrastructure from memory after the driver
  452. * has bound to the device.
  453. *
  454. * One typical use for this would be with drivers for controllers integrated
  455. * into system-on-chip processors, where the controller devices have been
  456. * configured as part of board setup.
  457. *
  458. * Returns zero if the driver registered and bound to a device, else returns
  459. * a negative error code and with the driver not registered.
  460. */
  461. int __init_or_module platform_driver_probe(struct platform_driver *drv,
  462. int (*probe)(struct platform_device *))
  463. {
  464. int retval, code;
  465. /* temporary section violation during probe() */
  466. drv->probe = probe;
  467. retval = code = platform_driver_register(drv);
  468. /* Fixup that section violation, being paranoid about code scanning
  469. * the list of drivers in order to probe new devices. Check to see
  470. * if the probe was successful, and make sure any forced probes of
  471. * new devices fail.
  472. */
  473. spin_lock(&platform_bus_type.p->klist_drivers.k_lock);
  474. drv->probe = NULL;
  475. if (code == 0 && list_empty(&drv->driver.p->klist_devices.k_list))
  476. retval = -ENODEV;
  477. drv->driver.probe = platform_drv_probe_fail;
  478. spin_unlock(&platform_bus_type.p->klist_drivers.k_lock);
  479. if (code != retval)
  480. platform_driver_unregister(drv);
  481. return retval;
  482. }
  483. EXPORT_SYMBOL_GPL(platform_driver_probe);
  484. /* modalias support enables more hands-off userspace setup:
  485. * (a) environment variable lets new-style hotplug events work once system is
  486. * fully running: "modprobe $MODALIAS"
  487. * (b) sysfs attribute lets new-style coldplug recover from hotplug events
  488. * mishandled before system is fully running: "modprobe $(cat modalias)"
  489. */
  490. static ssize_t modalias_show(struct device *dev, struct device_attribute *a,
  491. char *buf)
  492. {
  493. struct platform_device *pdev = to_platform_device(dev);
  494. int len = snprintf(buf, PAGE_SIZE, "platform:%s\n", pdev->name);
  495. return (len >= PAGE_SIZE) ? (PAGE_SIZE - 1) : len;
  496. }
  497. static struct device_attribute platform_dev_attrs[] = {
  498. __ATTR_RO(modalias),
  499. __ATTR_NULL,
  500. };
  501. static int platform_uevent(struct device *dev, struct kobj_uevent_env *env)
  502. {
  503. struct platform_device *pdev = to_platform_device(dev);
  504. add_uevent_var(env, "MODALIAS=platform:%s", pdev->name);
  505. return 0;
  506. }
  507. /**
  508. * platform_match - bind platform device to platform driver.
  509. * @dev: device.
  510. * @drv: driver.
  511. *
  512. * Platform device IDs are assumed to be encoded like this:
  513. * "<name><instance>", where <name> is a short description of the type of
  514. * device, like "pci" or "floppy", and <instance> is the enumerated
  515. * instance of the device, like '0' or '42'. Driver IDs are simply
  516. * "<name>". So, extract the <name> from the platform_device structure,
  517. * and compare it against the name of the driver. Return whether they match
  518. * or not.
  519. */
  520. static int platform_match(struct device *dev, struct device_driver *drv)
  521. {
  522. struct platform_device *pdev;
  523. pdev = container_of(dev, struct platform_device, dev);
  524. return (strcmp(pdev->name, drv->name) == 0);
  525. }
  526. #ifdef CONFIG_PM_SLEEP
  527. static int platform_legacy_suspend(struct device *dev, pm_message_t mesg)
  528. {
  529. int ret = 0;
  530. if (dev->driver && dev->driver->suspend)
  531. ret = dev->driver->suspend(dev, mesg);
  532. return ret;
  533. }
  534. static int platform_legacy_suspend_late(struct device *dev, pm_message_t mesg)
  535. {
  536. struct platform_driver *drv = to_platform_driver(dev->driver);
  537. struct platform_device *pdev;
  538. int ret = 0;
  539. pdev = container_of(dev, struct platform_device, dev);
  540. if (dev->driver && drv->suspend_late)
  541. ret = drv->suspend_late(pdev, mesg);
  542. return ret;
  543. }
  544. static int platform_legacy_resume_early(struct device *dev)
  545. {
  546. struct platform_driver *drv = to_platform_driver(dev->driver);
  547. struct platform_device *pdev;
  548. int ret = 0;
  549. pdev = container_of(dev, struct platform_device, dev);
  550. if (dev->driver && drv->resume_early)
  551. ret = drv->resume_early(pdev);
  552. return ret;
  553. }
  554. static int platform_legacy_resume(struct device *dev)
  555. {
  556. int ret = 0;
  557. if (dev->driver && dev->driver->resume)
  558. ret = dev->driver->resume(dev);
  559. return ret;
  560. }
  561. static int platform_pm_prepare(struct device *dev)
  562. {
  563. struct device_driver *drv = dev->driver;
  564. int ret = 0;
  565. if (drv && drv->pm && drv->pm->prepare)
  566. ret = drv->pm->prepare(dev);
  567. return ret;
  568. }
  569. static void platform_pm_complete(struct device *dev)
  570. {
  571. struct device_driver *drv = dev->driver;
  572. if (drv && drv->pm && drv->pm->complete)
  573. drv->pm->complete(dev);
  574. }
  575. #ifdef CONFIG_SUSPEND
  576. static int platform_pm_suspend(struct device *dev)
  577. {
  578. struct device_driver *drv = dev->driver;
  579. int ret = 0;
  580. if (!drv)
  581. return 0;
  582. if (drv->pm) {
  583. if (drv->pm->suspend)
  584. ret = drv->pm->suspend(dev);
  585. } else {
  586. ret = platform_legacy_suspend(dev, PMSG_SUSPEND);
  587. }
  588. return ret;
  589. }
  590. static int platform_pm_suspend_noirq(struct device *dev)
  591. {
  592. struct device_driver *drv = dev->driver;
  593. int ret = 0;
  594. if (!drv)
  595. return 0;
  596. if (drv->pm) {
  597. if (drv->pm->suspend_noirq)
  598. ret = drv->pm->suspend_noirq(dev);
  599. } else {
  600. ret = platform_legacy_suspend_late(dev, PMSG_SUSPEND);
  601. }
  602. return ret;
  603. }
  604. static int platform_pm_resume(struct device *dev)
  605. {
  606. struct device_driver *drv = dev->driver;
  607. int ret = 0;
  608. if (!drv)
  609. return 0;
  610. if (drv->pm) {
  611. if (drv->pm->resume)
  612. ret = drv->pm->resume(dev);
  613. } else {
  614. ret = platform_legacy_resume(dev);
  615. }
  616. return ret;
  617. }
  618. static int platform_pm_resume_noirq(struct device *dev)
  619. {
  620. struct device_driver *drv = dev->driver;
  621. int ret = 0;
  622. if (!drv)
  623. return 0;
  624. if (drv->pm) {
  625. if (drv->pm->resume_noirq)
  626. ret = drv->pm->resume_noirq(dev);
  627. } else {
  628. ret = platform_legacy_resume_early(dev);
  629. }
  630. return ret;
  631. }
  632. #else /* !CONFIG_SUSPEND */
  633. #define platform_pm_suspend NULL
  634. #define platform_pm_resume NULL
  635. #define platform_pm_suspend_noirq NULL
  636. #define platform_pm_resume_noirq NULL
  637. #endif /* !CONFIG_SUSPEND */
  638. #ifdef CONFIG_HIBERNATION
  639. static int platform_pm_freeze(struct device *dev)
  640. {
  641. struct device_driver *drv = dev->driver;
  642. int ret = 0;
  643. if (!drv)
  644. return 0;
  645. if (drv->pm) {
  646. if (drv->pm->freeze)
  647. ret = drv->pm->freeze(dev);
  648. } else {
  649. ret = platform_legacy_suspend(dev, PMSG_FREEZE);
  650. }
  651. return ret;
  652. }
  653. static int platform_pm_freeze_noirq(struct device *dev)
  654. {
  655. struct device_driver *drv = dev->driver;
  656. int ret = 0;
  657. if (!drv)
  658. return 0;
  659. if (drv->pm) {
  660. if (drv->pm->freeze_noirq)
  661. ret = drv->pm->freeze_noirq(dev);
  662. } else {
  663. ret = platform_legacy_suspend_late(dev, PMSG_FREEZE);
  664. }
  665. return ret;
  666. }
  667. static int platform_pm_thaw(struct device *dev)
  668. {
  669. struct device_driver *drv = dev->driver;
  670. int ret = 0;
  671. if (!drv)
  672. return 0;
  673. if (drv->pm) {
  674. if (drv->pm->thaw)
  675. ret = drv->pm->thaw(dev);
  676. } else {
  677. ret = platform_legacy_resume(dev);
  678. }
  679. return ret;
  680. }
  681. static int platform_pm_thaw_noirq(struct device *dev)
  682. {
  683. struct device_driver *drv = dev->driver;
  684. int ret = 0;
  685. if (!drv)
  686. return 0;
  687. if (drv->pm) {
  688. if (drv->pm->thaw_noirq)
  689. ret = drv->pm->thaw_noirq(dev);
  690. } else {
  691. ret = platform_legacy_resume_early(dev);
  692. }
  693. return ret;
  694. }
  695. static int platform_pm_poweroff(struct device *dev)
  696. {
  697. struct device_driver *drv = dev->driver;
  698. int ret = 0;
  699. if (!drv)
  700. return 0;
  701. if (drv->pm) {
  702. if (drv->pm->poweroff)
  703. ret = drv->pm->poweroff(dev);
  704. } else {
  705. ret = platform_legacy_suspend(dev, PMSG_HIBERNATE);
  706. }
  707. return ret;
  708. }
  709. static int platform_pm_poweroff_noirq(struct device *dev)
  710. {
  711. struct device_driver *drv = dev->driver;
  712. int ret = 0;
  713. if (!drv)
  714. return 0;
  715. if (drv->pm) {
  716. if (drv->pm->poweroff_noirq)
  717. ret = drv->pm->poweroff_noirq(dev);
  718. } else {
  719. ret = platform_legacy_suspend_late(dev, PMSG_HIBERNATE);
  720. }
  721. return ret;
  722. }
  723. static int platform_pm_restore(struct device *dev)
  724. {
  725. struct device_driver *drv = dev->driver;
  726. int ret = 0;
  727. if (!drv)
  728. return 0;
  729. if (drv->pm) {
  730. if (drv->pm->restore)
  731. ret = drv->pm->restore(dev);
  732. } else {
  733. ret = platform_legacy_resume(dev);
  734. }
  735. return ret;
  736. }
  737. static int platform_pm_restore_noirq(struct device *dev)
  738. {
  739. struct device_driver *drv = dev->driver;
  740. int ret = 0;
  741. if (!drv)
  742. return 0;
  743. if (drv->pm) {
  744. if (drv->pm->restore_noirq)
  745. ret = drv->pm->restore_noirq(dev);
  746. } else {
  747. ret = platform_legacy_resume_early(dev);
  748. }
  749. return ret;
  750. }
  751. #else /* !CONFIG_HIBERNATION */
  752. #define platform_pm_freeze NULL
  753. #define platform_pm_thaw NULL
  754. #define platform_pm_poweroff NULL
  755. #define platform_pm_restore NULL
  756. #define platform_pm_freeze_noirq NULL
  757. #define platform_pm_thaw_noirq NULL
  758. #define platform_pm_poweroff_noirq NULL
  759. #define platform_pm_restore_noirq NULL
  760. #endif /* !CONFIG_HIBERNATION */
  761. static struct dev_pm_ops platform_dev_pm_ops = {
  762. .prepare = platform_pm_prepare,
  763. .complete = platform_pm_complete,
  764. .suspend = platform_pm_suspend,
  765. .resume = platform_pm_resume,
  766. .freeze = platform_pm_freeze,
  767. .thaw = platform_pm_thaw,
  768. .poweroff = platform_pm_poweroff,
  769. .restore = platform_pm_restore,
  770. .suspend_noirq = platform_pm_suspend_noirq,
  771. .resume_noirq = platform_pm_resume_noirq,
  772. .freeze_noirq = platform_pm_freeze_noirq,
  773. .thaw_noirq = platform_pm_thaw_noirq,
  774. .poweroff_noirq = platform_pm_poweroff_noirq,
  775. .restore_noirq = platform_pm_restore_noirq,
  776. };
  777. #define PLATFORM_PM_OPS_PTR (&platform_dev_pm_ops)
  778. #else /* !CONFIG_PM_SLEEP */
  779. #define PLATFORM_PM_OPS_PTR NULL
  780. #endif /* !CONFIG_PM_SLEEP */
  781. struct bus_type platform_bus_type = {
  782. .name = "platform",
  783. .dev_attrs = platform_dev_attrs,
  784. .match = platform_match,
  785. .uevent = platform_uevent,
  786. .pm = PLATFORM_PM_OPS_PTR,
  787. };
  788. EXPORT_SYMBOL_GPL(platform_bus_type);
  789. int __init platform_bus_init(void)
  790. {
  791. int error;
  792. error = device_register(&platform_bus);
  793. if (error)
  794. return error;
  795. error = bus_register(&platform_bus_type);
  796. if (error)
  797. device_unregister(&platform_bus);
  798. return error;
  799. }
  800. #ifndef ARCH_HAS_DMA_GET_REQUIRED_MASK
  801. u64 dma_get_required_mask(struct device *dev)
  802. {
  803. u32 low_totalram = ((max_pfn - 1) << PAGE_SHIFT);
  804. u32 high_totalram = ((max_pfn - 1) >> (32 - PAGE_SHIFT));
  805. u64 mask;
  806. if (!high_totalram) {
  807. /* convert to mask just covering totalram */
  808. low_totalram = (1 << (fls(low_totalram) - 1));
  809. low_totalram += low_totalram - 1;
  810. mask = low_totalram;
  811. } else {
  812. high_totalram = (1 << (fls(high_totalram) - 1));
  813. high_totalram += high_totalram - 1;
  814. mask = (((u64)high_totalram) << 32) + 0xffffffff;
  815. }
  816. return mask;
  817. }
  818. EXPORT_SYMBOL_GPL(dma_get_required_mask);
  819. #endif