acpi_lpss.c 20 KB

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