acpi_lpss.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765
  1. /*
  2. * ACPI support for Intel Lynxpoint LPSS.
  3. *
  4. * Copyright (C) 2013, Intel Corporation
  5. * Authors: Mika Westerberg <mika.westerberg@linux.intel.com>
  6. * Rafael J. Wysocki <rafael.j.wysocki@intel.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. */
  12. #include <linux/acpi.h>
  13. #include <linux/clk.h>
  14. #include <linux/clkdev.h>
  15. #include <linux/clk-provider.h>
  16. #include <linux/err.h>
  17. #include <linux/io.h>
  18. #include <linux/platform_device.h>
  19. #include <linux/platform_data/clk-lpss.h>
  20. #include <linux/pm_runtime.h>
  21. #include <linux/delay.h>
  22. #include "internal.h"
  23. ACPI_MODULE_NAME("acpi_lpss");
  24. #ifdef CONFIG_X86_INTEL_LPSS
  25. #define LPSS_ADDR(desc) ((unsigned long)&desc)
  26. #define LPSS_CLK_SIZE 0x04
  27. #define LPSS_LTR_SIZE 0x18
  28. /* Offsets relative to LPSS_PRIVATE_OFFSET */
  29. #define LPSS_CLK_DIVIDER_DEF_MASK (BIT(1) | BIT(16))
  30. #define LPSS_RESETS 0x04
  31. #define LPSS_RESETS_RESET_FUNC BIT(0)
  32. #define LPSS_RESETS_RESET_APB BIT(1)
  33. #define LPSS_GENERAL 0x08
  34. #define LPSS_GENERAL_LTR_MODE_SW BIT(2)
  35. #define LPSS_GENERAL_UART_RTS_OVRD BIT(3)
  36. #define LPSS_SW_LTR 0x10
  37. #define LPSS_AUTO_LTR 0x14
  38. #define LPSS_LTR_SNOOP_REQ BIT(15)
  39. #define LPSS_LTR_SNOOP_MASK 0x0000FFFF
  40. #define LPSS_LTR_SNOOP_LAT_1US 0x800
  41. #define LPSS_LTR_SNOOP_LAT_32US 0xC00
  42. #define LPSS_LTR_SNOOP_LAT_SHIFT 5
  43. #define LPSS_LTR_SNOOP_LAT_CUTOFF 3000
  44. #define LPSS_LTR_MAX_VAL 0x3FF
  45. #define LPSS_TX_INT 0x20
  46. #define LPSS_TX_INT_MASK BIT(1)
  47. #define LPSS_PRV_REG_COUNT 9
  48. struct lpss_shared_clock {
  49. const char *name;
  50. unsigned long rate;
  51. struct clk *clk;
  52. };
  53. struct lpss_private_data;
  54. struct lpss_device_desc {
  55. bool clk_required;
  56. const char *clkdev_name;
  57. bool ltr_required;
  58. unsigned int prv_offset;
  59. size_t prv_size_override;
  60. bool clk_divider;
  61. bool clk_gate;
  62. bool save_ctx;
  63. struct lpss_shared_clock *shared_clock;
  64. void (*setup)(struct lpss_private_data *pdata);
  65. };
  66. static struct lpss_device_desc lpss_dma_desc = {
  67. .clk_required = true,
  68. .clkdev_name = "hclk",
  69. };
  70. struct lpss_private_data {
  71. void __iomem *mmio_base;
  72. resource_size_t mmio_size;
  73. struct clk *clk;
  74. const struct lpss_device_desc *dev_desc;
  75. u32 prv_reg_ctx[LPSS_PRV_REG_COUNT];
  76. };
  77. static void lpss_uart_setup(struct lpss_private_data *pdata)
  78. {
  79. unsigned int offset;
  80. u32 reg;
  81. offset = pdata->dev_desc->prv_offset + LPSS_TX_INT;
  82. reg = readl(pdata->mmio_base + offset);
  83. writel(reg | LPSS_TX_INT_MASK, pdata->mmio_base + offset);
  84. offset = pdata->dev_desc->prv_offset + LPSS_GENERAL;
  85. reg = readl(pdata->mmio_base + offset);
  86. writel(reg | LPSS_GENERAL_UART_RTS_OVRD, pdata->mmio_base + offset);
  87. }
  88. static void lpss_i2c_setup(struct lpss_private_data *pdata)
  89. {
  90. unsigned int offset;
  91. u32 val;
  92. offset = pdata->dev_desc->prv_offset + LPSS_RESETS;
  93. val = readl(pdata->mmio_base + offset);
  94. val |= LPSS_RESETS_RESET_APB | LPSS_RESETS_RESET_FUNC;
  95. writel(val, pdata->mmio_base + offset);
  96. }
  97. static struct lpss_device_desc wpt_dev_desc = {
  98. .clk_required = true,
  99. .prv_offset = 0x800,
  100. .ltr_required = true,
  101. .clk_divider = true,
  102. .clk_gate = true,
  103. };
  104. static struct lpss_device_desc lpt_dev_desc = {
  105. .clk_required = true,
  106. .prv_offset = 0x800,
  107. .ltr_required = true,
  108. .clk_divider = true,
  109. .clk_gate = true,
  110. };
  111. static struct lpss_device_desc lpt_i2c_dev_desc = {
  112. .clk_required = true,
  113. .prv_offset = 0x800,
  114. .ltr_required = true,
  115. .clk_gate = true,
  116. };
  117. static struct lpss_device_desc lpt_uart_dev_desc = {
  118. .clk_required = true,
  119. .prv_offset = 0x800,
  120. .ltr_required = true,
  121. .clk_divider = true,
  122. .clk_gate = true,
  123. .setup = lpss_uart_setup,
  124. };
  125. static struct lpss_device_desc lpt_sdio_dev_desc = {
  126. .prv_offset = 0x1000,
  127. .prv_size_override = 0x1018,
  128. .ltr_required = true,
  129. };
  130. static struct lpss_shared_clock pwm_clock = {
  131. .name = "pwm_clk",
  132. .rate = 25000000,
  133. };
  134. static struct lpss_device_desc byt_pwm_dev_desc = {
  135. .clk_required = true,
  136. .save_ctx = true,
  137. .shared_clock = &pwm_clock,
  138. };
  139. static struct lpss_device_desc byt_uart_dev_desc = {
  140. .clk_required = true,
  141. .prv_offset = 0x800,
  142. .clk_divider = true,
  143. .clk_gate = true,
  144. .save_ctx = true,
  145. .setup = lpss_uart_setup,
  146. };
  147. static struct lpss_device_desc byt_spi_dev_desc = {
  148. .clk_required = true,
  149. .prv_offset = 0x400,
  150. .clk_divider = true,
  151. .clk_gate = true,
  152. .save_ctx = true,
  153. };
  154. static struct lpss_device_desc byt_sdio_dev_desc = {
  155. .clk_required = true,
  156. };
  157. static struct lpss_shared_clock i2c_clock = {
  158. .name = "i2c_clk",
  159. .rate = 100000000,
  160. };
  161. static struct lpss_device_desc byt_i2c_dev_desc = {
  162. .clk_required = true,
  163. .prv_offset = 0x800,
  164. .save_ctx = true,
  165. .shared_clock = &i2c_clock,
  166. .setup = lpss_i2c_setup,
  167. };
  168. static struct lpss_shared_clock bsw_pwm_clock = {
  169. .name = "pwm_clk",
  170. .rate = 19200000,
  171. };
  172. static struct lpss_device_desc bsw_pwm_dev_desc = {
  173. .clk_required = true,
  174. .save_ctx = true,
  175. .shared_clock = &bsw_pwm_clock,
  176. };
  177. #else
  178. #define LPSS_ADDR(desc) (0UL)
  179. #endif /* CONFIG_X86_INTEL_LPSS */
  180. static const struct acpi_device_id acpi_lpss_device_ids[] = {
  181. /* Generic LPSS devices */
  182. { "INTL9C60", LPSS_ADDR(lpss_dma_desc) },
  183. /* Lynxpoint LPSS devices */
  184. { "INT33C0", LPSS_ADDR(lpt_dev_desc) },
  185. { "INT33C1", LPSS_ADDR(lpt_dev_desc) },
  186. { "INT33C2", LPSS_ADDR(lpt_i2c_dev_desc) },
  187. { "INT33C3", LPSS_ADDR(lpt_i2c_dev_desc) },
  188. { "INT33C4", LPSS_ADDR(lpt_uart_dev_desc) },
  189. { "INT33C5", LPSS_ADDR(lpt_uart_dev_desc) },
  190. { "INT33C6", LPSS_ADDR(lpt_sdio_dev_desc) },
  191. { "INT33C7", },
  192. /* BayTrail LPSS devices */
  193. { "80860F09", LPSS_ADDR(byt_pwm_dev_desc) },
  194. { "80860F0A", LPSS_ADDR(byt_uart_dev_desc) },
  195. { "80860F0E", LPSS_ADDR(byt_spi_dev_desc) },
  196. { "80860F14", LPSS_ADDR(byt_sdio_dev_desc) },
  197. { "80860F41", LPSS_ADDR(byt_i2c_dev_desc) },
  198. { "INT33B2", },
  199. { "INT33FC", },
  200. /* Braswell LPSS devices */
  201. { "80862288", LPSS_ADDR(bsw_pwm_dev_desc) },
  202. { "8086228A", LPSS_ADDR(byt_uart_dev_desc) },
  203. { "8086228E", LPSS_ADDR(byt_spi_dev_desc) },
  204. { "808622C1", LPSS_ADDR(byt_i2c_dev_desc) },
  205. { "INT3430", LPSS_ADDR(lpt_dev_desc) },
  206. { "INT3431", LPSS_ADDR(lpt_dev_desc) },
  207. { "INT3432", LPSS_ADDR(lpt_i2c_dev_desc) },
  208. { "INT3433", LPSS_ADDR(lpt_i2c_dev_desc) },
  209. { "INT3434", LPSS_ADDR(lpt_uart_dev_desc) },
  210. { "INT3435", LPSS_ADDR(lpt_uart_dev_desc) },
  211. { "INT3436", LPSS_ADDR(lpt_sdio_dev_desc) },
  212. { "INT3437", },
  213. { "INT3438", LPSS_ADDR(wpt_dev_desc) },
  214. { }
  215. };
  216. #ifdef CONFIG_X86_INTEL_LPSS
  217. static int is_memory(struct acpi_resource *res, void *not_used)
  218. {
  219. struct resource r;
  220. return !acpi_dev_resource_memory(res, &r);
  221. }
  222. /* LPSS main clock device. */
  223. static struct platform_device *lpss_clk_dev;
  224. static inline void lpt_register_clock_device(void)
  225. {
  226. lpss_clk_dev = platform_device_register_simple("clk-lpt", -1, NULL, 0);
  227. }
  228. static int register_device_clock(struct acpi_device *adev,
  229. struct lpss_private_data *pdata)
  230. {
  231. const struct lpss_device_desc *dev_desc = pdata->dev_desc;
  232. struct lpss_shared_clock *shared_clock = dev_desc->shared_clock;
  233. const char *devname = dev_name(&adev->dev);
  234. struct clk *clk = ERR_PTR(-ENODEV);
  235. struct lpss_clk_data *clk_data;
  236. const char *parent, *clk_name;
  237. void __iomem *prv_base;
  238. if (!lpss_clk_dev)
  239. lpt_register_clock_device();
  240. clk_data = platform_get_drvdata(lpss_clk_dev);
  241. if (!clk_data)
  242. return -ENODEV;
  243. if (dev_desc->clkdev_name) {
  244. clk_register_clkdev(clk_data->clk, dev_desc->clkdev_name,
  245. devname);
  246. return 0;
  247. }
  248. if (!pdata->mmio_base
  249. || pdata->mmio_size < dev_desc->prv_offset + LPSS_CLK_SIZE)
  250. return -ENODATA;
  251. parent = clk_data->name;
  252. prv_base = pdata->mmio_base + dev_desc->prv_offset;
  253. if (shared_clock) {
  254. clk = shared_clock->clk;
  255. if (!clk) {
  256. clk = clk_register_fixed_rate(NULL, shared_clock->name,
  257. "lpss_clk", 0,
  258. shared_clock->rate);
  259. shared_clock->clk = clk;
  260. }
  261. parent = shared_clock->name;
  262. }
  263. if (dev_desc->clk_gate) {
  264. clk = clk_register_gate(NULL, devname, parent, 0,
  265. prv_base, 0, 0, NULL);
  266. parent = devname;
  267. }
  268. if (dev_desc->clk_divider) {
  269. /* Prevent division by zero */
  270. if (!readl(prv_base))
  271. writel(LPSS_CLK_DIVIDER_DEF_MASK, prv_base);
  272. clk_name = kasprintf(GFP_KERNEL, "%s-div", devname);
  273. if (!clk_name)
  274. return -ENOMEM;
  275. clk = clk_register_fractional_divider(NULL, clk_name, parent,
  276. 0, prv_base,
  277. 1, 15, 16, 15, 0, NULL);
  278. parent = clk_name;
  279. clk_name = kasprintf(GFP_KERNEL, "%s-update", devname);
  280. if (!clk_name) {
  281. kfree(parent);
  282. return -ENOMEM;
  283. }
  284. clk = clk_register_gate(NULL, clk_name, parent,
  285. CLK_SET_RATE_PARENT | CLK_SET_RATE_GATE,
  286. prv_base, 31, 0, NULL);
  287. kfree(parent);
  288. kfree(clk_name);
  289. }
  290. if (IS_ERR(clk))
  291. return PTR_ERR(clk);
  292. pdata->clk = clk;
  293. clk_register_clkdev(clk, NULL, devname);
  294. return 0;
  295. }
  296. static int acpi_lpss_create_device(struct acpi_device *adev,
  297. const struct acpi_device_id *id)
  298. {
  299. struct lpss_device_desc *dev_desc;
  300. struct lpss_private_data *pdata;
  301. struct resource_list_entry *rentry;
  302. struct list_head resource_list;
  303. struct platform_device *pdev;
  304. int ret;
  305. dev_desc = (struct lpss_device_desc *)id->driver_data;
  306. if (!dev_desc) {
  307. pdev = acpi_create_platform_device(adev);
  308. return IS_ERR_OR_NULL(pdev) ? PTR_ERR(pdev) : 1;
  309. }
  310. pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
  311. if (!pdata)
  312. return -ENOMEM;
  313. INIT_LIST_HEAD(&resource_list);
  314. ret = acpi_dev_get_resources(adev, &resource_list, is_memory, NULL);
  315. if (ret < 0)
  316. goto err_out;
  317. list_for_each_entry(rentry, &resource_list, node)
  318. if (resource_type(&rentry->res) == IORESOURCE_MEM) {
  319. if (dev_desc->prv_size_override)
  320. pdata->mmio_size = dev_desc->prv_size_override;
  321. else
  322. pdata->mmio_size = resource_size(&rentry->res);
  323. pdata->mmio_base = ioremap(rentry->res.start,
  324. pdata->mmio_size);
  325. break;
  326. }
  327. acpi_dev_free_resource_list(&resource_list);
  328. pdata->dev_desc = dev_desc;
  329. if (dev_desc->clk_required) {
  330. ret = register_device_clock(adev, pdata);
  331. if (ret) {
  332. /* Skip the device, but continue the namespace scan. */
  333. ret = 0;
  334. goto err_out;
  335. }
  336. }
  337. /*
  338. * This works around a known issue in ACPI tables where LPSS devices
  339. * have _PS0 and _PS3 without _PSC (and no power resources), so
  340. * acpi_bus_init_power() will assume that the BIOS has put them into D0.
  341. */
  342. ret = acpi_device_fix_up_power(adev);
  343. if (ret) {
  344. /* Skip the device, but continue the namespace scan. */
  345. ret = 0;
  346. goto err_out;
  347. }
  348. if (dev_desc->setup)
  349. dev_desc->setup(pdata);
  350. adev->driver_data = pdata;
  351. pdev = acpi_create_platform_device(adev);
  352. if (!IS_ERR_OR_NULL(pdev)) {
  353. device_enable_async_suspend(&pdev->dev);
  354. return 1;
  355. }
  356. ret = PTR_ERR(pdev);
  357. adev->driver_data = NULL;
  358. err_out:
  359. kfree(pdata);
  360. return ret;
  361. }
  362. static u32 __lpss_reg_read(struct lpss_private_data *pdata, unsigned int reg)
  363. {
  364. return readl(pdata->mmio_base + pdata->dev_desc->prv_offset + reg);
  365. }
  366. static void __lpss_reg_write(u32 val, struct lpss_private_data *pdata,
  367. unsigned int reg)
  368. {
  369. writel(val, pdata->mmio_base + pdata->dev_desc->prv_offset + reg);
  370. }
  371. static int lpss_reg_read(struct device *dev, unsigned int reg, u32 *val)
  372. {
  373. struct acpi_device *adev;
  374. struct lpss_private_data *pdata;
  375. unsigned long flags;
  376. int ret;
  377. ret = acpi_bus_get_device(ACPI_HANDLE(dev), &adev);
  378. if (WARN_ON(ret))
  379. return ret;
  380. spin_lock_irqsave(&dev->power.lock, flags);
  381. if (pm_runtime_suspended(dev)) {
  382. ret = -EAGAIN;
  383. goto out;
  384. }
  385. pdata = acpi_driver_data(adev);
  386. if (WARN_ON(!pdata || !pdata->mmio_base)) {
  387. ret = -ENODEV;
  388. goto out;
  389. }
  390. *val = __lpss_reg_read(pdata, reg);
  391. out:
  392. spin_unlock_irqrestore(&dev->power.lock, flags);
  393. return ret;
  394. }
  395. static ssize_t lpss_ltr_show(struct device *dev, struct device_attribute *attr,
  396. char *buf)
  397. {
  398. u32 ltr_value = 0;
  399. unsigned int reg;
  400. int ret;
  401. reg = strcmp(attr->attr.name, "auto_ltr") ? LPSS_SW_LTR : LPSS_AUTO_LTR;
  402. ret = lpss_reg_read(dev, reg, &ltr_value);
  403. if (ret)
  404. return ret;
  405. return snprintf(buf, PAGE_SIZE, "%08x\n", ltr_value);
  406. }
  407. static ssize_t lpss_ltr_mode_show(struct device *dev,
  408. struct device_attribute *attr, char *buf)
  409. {
  410. u32 ltr_mode = 0;
  411. char *outstr;
  412. int ret;
  413. ret = lpss_reg_read(dev, LPSS_GENERAL, &ltr_mode);
  414. if (ret)
  415. return ret;
  416. outstr = (ltr_mode & LPSS_GENERAL_LTR_MODE_SW) ? "sw" : "auto";
  417. return sprintf(buf, "%s\n", outstr);
  418. }
  419. static DEVICE_ATTR(auto_ltr, S_IRUSR, lpss_ltr_show, NULL);
  420. static DEVICE_ATTR(sw_ltr, S_IRUSR, lpss_ltr_show, NULL);
  421. static DEVICE_ATTR(ltr_mode, S_IRUSR, lpss_ltr_mode_show, NULL);
  422. static struct attribute *lpss_attrs[] = {
  423. &dev_attr_auto_ltr.attr,
  424. &dev_attr_sw_ltr.attr,
  425. &dev_attr_ltr_mode.attr,
  426. NULL,
  427. };
  428. static struct attribute_group lpss_attr_group = {
  429. .attrs = lpss_attrs,
  430. .name = "lpss_ltr",
  431. };
  432. static void acpi_lpss_set_ltr(struct device *dev, s32 val)
  433. {
  434. struct lpss_private_data *pdata = acpi_driver_data(ACPI_COMPANION(dev));
  435. u32 ltr_mode, ltr_val;
  436. ltr_mode = __lpss_reg_read(pdata, LPSS_GENERAL);
  437. if (val < 0) {
  438. if (ltr_mode & LPSS_GENERAL_LTR_MODE_SW) {
  439. ltr_mode &= ~LPSS_GENERAL_LTR_MODE_SW;
  440. __lpss_reg_write(ltr_mode, pdata, LPSS_GENERAL);
  441. }
  442. return;
  443. }
  444. ltr_val = __lpss_reg_read(pdata, LPSS_SW_LTR) & ~LPSS_LTR_SNOOP_MASK;
  445. if (val >= LPSS_LTR_SNOOP_LAT_CUTOFF) {
  446. ltr_val |= LPSS_LTR_SNOOP_LAT_32US;
  447. val = LPSS_LTR_MAX_VAL;
  448. } else if (val > LPSS_LTR_MAX_VAL) {
  449. ltr_val |= LPSS_LTR_SNOOP_LAT_32US | LPSS_LTR_SNOOP_REQ;
  450. val >>= LPSS_LTR_SNOOP_LAT_SHIFT;
  451. } else {
  452. ltr_val |= LPSS_LTR_SNOOP_LAT_1US | LPSS_LTR_SNOOP_REQ;
  453. }
  454. ltr_val |= val;
  455. __lpss_reg_write(ltr_val, pdata, LPSS_SW_LTR);
  456. if (!(ltr_mode & LPSS_GENERAL_LTR_MODE_SW)) {
  457. ltr_mode |= LPSS_GENERAL_LTR_MODE_SW;
  458. __lpss_reg_write(ltr_mode, pdata, LPSS_GENERAL);
  459. }
  460. }
  461. #ifdef CONFIG_PM
  462. /**
  463. * acpi_lpss_save_ctx() - Save the private registers of LPSS device
  464. * @dev: LPSS device
  465. *
  466. * Most LPSS devices have private registers which may loose their context when
  467. * the device is powered down. acpi_lpss_save_ctx() saves those registers into
  468. * prv_reg_ctx array.
  469. */
  470. static void acpi_lpss_save_ctx(struct device *dev)
  471. {
  472. struct lpss_private_data *pdata = acpi_driver_data(ACPI_COMPANION(dev));
  473. unsigned int i;
  474. for (i = 0; i < LPSS_PRV_REG_COUNT; i++) {
  475. unsigned long offset = i * sizeof(u32);
  476. pdata->prv_reg_ctx[i] = __lpss_reg_read(pdata, offset);
  477. dev_dbg(dev, "saving 0x%08x from LPSS reg at offset 0x%02lx\n",
  478. pdata->prv_reg_ctx[i], offset);
  479. }
  480. }
  481. /**
  482. * acpi_lpss_restore_ctx() - Restore the private registers of LPSS device
  483. * @dev: LPSS device
  484. *
  485. * Restores the registers that were previously stored with acpi_lpss_save_ctx().
  486. */
  487. static void acpi_lpss_restore_ctx(struct device *dev)
  488. {
  489. struct lpss_private_data *pdata = acpi_driver_data(ACPI_COMPANION(dev));
  490. unsigned int i;
  491. /*
  492. * The following delay is needed or the subsequent write operations may
  493. * fail. The LPSS devices are actually PCI devices and the PCI spec
  494. * expects 10ms delay before the device can be accessed after D3 to D0
  495. * transition.
  496. */
  497. msleep(10);
  498. for (i = 0; i < LPSS_PRV_REG_COUNT; i++) {
  499. unsigned long offset = i * sizeof(u32);
  500. __lpss_reg_write(pdata->prv_reg_ctx[i], pdata, offset);
  501. dev_dbg(dev, "restoring 0x%08x to LPSS reg at offset 0x%02lx\n",
  502. pdata->prv_reg_ctx[i], offset);
  503. }
  504. }
  505. #ifdef CONFIG_PM_SLEEP
  506. static int acpi_lpss_suspend_late(struct device *dev)
  507. {
  508. int ret = pm_generic_suspend_late(dev);
  509. if (ret)
  510. return ret;
  511. acpi_lpss_save_ctx(dev);
  512. return acpi_dev_suspend_late(dev);
  513. }
  514. static int acpi_lpss_resume_early(struct device *dev)
  515. {
  516. int ret = acpi_dev_resume_early(dev);
  517. if (ret)
  518. return ret;
  519. acpi_lpss_restore_ctx(dev);
  520. return pm_generic_resume_early(dev);
  521. }
  522. #endif /* CONFIG_PM_SLEEP */
  523. #ifdef CONFIG_PM_RUNTIME
  524. static int acpi_lpss_runtime_suspend(struct device *dev)
  525. {
  526. int ret = pm_generic_runtime_suspend(dev);
  527. if (ret)
  528. return ret;
  529. acpi_lpss_save_ctx(dev);
  530. return acpi_dev_runtime_suspend(dev);
  531. }
  532. static int acpi_lpss_runtime_resume(struct device *dev)
  533. {
  534. int ret = acpi_dev_runtime_resume(dev);
  535. if (ret)
  536. return ret;
  537. acpi_lpss_restore_ctx(dev);
  538. return pm_generic_runtime_resume(dev);
  539. }
  540. #endif /* CONFIG_PM_RUNTIME */
  541. #endif /* CONFIG_PM */
  542. static struct dev_pm_domain acpi_lpss_pm_domain = {
  543. .ops = {
  544. #ifdef CONFIG_PM_SLEEP
  545. .prepare = acpi_subsys_prepare,
  546. .complete = acpi_subsys_complete,
  547. .suspend = acpi_subsys_suspend,
  548. .suspend_late = acpi_lpss_suspend_late,
  549. .resume_early = acpi_lpss_resume_early,
  550. .freeze = acpi_subsys_freeze,
  551. .poweroff = acpi_subsys_suspend,
  552. .poweroff_late = acpi_lpss_suspend_late,
  553. .restore_early = acpi_lpss_resume_early,
  554. #endif
  555. #ifdef CONFIG_PM_RUNTIME
  556. .runtime_suspend = acpi_lpss_runtime_suspend,
  557. .runtime_resume = acpi_lpss_runtime_resume,
  558. #endif
  559. },
  560. };
  561. static int acpi_lpss_platform_notify(struct notifier_block *nb,
  562. unsigned long action, void *data)
  563. {
  564. struct platform_device *pdev = to_platform_device(data);
  565. struct lpss_private_data *pdata;
  566. struct acpi_device *adev;
  567. const struct acpi_device_id *id;
  568. id = acpi_match_device(acpi_lpss_device_ids, &pdev->dev);
  569. if (!id || !id->driver_data)
  570. return 0;
  571. if (acpi_bus_get_device(ACPI_HANDLE(&pdev->dev), &adev))
  572. return 0;
  573. pdata = acpi_driver_data(adev);
  574. if (!pdata || !pdata->mmio_base)
  575. return 0;
  576. if (pdata->mmio_size < pdata->dev_desc->prv_offset + LPSS_LTR_SIZE) {
  577. dev_err(&pdev->dev, "MMIO size insufficient to access LTR\n");
  578. return 0;
  579. }
  580. switch (action) {
  581. case BUS_NOTIFY_BOUND_DRIVER:
  582. if (pdata->dev_desc->save_ctx)
  583. pdev->dev.pm_domain = &acpi_lpss_pm_domain;
  584. break;
  585. case BUS_NOTIFY_UNBOUND_DRIVER:
  586. if (pdata->dev_desc->save_ctx)
  587. pdev->dev.pm_domain = NULL;
  588. break;
  589. case BUS_NOTIFY_ADD_DEVICE:
  590. if (pdata->dev_desc->ltr_required)
  591. return sysfs_create_group(&pdev->dev.kobj,
  592. &lpss_attr_group);
  593. case BUS_NOTIFY_DEL_DEVICE:
  594. if (pdata->dev_desc->ltr_required)
  595. sysfs_remove_group(&pdev->dev.kobj, &lpss_attr_group);
  596. default:
  597. break;
  598. }
  599. return 0;
  600. }
  601. static struct notifier_block acpi_lpss_nb = {
  602. .notifier_call = acpi_lpss_platform_notify,
  603. };
  604. static void acpi_lpss_bind(struct device *dev)
  605. {
  606. struct lpss_private_data *pdata = acpi_driver_data(ACPI_COMPANION(dev));
  607. if (!pdata || !pdata->mmio_base || !pdata->dev_desc->ltr_required)
  608. return;
  609. if (pdata->mmio_size >= pdata->dev_desc->prv_offset + LPSS_LTR_SIZE)
  610. dev->power.set_latency_tolerance = acpi_lpss_set_ltr;
  611. else
  612. dev_err(dev, "MMIO size insufficient to access LTR\n");
  613. }
  614. static void acpi_lpss_unbind(struct device *dev)
  615. {
  616. dev->power.set_latency_tolerance = NULL;
  617. }
  618. static struct acpi_scan_handler lpss_handler = {
  619. .ids = acpi_lpss_device_ids,
  620. .attach = acpi_lpss_create_device,
  621. .bind = acpi_lpss_bind,
  622. .unbind = acpi_lpss_unbind,
  623. };
  624. void __init acpi_lpss_init(void)
  625. {
  626. if (!lpt_clk_init()) {
  627. bus_register_notifier(&platform_bus_type, &acpi_lpss_nb);
  628. acpi_scan_add_handler(&lpss_handler);
  629. }
  630. }
  631. #else
  632. static struct acpi_scan_handler lpss_handler = {
  633. .ids = acpi_lpss_device_ids,
  634. };
  635. void __init acpi_lpss_init(void)
  636. {
  637. acpi_scan_add_handler(&lpss_handler);
  638. }
  639. #endif /* CONFIG_X86_INTEL_LPSS */