acpi_lpss.c 19 KB

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