main.c 32 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326
  1. /*
  2. * drivers/base/power/main.c - Where the driver meets power management.
  3. *
  4. * Copyright (c) 2003 Patrick Mochel
  5. * Copyright (c) 2003 Open Source Development Lab
  6. *
  7. * This file is released under the GPLv2
  8. *
  9. *
  10. * The driver model core calls device_pm_add() when a device is registered.
  11. * This will initialize the embedded device_pm_info object in the device
  12. * and add it to the list of power-controlled devices. sysfs entries for
  13. * controlling device power management will also be added.
  14. *
  15. * A separate list is used for keeping track of power info, because the power
  16. * domain dependencies may differ from the ancestral dependencies that the
  17. * subsystem list maintains.
  18. */
  19. #include <linux/device.h>
  20. #include <linux/kallsyms.h>
  21. #include <linux/export.h>
  22. #include <linux/mutex.h>
  23. #include <linux/pm.h>
  24. #include <linux/pm_runtime.h>
  25. #include <linux/resume-trace.h>
  26. #include <linux/interrupt.h>
  27. #include <linux/sched.h>
  28. #include <linux/async.h>
  29. #include <linux/suspend.h>
  30. #include <linux/cpuidle.h>
  31. #include "../base.h"
  32. #include "power.h"
  33. typedef int (*pm_callback_t)(struct device *);
  34. /*
  35. * The entries in the dpm_list list are in a depth first order, simply
  36. * because children are guaranteed to be discovered after parents, and
  37. * are inserted at the back of the list on discovery.
  38. *
  39. * Since device_pm_add() may be called with a device lock held,
  40. * we must never try to acquire a device lock while holding
  41. * dpm_list_mutex.
  42. */
  43. LIST_HEAD(dpm_list);
  44. static LIST_HEAD(dpm_prepared_list);
  45. static LIST_HEAD(dpm_suspended_list);
  46. static LIST_HEAD(dpm_late_early_list);
  47. static LIST_HEAD(dpm_noirq_list);
  48. struct suspend_stats suspend_stats;
  49. static DEFINE_MUTEX(dpm_list_mtx);
  50. static pm_message_t pm_transition;
  51. static int async_error;
  52. /**
  53. * device_pm_init - Initialize the PM-related part of a device object.
  54. * @dev: Device object being initialized.
  55. */
  56. void device_pm_init(struct device *dev)
  57. {
  58. dev->power.is_prepared = false;
  59. dev->power.is_suspended = false;
  60. init_completion(&dev->power.completion);
  61. complete_all(&dev->power.completion);
  62. dev->power.wakeup = NULL;
  63. spin_lock_init(&dev->power.lock);
  64. pm_runtime_init(dev);
  65. INIT_LIST_HEAD(&dev->power.entry);
  66. dev->power.power_state = PMSG_INVALID;
  67. }
  68. /**
  69. * device_pm_lock - Lock the list of active devices used by the PM core.
  70. */
  71. void device_pm_lock(void)
  72. {
  73. mutex_lock(&dpm_list_mtx);
  74. }
  75. /**
  76. * device_pm_unlock - Unlock the list of active devices used by the PM core.
  77. */
  78. void device_pm_unlock(void)
  79. {
  80. mutex_unlock(&dpm_list_mtx);
  81. }
  82. /**
  83. * device_pm_add - Add a device to the PM core's list of active devices.
  84. * @dev: Device to add to the list.
  85. */
  86. void device_pm_add(struct device *dev)
  87. {
  88. pr_debug("PM: Adding info for %s:%s\n",
  89. dev->bus ? dev->bus->name : "No Bus", dev_name(dev));
  90. mutex_lock(&dpm_list_mtx);
  91. if (dev->parent && dev->parent->power.is_prepared)
  92. dev_warn(dev, "parent %s should not be sleeping\n",
  93. dev_name(dev->parent));
  94. list_add_tail(&dev->power.entry, &dpm_list);
  95. dev_pm_qos_constraints_init(dev);
  96. mutex_unlock(&dpm_list_mtx);
  97. }
  98. /**
  99. * device_pm_remove - Remove a device from the PM core's list of active devices.
  100. * @dev: Device to be removed from the list.
  101. */
  102. void device_pm_remove(struct device *dev)
  103. {
  104. pr_debug("PM: Removing info for %s:%s\n",
  105. dev->bus ? dev->bus->name : "No Bus", dev_name(dev));
  106. complete_all(&dev->power.completion);
  107. mutex_lock(&dpm_list_mtx);
  108. dev_pm_qos_constraints_destroy(dev);
  109. list_del_init(&dev->power.entry);
  110. mutex_unlock(&dpm_list_mtx);
  111. device_wakeup_disable(dev);
  112. pm_runtime_remove(dev);
  113. }
  114. /**
  115. * device_pm_move_before - Move device in the PM core's list of active devices.
  116. * @deva: Device to move in dpm_list.
  117. * @devb: Device @deva should come before.
  118. */
  119. void device_pm_move_before(struct device *deva, struct device *devb)
  120. {
  121. pr_debug("PM: Moving %s:%s before %s:%s\n",
  122. deva->bus ? deva->bus->name : "No Bus", dev_name(deva),
  123. devb->bus ? devb->bus->name : "No Bus", dev_name(devb));
  124. /* Delete deva from dpm_list and reinsert before devb. */
  125. list_move_tail(&deva->power.entry, &devb->power.entry);
  126. }
  127. /**
  128. * device_pm_move_after - Move device in the PM core's list of active devices.
  129. * @deva: Device to move in dpm_list.
  130. * @devb: Device @deva should come after.
  131. */
  132. void device_pm_move_after(struct device *deva, struct device *devb)
  133. {
  134. pr_debug("PM: Moving %s:%s after %s:%s\n",
  135. deva->bus ? deva->bus->name : "No Bus", dev_name(deva),
  136. devb->bus ? devb->bus->name : "No Bus", dev_name(devb));
  137. /* Delete deva from dpm_list and reinsert after devb. */
  138. list_move(&deva->power.entry, &devb->power.entry);
  139. }
  140. /**
  141. * device_pm_move_last - Move device to end of the PM core's list of devices.
  142. * @dev: Device to move in dpm_list.
  143. */
  144. void device_pm_move_last(struct device *dev)
  145. {
  146. pr_debug("PM: Moving %s:%s to end of list\n",
  147. dev->bus ? dev->bus->name : "No Bus", dev_name(dev));
  148. list_move_tail(&dev->power.entry, &dpm_list);
  149. }
  150. static ktime_t initcall_debug_start(struct device *dev)
  151. {
  152. ktime_t calltime = ktime_set(0, 0);
  153. if (pm_print_times_enabled) {
  154. pr_info("calling %s+ @ %i, parent: %s\n",
  155. dev_name(dev), task_pid_nr(current),
  156. dev->parent ? dev_name(dev->parent) : "none");
  157. calltime = ktime_get();
  158. }
  159. return calltime;
  160. }
  161. static void initcall_debug_report(struct device *dev, ktime_t calltime,
  162. int error)
  163. {
  164. ktime_t delta, rettime;
  165. if (pm_print_times_enabled) {
  166. rettime = ktime_get();
  167. delta = ktime_sub(rettime, calltime);
  168. pr_info("call %s+ returned %d after %Ld usecs\n", dev_name(dev),
  169. error, (unsigned long long)ktime_to_ns(delta) >> 10);
  170. }
  171. }
  172. /**
  173. * dpm_wait - Wait for a PM operation to complete.
  174. * @dev: Device to wait for.
  175. * @async: If unset, wait only if the device's power.async_suspend flag is set.
  176. */
  177. static void dpm_wait(struct device *dev, bool async)
  178. {
  179. if (!dev)
  180. return;
  181. if (async || (pm_async_enabled && dev->power.async_suspend))
  182. wait_for_completion(&dev->power.completion);
  183. }
  184. static int dpm_wait_fn(struct device *dev, void *async_ptr)
  185. {
  186. dpm_wait(dev, *((bool *)async_ptr));
  187. return 0;
  188. }
  189. static void dpm_wait_for_children(struct device *dev, bool async)
  190. {
  191. device_for_each_child(dev, &async, dpm_wait_fn);
  192. }
  193. /**
  194. * pm_op - Return the PM operation appropriate for given PM event.
  195. * @ops: PM operations to choose from.
  196. * @state: PM transition of the system being carried out.
  197. */
  198. static pm_callback_t pm_op(const struct dev_pm_ops *ops, pm_message_t state)
  199. {
  200. switch (state.event) {
  201. #ifdef CONFIG_SUSPEND
  202. case PM_EVENT_SUSPEND:
  203. return ops->suspend;
  204. case PM_EVENT_RESUME:
  205. return ops->resume;
  206. #endif /* CONFIG_SUSPEND */
  207. #ifdef CONFIG_HIBERNATE_CALLBACKS
  208. case PM_EVENT_FREEZE:
  209. case PM_EVENT_QUIESCE:
  210. return ops->freeze;
  211. case PM_EVENT_HIBERNATE:
  212. return ops->poweroff;
  213. case PM_EVENT_THAW:
  214. case PM_EVENT_RECOVER:
  215. return ops->thaw;
  216. break;
  217. case PM_EVENT_RESTORE:
  218. return ops->restore;
  219. #endif /* CONFIG_HIBERNATE_CALLBACKS */
  220. }
  221. return NULL;
  222. }
  223. /**
  224. * pm_late_early_op - Return the PM operation appropriate for given PM event.
  225. * @ops: PM operations to choose from.
  226. * @state: PM transition of the system being carried out.
  227. *
  228. * Runtime PM is disabled for @dev while this function is being executed.
  229. */
  230. static pm_callback_t pm_late_early_op(const struct dev_pm_ops *ops,
  231. pm_message_t state)
  232. {
  233. switch (state.event) {
  234. #ifdef CONFIG_SUSPEND
  235. case PM_EVENT_SUSPEND:
  236. return ops->suspend_late;
  237. case PM_EVENT_RESUME:
  238. return ops->resume_early;
  239. #endif /* CONFIG_SUSPEND */
  240. #ifdef CONFIG_HIBERNATE_CALLBACKS
  241. case PM_EVENT_FREEZE:
  242. case PM_EVENT_QUIESCE:
  243. return ops->freeze_late;
  244. case PM_EVENT_HIBERNATE:
  245. return ops->poweroff_late;
  246. case PM_EVENT_THAW:
  247. case PM_EVENT_RECOVER:
  248. return ops->thaw_early;
  249. case PM_EVENT_RESTORE:
  250. return ops->restore_early;
  251. #endif /* CONFIG_HIBERNATE_CALLBACKS */
  252. }
  253. return NULL;
  254. }
  255. /**
  256. * pm_noirq_op - Return the PM operation appropriate for given PM event.
  257. * @ops: PM operations to choose from.
  258. * @state: PM transition of the system being carried out.
  259. *
  260. * The driver of @dev will not receive interrupts while this function is being
  261. * executed.
  262. */
  263. static pm_callback_t pm_noirq_op(const struct dev_pm_ops *ops, pm_message_t state)
  264. {
  265. switch (state.event) {
  266. #ifdef CONFIG_SUSPEND
  267. case PM_EVENT_SUSPEND:
  268. return ops->suspend_noirq;
  269. case PM_EVENT_RESUME:
  270. return ops->resume_noirq;
  271. #endif /* CONFIG_SUSPEND */
  272. #ifdef CONFIG_HIBERNATE_CALLBACKS
  273. case PM_EVENT_FREEZE:
  274. case PM_EVENT_QUIESCE:
  275. return ops->freeze_noirq;
  276. case PM_EVENT_HIBERNATE:
  277. return ops->poweroff_noirq;
  278. case PM_EVENT_THAW:
  279. case PM_EVENT_RECOVER:
  280. return ops->thaw_noirq;
  281. case PM_EVENT_RESTORE:
  282. return ops->restore_noirq;
  283. #endif /* CONFIG_HIBERNATE_CALLBACKS */
  284. }
  285. return NULL;
  286. }
  287. static char *pm_verb(int event)
  288. {
  289. switch (event) {
  290. case PM_EVENT_SUSPEND:
  291. return "suspend";
  292. case PM_EVENT_RESUME:
  293. return "resume";
  294. case PM_EVENT_FREEZE:
  295. return "freeze";
  296. case PM_EVENT_QUIESCE:
  297. return "quiesce";
  298. case PM_EVENT_HIBERNATE:
  299. return "hibernate";
  300. case PM_EVENT_THAW:
  301. return "thaw";
  302. case PM_EVENT_RESTORE:
  303. return "restore";
  304. case PM_EVENT_RECOVER:
  305. return "recover";
  306. default:
  307. return "(unknown PM event)";
  308. }
  309. }
  310. static void pm_dev_dbg(struct device *dev, pm_message_t state, char *info)
  311. {
  312. dev_dbg(dev, "%s%s%s\n", info, pm_verb(state.event),
  313. ((state.event & PM_EVENT_SLEEP) && device_may_wakeup(dev)) ?
  314. ", may wakeup" : "");
  315. }
  316. static void pm_dev_err(struct device *dev, pm_message_t state, char *info,
  317. int error)
  318. {
  319. printk(KERN_ERR "PM: Device %s failed to %s%s: error %d\n",
  320. dev_name(dev), pm_verb(state.event), info, error);
  321. }
  322. static void dpm_show_time(ktime_t starttime, pm_message_t state, char *info)
  323. {
  324. ktime_t calltime;
  325. u64 usecs64;
  326. int usecs;
  327. calltime = ktime_get();
  328. usecs64 = ktime_to_ns(ktime_sub(calltime, starttime));
  329. do_div(usecs64, NSEC_PER_USEC);
  330. usecs = usecs64;
  331. if (usecs == 0)
  332. usecs = 1;
  333. pr_info("PM: %s%s%s of devices complete after %ld.%03ld msecs\n",
  334. info ?: "", info ? " " : "", pm_verb(state.event),
  335. usecs / USEC_PER_MSEC, usecs % USEC_PER_MSEC);
  336. }
  337. static int dpm_run_callback(pm_callback_t cb, struct device *dev,
  338. pm_message_t state, char *info)
  339. {
  340. ktime_t calltime;
  341. int error;
  342. if (!cb)
  343. return 0;
  344. calltime = initcall_debug_start(dev);
  345. pm_dev_dbg(dev, state, info);
  346. error = cb(dev);
  347. suspend_report_result(cb, error);
  348. initcall_debug_report(dev, calltime, error);
  349. return error;
  350. }
  351. /*------------------------- Resume routines -------------------------*/
  352. /**
  353. * device_resume_noirq - Execute an "early resume" callback for given device.
  354. * @dev: Device to handle.
  355. * @state: PM transition of the system being carried out.
  356. *
  357. * The driver of @dev will not receive interrupts while this function is being
  358. * executed.
  359. */
  360. static int device_resume_noirq(struct device *dev, pm_message_t state)
  361. {
  362. pm_callback_t callback = NULL;
  363. char *info = NULL;
  364. int error = 0;
  365. TRACE_DEVICE(dev);
  366. TRACE_RESUME(0);
  367. if (dev->pm_domain) {
  368. info = "noirq power domain ";
  369. callback = pm_noirq_op(&dev->pm_domain->ops, state);
  370. } else if (dev->type && dev->type->pm) {
  371. info = "noirq type ";
  372. callback = pm_noirq_op(dev->type->pm, state);
  373. } else if (dev->class && dev->class->pm) {
  374. info = "noirq class ";
  375. callback = pm_noirq_op(dev->class->pm, state);
  376. } else if (dev->bus && dev->bus->pm) {
  377. info = "noirq bus ";
  378. callback = pm_noirq_op(dev->bus->pm, state);
  379. }
  380. if (!callback && dev->driver && dev->driver->pm) {
  381. info = "noirq driver ";
  382. callback = pm_noirq_op(dev->driver->pm, state);
  383. }
  384. error = dpm_run_callback(callback, dev, state, info);
  385. TRACE_RESUME(error);
  386. return error;
  387. }
  388. /**
  389. * dpm_resume_noirq - Execute "noirq resume" callbacks for all devices.
  390. * @state: PM transition of the system being carried out.
  391. *
  392. * Call the "noirq" resume handlers for all devices in dpm_noirq_list and
  393. * enable device drivers to receive interrupts.
  394. */
  395. static void dpm_resume_noirq(pm_message_t state)
  396. {
  397. ktime_t starttime = ktime_get();
  398. mutex_lock(&dpm_list_mtx);
  399. while (!list_empty(&dpm_noirq_list)) {
  400. struct device *dev = to_device(dpm_noirq_list.next);
  401. int error;
  402. get_device(dev);
  403. list_move_tail(&dev->power.entry, &dpm_late_early_list);
  404. mutex_unlock(&dpm_list_mtx);
  405. error = device_resume_noirq(dev, state);
  406. if (error) {
  407. suspend_stats.failed_resume_noirq++;
  408. dpm_save_failed_step(SUSPEND_RESUME_NOIRQ);
  409. dpm_save_failed_dev(dev_name(dev));
  410. pm_dev_err(dev, state, " noirq", error);
  411. }
  412. mutex_lock(&dpm_list_mtx);
  413. put_device(dev);
  414. }
  415. mutex_unlock(&dpm_list_mtx);
  416. dpm_show_time(starttime, state, "noirq");
  417. resume_device_irqs();
  418. cpuidle_resume();
  419. }
  420. /**
  421. * device_resume_early - Execute an "early resume" callback for given device.
  422. * @dev: Device to handle.
  423. * @state: PM transition of the system being carried out.
  424. *
  425. * Runtime PM is disabled for @dev while this function is being executed.
  426. */
  427. static int device_resume_early(struct device *dev, pm_message_t state)
  428. {
  429. pm_callback_t callback = NULL;
  430. char *info = NULL;
  431. int error = 0;
  432. TRACE_DEVICE(dev);
  433. TRACE_RESUME(0);
  434. if (dev->pm_domain) {
  435. info = "early power domain ";
  436. callback = pm_late_early_op(&dev->pm_domain->ops, state);
  437. } else if (dev->type && dev->type->pm) {
  438. info = "early type ";
  439. callback = pm_late_early_op(dev->type->pm, state);
  440. } else if (dev->class && dev->class->pm) {
  441. info = "early class ";
  442. callback = pm_late_early_op(dev->class->pm, state);
  443. } else if (dev->bus && dev->bus->pm) {
  444. info = "early bus ";
  445. callback = pm_late_early_op(dev->bus->pm, state);
  446. }
  447. if (!callback && dev->driver && dev->driver->pm) {
  448. info = "early driver ";
  449. callback = pm_late_early_op(dev->driver->pm, state);
  450. }
  451. error = dpm_run_callback(callback, dev, state, info);
  452. TRACE_RESUME(error);
  453. return error;
  454. }
  455. /**
  456. * dpm_resume_early - Execute "early resume" callbacks for all devices.
  457. * @state: PM transition of the system being carried out.
  458. */
  459. static void dpm_resume_early(pm_message_t state)
  460. {
  461. ktime_t starttime = ktime_get();
  462. mutex_lock(&dpm_list_mtx);
  463. while (!list_empty(&dpm_late_early_list)) {
  464. struct device *dev = to_device(dpm_late_early_list.next);
  465. int error;
  466. get_device(dev);
  467. list_move_tail(&dev->power.entry, &dpm_suspended_list);
  468. mutex_unlock(&dpm_list_mtx);
  469. error = device_resume_early(dev, state);
  470. if (error) {
  471. suspend_stats.failed_resume_early++;
  472. dpm_save_failed_step(SUSPEND_RESUME_EARLY);
  473. dpm_save_failed_dev(dev_name(dev));
  474. pm_dev_err(dev, state, " early", error);
  475. }
  476. mutex_lock(&dpm_list_mtx);
  477. put_device(dev);
  478. }
  479. mutex_unlock(&dpm_list_mtx);
  480. dpm_show_time(starttime, state, "early");
  481. }
  482. /**
  483. * dpm_resume_start - Execute "noirq" and "early" device callbacks.
  484. * @state: PM transition of the system being carried out.
  485. */
  486. void dpm_resume_start(pm_message_t state)
  487. {
  488. dpm_resume_noirq(state);
  489. dpm_resume_early(state);
  490. }
  491. EXPORT_SYMBOL_GPL(dpm_resume_start);
  492. /**
  493. * device_resume - Execute "resume" callbacks for given device.
  494. * @dev: Device to handle.
  495. * @state: PM transition of the system being carried out.
  496. * @async: If true, the device is being resumed asynchronously.
  497. */
  498. static int device_resume(struct device *dev, pm_message_t state, bool async)
  499. {
  500. pm_callback_t callback = NULL;
  501. char *info = NULL;
  502. int error = 0;
  503. bool put = false;
  504. TRACE_DEVICE(dev);
  505. TRACE_RESUME(0);
  506. dpm_wait(dev->parent, async);
  507. device_lock(dev);
  508. /*
  509. * This is a fib. But we'll allow new children to be added below
  510. * a resumed device, even if the device hasn't been completed yet.
  511. */
  512. dev->power.is_prepared = false;
  513. if (!dev->power.is_suspended)
  514. goto Unlock;
  515. pm_runtime_enable(dev);
  516. put = true;
  517. if (dev->pm_domain) {
  518. info = "power domain ";
  519. callback = pm_op(&dev->pm_domain->ops, state);
  520. goto Driver;
  521. }
  522. if (dev->type && dev->type->pm) {
  523. info = "type ";
  524. callback = pm_op(dev->type->pm, state);
  525. goto Driver;
  526. }
  527. if (dev->class) {
  528. if (dev->class->pm) {
  529. info = "class ";
  530. callback = pm_op(dev->class->pm, state);
  531. goto Driver;
  532. } else if (dev->class->resume) {
  533. info = "legacy class ";
  534. callback = dev->class->resume;
  535. goto End;
  536. }
  537. }
  538. if (dev->bus) {
  539. if (dev->bus->pm) {
  540. info = "bus ";
  541. callback = pm_op(dev->bus->pm, state);
  542. } else if (dev->bus->resume) {
  543. info = "legacy bus ";
  544. callback = dev->bus->resume;
  545. goto End;
  546. }
  547. }
  548. Driver:
  549. if (!callback && dev->driver && dev->driver->pm) {
  550. info = "driver ";
  551. callback = pm_op(dev->driver->pm, state);
  552. }
  553. End:
  554. error = dpm_run_callback(callback, dev, state, info);
  555. dev->power.is_suspended = false;
  556. Unlock:
  557. device_unlock(dev);
  558. complete_all(&dev->power.completion);
  559. TRACE_RESUME(error);
  560. if (put)
  561. pm_runtime_put_sync(dev);
  562. return error;
  563. }
  564. static void async_resume(void *data, async_cookie_t cookie)
  565. {
  566. struct device *dev = (struct device *)data;
  567. int error;
  568. error = device_resume(dev, pm_transition, true);
  569. if (error)
  570. pm_dev_err(dev, pm_transition, " async", error);
  571. put_device(dev);
  572. }
  573. static bool is_async(struct device *dev)
  574. {
  575. return dev->power.async_suspend && pm_async_enabled
  576. && !pm_trace_is_enabled();
  577. }
  578. /**
  579. * dpm_resume - Execute "resume" callbacks for non-sysdev devices.
  580. * @state: PM transition of the system being carried out.
  581. *
  582. * Execute the appropriate "resume" callback for all devices whose status
  583. * indicates that they are suspended.
  584. */
  585. void dpm_resume(pm_message_t state)
  586. {
  587. struct device *dev;
  588. ktime_t starttime = ktime_get();
  589. might_sleep();
  590. mutex_lock(&dpm_list_mtx);
  591. pm_transition = state;
  592. async_error = 0;
  593. list_for_each_entry(dev, &dpm_suspended_list, power.entry) {
  594. INIT_COMPLETION(dev->power.completion);
  595. if (is_async(dev)) {
  596. get_device(dev);
  597. async_schedule(async_resume, dev);
  598. }
  599. }
  600. while (!list_empty(&dpm_suspended_list)) {
  601. dev = to_device(dpm_suspended_list.next);
  602. get_device(dev);
  603. if (!is_async(dev)) {
  604. int error;
  605. mutex_unlock(&dpm_list_mtx);
  606. error = device_resume(dev, state, false);
  607. if (error) {
  608. suspend_stats.failed_resume++;
  609. dpm_save_failed_step(SUSPEND_RESUME);
  610. dpm_save_failed_dev(dev_name(dev));
  611. pm_dev_err(dev, state, "", error);
  612. }
  613. mutex_lock(&dpm_list_mtx);
  614. }
  615. if (!list_empty(&dev->power.entry))
  616. list_move_tail(&dev->power.entry, &dpm_prepared_list);
  617. put_device(dev);
  618. }
  619. mutex_unlock(&dpm_list_mtx);
  620. async_synchronize_full();
  621. dpm_show_time(starttime, state, NULL);
  622. }
  623. /**
  624. * device_complete - Complete a PM transition for given device.
  625. * @dev: Device to handle.
  626. * @state: PM transition of the system being carried out.
  627. */
  628. static void device_complete(struct device *dev, pm_message_t state)
  629. {
  630. void (*callback)(struct device *) = NULL;
  631. char *info = NULL;
  632. device_lock(dev);
  633. if (dev->pm_domain) {
  634. info = "completing power domain ";
  635. callback = dev->pm_domain->ops.complete;
  636. } else if (dev->type && dev->type->pm) {
  637. info = "completing type ";
  638. callback = dev->type->pm->complete;
  639. } else if (dev->class && dev->class->pm) {
  640. info = "completing class ";
  641. callback = dev->class->pm->complete;
  642. } else if (dev->bus && dev->bus->pm) {
  643. info = "completing bus ";
  644. callback = dev->bus->pm->complete;
  645. }
  646. if (!callback && dev->driver && dev->driver->pm) {
  647. info = "completing driver ";
  648. callback = dev->driver->pm->complete;
  649. }
  650. if (callback) {
  651. pm_dev_dbg(dev, state, info);
  652. callback(dev);
  653. }
  654. device_unlock(dev);
  655. }
  656. /**
  657. * dpm_complete - Complete a PM transition for all non-sysdev devices.
  658. * @state: PM transition of the system being carried out.
  659. *
  660. * Execute the ->complete() callbacks for all devices whose PM status is not
  661. * DPM_ON (this allows new devices to be registered).
  662. */
  663. void dpm_complete(pm_message_t state)
  664. {
  665. struct list_head list;
  666. might_sleep();
  667. INIT_LIST_HEAD(&list);
  668. mutex_lock(&dpm_list_mtx);
  669. while (!list_empty(&dpm_prepared_list)) {
  670. struct device *dev = to_device(dpm_prepared_list.prev);
  671. get_device(dev);
  672. dev->power.is_prepared = false;
  673. list_move(&dev->power.entry, &list);
  674. mutex_unlock(&dpm_list_mtx);
  675. device_complete(dev, state);
  676. mutex_lock(&dpm_list_mtx);
  677. put_device(dev);
  678. }
  679. list_splice(&list, &dpm_list);
  680. mutex_unlock(&dpm_list_mtx);
  681. }
  682. /**
  683. * dpm_resume_end - Execute "resume" callbacks and complete system transition.
  684. * @state: PM transition of the system being carried out.
  685. *
  686. * Execute "resume" callbacks for all devices and complete the PM transition of
  687. * the system.
  688. */
  689. void dpm_resume_end(pm_message_t state)
  690. {
  691. dpm_resume(state);
  692. dpm_complete(state);
  693. }
  694. EXPORT_SYMBOL_GPL(dpm_resume_end);
  695. /*------------------------- Suspend routines -------------------------*/
  696. /**
  697. * resume_event - Return a "resume" message for given "suspend" sleep state.
  698. * @sleep_state: PM message representing a sleep state.
  699. *
  700. * Return a PM message representing the resume event corresponding to given
  701. * sleep state.
  702. */
  703. static pm_message_t resume_event(pm_message_t sleep_state)
  704. {
  705. switch (sleep_state.event) {
  706. case PM_EVENT_SUSPEND:
  707. return PMSG_RESUME;
  708. case PM_EVENT_FREEZE:
  709. case PM_EVENT_QUIESCE:
  710. return PMSG_RECOVER;
  711. case PM_EVENT_HIBERNATE:
  712. return PMSG_RESTORE;
  713. }
  714. return PMSG_ON;
  715. }
  716. /**
  717. * device_suspend_noirq - Execute a "late suspend" callback for given device.
  718. * @dev: Device to handle.
  719. * @state: PM transition of the system being carried out.
  720. *
  721. * The driver of @dev will not receive interrupts while this function is being
  722. * executed.
  723. */
  724. static int device_suspend_noirq(struct device *dev, pm_message_t state)
  725. {
  726. pm_callback_t callback = NULL;
  727. char *info = NULL;
  728. if (dev->pm_domain) {
  729. info = "noirq power domain ";
  730. callback = pm_noirq_op(&dev->pm_domain->ops, state);
  731. } else if (dev->type && dev->type->pm) {
  732. info = "noirq type ";
  733. callback = pm_noirq_op(dev->type->pm, state);
  734. } else if (dev->class && dev->class->pm) {
  735. info = "noirq class ";
  736. callback = pm_noirq_op(dev->class->pm, state);
  737. } else if (dev->bus && dev->bus->pm) {
  738. info = "noirq bus ";
  739. callback = pm_noirq_op(dev->bus->pm, state);
  740. }
  741. if (!callback && dev->driver && dev->driver->pm) {
  742. info = "noirq driver ";
  743. callback = pm_noirq_op(dev->driver->pm, state);
  744. }
  745. return dpm_run_callback(callback, dev, state, info);
  746. }
  747. /**
  748. * dpm_suspend_noirq - Execute "noirq suspend" callbacks for all devices.
  749. * @state: PM transition of the system being carried out.
  750. *
  751. * Prevent device drivers from receiving interrupts and call the "noirq" suspend
  752. * handlers for all non-sysdev devices.
  753. */
  754. static int dpm_suspend_noirq(pm_message_t state)
  755. {
  756. ktime_t starttime = ktime_get();
  757. int error = 0;
  758. cpuidle_pause();
  759. suspend_device_irqs();
  760. mutex_lock(&dpm_list_mtx);
  761. while (!list_empty(&dpm_late_early_list)) {
  762. struct device *dev = to_device(dpm_late_early_list.prev);
  763. get_device(dev);
  764. mutex_unlock(&dpm_list_mtx);
  765. error = device_suspend_noirq(dev, state);
  766. mutex_lock(&dpm_list_mtx);
  767. if (error) {
  768. pm_dev_err(dev, state, " noirq", error);
  769. suspend_stats.failed_suspend_noirq++;
  770. dpm_save_failed_step(SUSPEND_SUSPEND_NOIRQ);
  771. dpm_save_failed_dev(dev_name(dev));
  772. put_device(dev);
  773. break;
  774. }
  775. if (!list_empty(&dev->power.entry))
  776. list_move(&dev->power.entry, &dpm_noirq_list);
  777. put_device(dev);
  778. if (pm_wakeup_pending()) {
  779. error = -EBUSY;
  780. break;
  781. }
  782. }
  783. mutex_unlock(&dpm_list_mtx);
  784. if (error)
  785. dpm_resume_noirq(resume_event(state));
  786. else
  787. dpm_show_time(starttime, state, "noirq");
  788. return error;
  789. }
  790. /**
  791. * device_suspend_late - Execute a "late suspend" callback for given device.
  792. * @dev: Device to handle.
  793. * @state: PM transition of the system being carried out.
  794. *
  795. * Runtime PM is disabled for @dev while this function is being executed.
  796. */
  797. static int device_suspend_late(struct device *dev, pm_message_t state)
  798. {
  799. pm_callback_t callback = NULL;
  800. char *info = NULL;
  801. if (dev->pm_domain) {
  802. info = "late power domain ";
  803. callback = pm_late_early_op(&dev->pm_domain->ops, state);
  804. } else if (dev->type && dev->type->pm) {
  805. info = "late type ";
  806. callback = pm_late_early_op(dev->type->pm, state);
  807. } else if (dev->class && dev->class->pm) {
  808. info = "late class ";
  809. callback = pm_late_early_op(dev->class->pm, state);
  810. } else if (dev->bus && dev->bus->pm) {
  811. info = "late bus ";
  812. callback = pm_late_early_op(dev->bus->pm, state);
  813. }
  814. if (!callback && dev->driver && dev->driver->pm) {
  815. info = "late driver ";
  816. callback = pm_late_early_op(dev->driver->pm, state);
  817. }
  818. return dpm_run_callback(callback, dev, state, info);
  819. }
  820. /**
  821. * dpm_suspend_late - Execute "late suspend" callbacks for all devices.
  822. * @state: PM transition of the system being carried out.
  823. */
  824. static int dpm_suspend_late(pm_message_t state)
  825. {
  826. ktime_t starttime = ktime_get();
  827. int error = 0;
  828. mutex_lock(&dpm_list_mtx);
  829. while (!list_empty(&dpm_suspended_list)) {
  830. struct device *dev = to_device(dpm_suspended_list.prev);
  831. get_device(dev);
  832. mutex_unlock(&dpm_list_mtx);
  833. error = device_suspend_late(dev, state);
  834. mutex_lock(&dpm_list_mtx);
  835. if (error) {
  836. pm_dev_err(dev, state, " late", error);
  837. suspend_stats.failed_suspend_late++;
  838. dpm_save_failed_step(SUSPEND_SUSPEND_LATE);
  839. dpm_save_failed_dev(dev_name(dev));
  840. put_device(dev);
  841. break;
  842. }
  843. if (!list_empty(&dev->power.entry))
  844. list_move(&dev->power.entry, &dpm_late_early_list);
  845. put_device(dev);
  846. if (pm_wakeup_pending()) {
  847. error = -EBUSY;
  848. break;
  849. }
  850. }
  851. mutex_unlock(&dpm_list_mtx);
  852. if (error)
  853. dpm_resume_early(resume_event(state));
  854. else
  855. dpm_show_time(starttime, state, "late");
  856. return error;
  857. }
  858. /**
  859. * dpm_suspend_end - Execute "late" and "noirq" device suspend callbacks.
  860. * @state: PM transition of the system being carried out.
  861. */
  862. int dpm_suspend_end(pm_message_t state)
  863. {
  864. int error = dpm_suspend_late(state);
  865. if (error)
  866. return error;
  867. error = dpm_suspend_noirq(state);
  868. if (error) {
  869. dpm_resume_early(state);
  870. return error;
  871. }
  872. return 0;
  873. }
  874. EXPORT_SYMBOL_GPL(dpm_suspend_end);
  875. /**
  876. * legacy_suspend - Execute a legacy (bus or class) suspend callback for device.
  877. * @dev: Device to suspend.
  878. * @state: PM transition of the system being carried out.
  879. * @cb: Suspend callback to execute.
  880. */
  881. static int legacy_suspend(struct device *dev, pm_message_t state,
  882. int (*cb)(struct device *dev, pm_message_t state))
  883. {
  884. int error;
  885. ktime_t calltime;
  886. calltime = initcall_debug_start(dev);
  887. error = cb(dev, state);
  888. suspend_report_result(cb, error);
  889. initcall_debug_report(dev, calltime, error);
  890. return error;
  891. }
  892. /**
  893. * device_suspend - Execute "suspend" callbacks for given device.
  894. * @dev: Device to handle.
  895. * @state: PM transition of the system being carried out.
  896. * @async: If true, the device is being suspended asynchronously.
  897. */
  898. static int __device_suspend(struct device *dev, pm_message_t state, bool async)
  899. {
  900. pm_callback_t callback = NULL;
  901. char *info = NULL;
  902. int error = 0;
  903. dpm_wait_for_children(dev, async);
  904. if (async_error)
  905. goto Complete;
  906. pm_runtime_get_noresume(dev);
  907. if (pm_runtime_barrier(dev) && device_may_wakeup(dev))
  908. pm_wakeup_event(dev, 0);
  909. if (pm_wakeup_pending()) {
  910. pm_runtime_put_sync(dev);
  911. async_error = -EBUSY;
  912. goto Complete;
  913. }
  914. device_lock(dev);
  915. if (dev->pm_domain) {
  916. info = "power domain ";
  917. callback = pm_op(&dev->pm_domain->ops, state);
  918. goto Run;
  919. }
  920. if (dev->type && dev->type->pm) {
  921. info = "type ";
  922. callback = pm_op(dev->type->pm, state);
  923. goto Run;
  924. }
  925. if (dev->class) {
  926. if (dev->class->pm) {
  927. info = "class ";
  928. callback = pm_op(dev->class->pm, state);
  929. goto Run;
  930. } else if (dev->class->suspend) {
  931. pm_dev_dbg(dev, state, "legacy class ");
  932. error = legacy_suspend(dev, state, dev->class->suspend);
  933. goto End;
  934. }
  935. }
  936. if (dev->bus) {
  937. if (dev->bus->pm) {
  938. info = "bus ";
  939. callback = pm_op(dev->bus->pm, state);
  940. } else if (dev->bus->suspend) {
  941. pm_dev_dbg(dev, state, "legacy bus ");
  942. error = legacy_suspend(dev, state, dev->bus->suspend);
  943. goto End;
  944. }
  945. }
  946. Run:
  947. if (!callback && dev->driver && dev->driver->pm) {
  948. info = "driver ";
  949. callback = pm_op(dev->driver->pm, state);
  950. }
  951. error = dpm_run_callback(callback, dev, state, info);
  952. End:
  953. if (!error) {
  954. dev->power.is_suspended = true;
  955. if (dev->power.wakeup_path
  956. && dev->parent && !dev->parent->power.ignore_children)
  957. dev->parent->power.wakeup_path = true;
  958. }
  959. device_unlock(dev);
  960. Complete:
  961. complete_all(&dev->power.completion);
  962. if (error) {
  963. pm_runtime_put_sync(dev);
  964. async_error = error;
  965. } else if (dev->power.is_suspended) {
  966. __pm_runtime_disable(dev, false);
  967. }
  968. return error;
  969. }
  970. static void async_suspend(void *data, async_cookie_t cookie)
  971. {
  972. struct device *dev = (struct device *)data;
  973. int error;
  974. error = __device_suspend(dev, pm_transition, true);
  975. if (error) {
  976. dpm_save_failed_dev(dev_name(dev));
  977. pm_dev_err(dev, pm_transition, " async", error);
  978. }
  979. put_device(dev);
  980. }
  981. static int device_suspend(struct device *dev)
  982. {
  983. INIT_COMPLETION(dev->power.completion);
  984. if (pm_async_enabled && dev->power.async_suspend) {
  985. get_device(dev);
  986. async_schedule(async_suspend, dev);
  987. return 0;
  988. }
  989. return __device_suspend(dev, pm_transition, false);
  990. }
  991. /**
  992. * dpm_suspend - Execute "suspend" callbacks for all non-sysdev devices.
  993. * @state: PM transition of the system being carried out.
  994. */
  995. int dpm_suspend(pm_message_t state)
  996. {
  997. ktime_t starttime = ktime_get();
  998. int error = 0;
  999. might_sleep();
  1000. mutex_lock(&dpm_list_mtx);
  1001. pm_transition = state;
  1002. async_error = 0;
  1003. while (!list_empty(&dpm_prepared_list)) {
  1004. struct device *dev = to_device(dpm_prepared_list.prev);
  1005. get_device(dev);
  1006. mutex_unlock(&dpm_list_mtx);
  1007. error = device_suspend(dev);
  1008. mutex_lock(&dpm_list_mtx);
  1009. if (error) {
  1010. pm_dev_err(dev, state, "", error);
  1011. dpm_save_failed_dev(dev_name(dev));
  1012. put_device(dev);
  1013. break;
  1014. }
  1015. if (!list_empty(&dev->power.entry))
  1016. list_move(&dev->power.entry, &dpm_suspended_list);
  1017. put_device(dev);
  1018. if (async_error)
  1019. break;
  1020. }
  1021. mutex_unlock(&dpm_list_mtx);
  1022. async_synchronize_full();
  1023. if (!error)
  1024. error = async_error;
  1025. if (error) {
  1026. suspend_stats.failed_suspend++;
  1027. dpm_save_failed_step(SUSPEND_SUSPEND);
  1028. } else
  1029. dpm_show_time(starttime, state, NULL);
  1030. return error;
  1031. }
  1032. /**
  1033. * device_prepare - Prepare a device for system power transition.
  1034. * @dev: Device to handle.
  1035. * @state: PM transition of the system being carried out.
  1036. *
  1037. * Execute the ->prepare() callback(s) for given device. No new children of the
  1038. * device may be registered after this function has returned.
  1039. */
  1040. static int device_prepare(struct device *dev, pm_message_t state)
  1041. {
  1042. int (*callback)(struct device *) = NULL;
  1043. char *info = NULL;
  1044. int error = 0;
  1045. device_lock(dev);
  1046. dev->power.wakeup_path = device_may_wakeup(dev);
  1047. if (dev->pm_domain) {
  1048. info = "preparing power domain ";
  1049. callback = dev->pm_domain->ops.prepare;
  1050. } else if (dev->type && dev->type->pm) {
  1051. info = "preparing type ";
  1052. callback = dev->type->pm->prepare;
  1053. } else if (dev->class && dev->class->pm) {
  1054. info = "preparing class ";
  1055. callback = dev->class->pm->prepare;
  1056. } else if (dev->bus && dev->bus->pm) {
  1057. info = "preparing bus ";
  1058. callback = dev->bus->pm->prepare;
  1059. }
  1060. if (!callback && dev->driver && dev->driver->pm) {
  1061. info = "preparing driver ";
  1062. callback = dev->driver->pm->prepare;
  1063. }
  1064. if (callback) {
  1065. error = callback(dev);
  1066. suspend_report_result(callback, error);
  1067. }
  1068. device_unlock(dev);
  1069. return error;
  1070. }
  1071. /**
  1072. * dpm_prepare - Prepare all non-sysdev devices for a system PM transition.
  1073. * @state: PM transition of the system being carried out.
  1074. *
  1075. * Execute the ->prepare() callback(s) for all devices.
  1076. */
  1077. int dpm_prepare(pm_message_t state)
  1078. {
  1079. int error = 0;
  1080. might_sleep();
  1081. mutex_lock(&dpm_list_mtx);
  1082. while (!list_empty(&dpm_list)) {
  1083. struct device *dev = to_device(dpm_list.next);
  1084. get_device(dev);
  1085. mutex_unlock(&dpm_list_mtx);
  1086. error = device_prepare(dev, state);
  1087. mutex_lock(&dpm_list_mtx);
  1088. if (error) {
  1089. if (error == -EAGAIN) {
  1090. put_device(dev);
  1091. error = 0;
  1092. continue;
  1093. }
  1094. printk(KERN_INFO "PM: Device %s not prepared "
  1095. "for power transition: code %d\n",
  1096. dev_name(dev), error);
  1097. put_device(dev);
  1098. break;
  1099. }
  1100. dev->power.is_prepared = true;
  1101. if (!list_empty(&dev->power.entry))
  1102. list_move_tail(&dev->power.entry, &dpm_prepared_list);
  1103. put_device(dev);
  1104. }
  1105. mutex_unlock(&dpm_list_mtx);
  1106. return error;
  1107. }
  1108. /**
  1109. * dpm_suspend_start - Prepare devices for PM transition and suspend them.
  1110. * @state: PM transition of the system being carried out.
  1111. *
  1112. * Prepare all non-sysdev devices for system PM transition and execute "suspend"
  1113. * callbacks for them.
  1114. */
  1115. int dpm_suspend_start(pm_message_t state)
  1116. {
  1117. int error;
  1118. error = dpm_prepare(state);
  1119. if (error) {
  1120. suspend_stats.failed_prepare++;
  1121. dpm_save_failed_step(SUSPEND_PREPARE);
  1122. } else
  1123. error = dpm_suspend(state);
  1124. return error;
  1125. }
  1126. EXPORT_SYMBOL_GPL(dpm_suspend_start);
  1127. void __suspend_report_result(const char *function, void *fn, int ret)
  1128. {
  1129. if (ret)
  1130. printk(KERN_ERR "%s(): %pF returns %d\n", function, fn, ret);
  1131. }
  1132. EXPORT_SYMBOL_GPL(__suspend_report_result);
  1133. /**
  1134. * device_pm_wait_for_dev - Wait for suspend/resume of a device to complete.
  1135. * @dev: Device to wait for.
  1136. * @subordinate: Device that needs to wait for @dev.
  1137. */
  1138. int device_pm_wait_for_dev(struct device *subordinate, struct device *dev)
  1139. {
  1140. dpm_wait(dev, subordinate->power.async_suspend);
  1141. return async_error;
  1142. }
  1143. EXPORT_SYMBOL_GPL(device_pm_wait_for_dev);