1 // SPDX-License-Identifier: GPL-2.0-only
3 * Intel MID Power Management Unit (PWRMU) device driver
5 * Copyright (C) 2016, Intel Corporation
7 * Author: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
9 * Intel MID Power Management Unit device driver handles the South Complex PCI
10 * devices such as GPDMA, SPI, I2C, PWM, and so on. By default PCI core
11 * modifies bits in PMCSR register in the PCI configuration space. This is not
12 * enough on some SoCs like Intel Tangier. In such case PCI core sets a new
13 * power state of the device in question through a PM hook registered in struct
14 * pci_platform_pm_ops (see drivers/pci/pci-mid.c).
17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19 #include <linux/delay.h>
20 #include <linux/errno.h>
21 #include <linux/interrupt.h>
22 #include <linux/kernel.h>
23 #include <linux/export.h>
24 #include <linux/mutex.h>
25 #include <linux/pci.h>
27 #include <asm/intel-mid.h>
33 #define PM_WKC(x) (0x10 + (x) * 4)
34 #define PM_WKS(x) (0x18 + (x) * 4)
35 #define PM_SSC(x) (0x20 + (x) * 4)
36 #define PM_SSS(x) (0x30 + (x) * 4)
39 #define PM_STS_BUSY (1 << 8)
42 #define PM_CMD_CMD(x) ((x) << 0)
43 #define PM_CMD_IOC (1 << 8)
44 #define PM_CMD_CM_NOP (0 << 9)
45 #define PM_CMD_CM_IMMEDIATE (1 << 9)
46 #define PM_CMD_CM_DELAY (2 << 9)
47 #define PM_CMD_CM_TRIGGER (3 << 9)
50 #define PM_CMD_SYS_STATE_S5 (5 << 16)
52 /* Trigger variants */
53 #define PM_CMD_CFG_TRIGGER_NC (3 << 19)
55 /* Message to wait for TRIGGER_NC case */
56 #define TRIGGER_NC_MSG_2 (2 << 22)
58 /* List of commands */
59 #define CMD_SET_CFG 0x01
62 #define PM_ICS_INT_STATUS(x) ((x) & 0xff)
63 #define PM_ICS_IE (1 << 8)
64 #define PM_ICS_IP (1 << 9)
65 #define PM_ICS_SW_INT_STS (1 << 10)
67 /* List of interrupts */
69 #define INT_CMD_COMPLETE 1
71 #define INT_WAKE_EVENT 3
72 #define INT_LSS_POWER_ERR 4
73 #define INT_S0iX_MSG_ERR 5
75 #define INT_TRIGGER_ERR 7
76 #define INT_INACTIVITY 8
78 /* South Complex devices */
79 #define LSS_MAX_SHARED_DEVS 4
80 #define LSS_MAX_DEVS 64
82 #define LSS_WS_BITS 1 /* wake state width */
83 #define LSS_PWS_BITS 2 /* power state width */
85 /* Supported device IDs */
86 #define PCI_DEVICE_ID_PENWELL 0x0828
87 #define PCI_DEVICE_ID_TANGIER 0x11a1
101 struct mid_pwr_dev lss
[LSS_MAX_DEVS
][LSS_MAX_SHARED_DEVS
];
104 static struct mid_pwr
*midpwr
;
106 static u32
mid_pwr_get_state(struct mid_pwr
*pwr
, int reg
)
108 return readl(pwr
->regs
+ PM_SSS(reg
));
111 static void mid_pwr_set_state(struct mid_pwr
*pwr
, int reg
, u32 value
)
113 writel(value
, pwr
->regs
+ PM_SSC(reg
));
116 static void mid_pwr_set_wake(struct mid_pwr
*pwr
, int reg
, u32 value
)
118 writel(value
, pwr
->regs
+ PM_WKC(reg
));
121 static void mid_pwr_interrupt_disable(struct mid_pwr
*pwr
)
123 writel(~PM_ICS_IE
, pwr
->regs
+ PM_ICS
);
126 static bool mid_pwr_is_busy(struct mid_pwr
*pwr
)
128 return !!(readl(pwr
->regs
+ PM_STS
) & PM_STS_BUSY
);
131 /* Wait 500ms that the latest PWRMU command finished */
132 static int mid_pwr_wait(struct mid_pwr
*pwr
)
134 unsigned int count
= 500000;
138 busy
= mid_pwr_is_busy(pwr
);
147 static int mid_pwr_wait_for_cmd(struct mid_pwr
*pwr
, u8 cmd
)
149 writel(PM_CMD_CMD(cmd
) | PM_CMD_CM_IMMEDIATE
, pwr
->regs
+ PM_CMD
);
150 return mid_pwr_wait(pwr
);
153 static int __update_power_state(struct mid_pwr
*pwr
, int reg
, int bit
, int new)
159 /* Check if the device is already in desired state */
160 power
= mid_pwr_get_state(pwr
, reg
);
161 curstate
= (power
>> bit
) & 3;
165 /* Update the power state */
166 mid_pwr_set_state(pwr
, reg
, (power
& ~(3 << bit
)) | (new << bit
));
168 /* Send command to SCU */
169 ret
= mid_pwr_wait_for_cmd(pwr
, CMD_SET_CFG
);
173 /* Check if the device is already in desired state */
174 power
= mid_pwr_get_state(pwr
, reg
);
175 curstate
= (power
>> bit
) & 3;
182 static pci_power_t
__find_weakest_power_state(struct mid_pwr_dev
*lss
,
183 struct pci_dev
*pdev
,
186 pci_power_t weakest
= PCI_D3hot
;
189 /* Find device in cache or first free cell */
190 for (j
= 0; j
< LSS_MAX_SHARED_DEVS
; j
++) {
191 if (lss
[j
].pdev
== pdev
|| !lss
[j
].pdev
)
195 /* Store the desired state in cache */
196 if (j
< LSS_MAX_SHARED_DEVS
) {
198 lss
[j
].state
= state
;
200 dev_WARN(&pdev
->dev
, "No room for device in PWRMU LSS cache\n");
204 /* Find the power state we may use */
205 for (j
= 0; j
< LSS_MAX_SHARED_DEVS
; j
++) {
206 if (lss
[j
].state
< weakest
)
207 weakest
= lss
[j
].state
;
213 static int __set_power_state(struct mid_pwr
*pwr
, struct pci_dev
*pdev
,
214 pci_power_t state
, int id
, int reg
, int bit
)
219 state
= __find_weakest_power_state(pwr
->lss
[id
], pdev
, state
);
220 name
= pci_power_name(state
);
222 ret
= __update_power_state(pwr
, reg
, bit
, (__force
int)state
);
224 dev_warn(&pdev
->dev
, "Can't set power state %s: %d\n", name
, ret
);
228 dev_vdbg(&pdev
->dev
, "Set power state %s\n", name
);
232 static int mid_pwr_set_power_state(struct mid_pwr
*pwr
, struct pci_dev
*pdev
,
238 id
= intel_mid_pwr_get_lss_id(pdev
);
242 reg
= (id
* LSS_PWS_BITS
) / 32;
243 bit
= (id
* LSS_PWS_BITS
) % 32;
245 /* We support states between PCI_D0 and PCI_D3hot */
248 if (state
> PCI_D3hot
)
251 mutex_lock(&pwr
->lock
);
252 ret
= __set_power_state(pwr
, pdev
, state
, id
, reg
, bit
);
253 mutex_unlock(&pwr
->lock
);
257 int intel_mid_pci_set_power_state(struct pci_dev
*pdev
, pci_power_t state
)
259 struct mid_pwr
*pwr
= midpwr
;
264 if (pwr
&& pwr
->available
)
265 ret
= mid_pwr_set_power_state(pwr
, pdev
, state
);
266 dev_vdbg(&pdev
->dev
, "set_power_state() returns %d\n", ret
);
271 pci_power_t
intel_mid_pci_get_power_state(struct pci_dev
*pdev
)
273 struct mid_pwr
*pwr
= midpwr
;
277 if (!pwr
|| !pwr
->available
)
280 id
= intel_mid_pwr_get_lss_id(pdev
);
284 reg
= (id
* LSS_PWS_BITS
) / 32;
285 bit
= (id
* LSS_PWS_BITS
) % 32;
286 power
= mid_pwr_get_state(pwr
, reg
);
287 return (__force pci_power_t
)((power
>> bit
) & 3);
290 void intel_mid_pwr_power_off(void)
292 struct mid_pwr
*pwr
= midpwr
;
293 u32 cmd
= PM_CMD_SYS_STATE_S5
|
294 PM_CMD_CMD(CMD_SET_CFG
) |
296 PM_CMD_CFG_TRIGGER_NC
|
299 /* Send command to SCU */
300 writel(cmd
, pwr
->regs
+ PM_CMD
);
304 int intel_mid_pwr_get_lss_id(struct pci_dev
*pdev
)
310 * Mapping to PWRMU index is kept in the Logical SubSystem ID byte of
313 vndr
= pci_find_capability(pdev
, PCI_CAP_ID_VNDR
);
317 /* Read the Logical SubSystem ID byte */
318 pci_read_config_byte(pdev
, vndr
+ INTEL_MID_PWR_LSS_OFFSET
, &id
);
319 if (!(id
& INTEL_MID_PWR_LSS_TYPE
))
322 id
&= ~INTEL_MID_PWR_LSS_TYPE
;
323 if (id
>= LSS_MAX_DEVS
)
329 static irqreturn_t
mid_pwr_irq_handler(int irq
, void *dev_id
)
331 struct mid_pwr
*pwr
= dev_id
;
334 ics
= readl(pwr
->regs
+ PM_ICS
);
335 if (!(ics
& PM_ICS_IP
))
338 writel(ics
| PM_ICS_IP
, pwr
->regs
+ PM_ICS
);
340 dev_warn(pwr
->dev
, "Unexpected IRQ: %#x\n", PM_ICS_INT_STATUS(ics
));
344 struct mid_pwr_device_info
{
345 int (*set_initial_state
)(struct mid_pwr
*pwr
);
348 static int mid_pwr_probe(struct pci_dev
*pdev
, const struct pci_device_id
*id
)
350 struct mid_pwr_device_info
*info
= (void *)id
->driver_data
;
351 struct device
*dev
= &pdev
->dev
;
355 ret
= pcim_enable_device(pdev
);
357 dev_err(&pdev
->dev
, "error: could not enable device\n");
361 ret
= pcim_iomap_regions(pdev
, 1 << 0, pci_name(pdev
));
363 dev_err(&pdev
->dev
, "I/O memory remapping failed\n");
367 pwr
= devm_kzalloc(dev
, sizeof(*pwr
), GFP_KERNEL
);
372 pwr
->regs
= pcim_iomap_table(pdev
)[0];
373 pwr
->irq
= pdev
->irq
;
375 mutex_init(&pwr
->lock
);
377 /* Disable interrupts */
378 mid_pwr_interrupt_disable(pwr
);
380 if (info
&& info
->set_initial_state
) {
381 ret
= info
->set_initial_state(pwr
);
383 dev_warn(dev
, "Can't set initial state: %d\n", ret
);
386 ret
= devm_request_irq(dev
, pdev
->irq
, mid_pwr_irq_handler
,
387 IRQF_NO_SUSPEND
, pci_name(pdev
), pwr
);
391 pwr
->available
= true;
394 pci_set_drvdata(pdev
, pwr
);
398 static int mid_set_initial_state(struct mid_pwr
*pwr
, const u32
*states
)
404 * Enable wake events.
406 * PWRMU supports up to 32 sources for wake up the system. Ungate them
409 mid_pwr_set_wake(pwr
, 0, 0xffffffff);
410 mid_pwr_set_wake(pwr
, 1, 0xffffffff);
413 * Power off South Complex devices.
415 * There is a map (see a note below) of 64 devices with 2 bits per each
416 * on 32-bit HW registers. The following calls set all devices to one
417 * known initial state, i.e. PCI_D3hot. This is done in conjunction
418 * with PMCSR setting in arch/x86/pci/intel_mid_pci.c.
420 * NOTE: The actual device mapping is provided by a platform at run
421 * time using vendor capability of PCI configuration space.
423 mid_pwr_set_state(pwr
, 0, states
[0]);
424 mid_pwr_set_state(pwr
, 1, states
[1]);
425 mid_pwr_set_state(pwr
, 2, states
[2]);
426 mid_pwr_set_state(pwr
, 3, states
[3]);
428 /* Send command to SCU */
429 ret
= mid_pwr_wait_for_cmd(pwr
, CMD_SET_CFG
);
433 for (i
= 0; i
< LSS_MAX_DEVS
; i
++) {
434 for (j
= 0; j
< LSS_MAX_SHARED_DEVS
; j
++)
435 pwr
->lss
[i
][j
].state
= PCI_D3hot
;
441 static int pnw_set_initial_state(struct mid_pwr
*pwr
)
443 /* On Penwell SRAM must stay powered on */
444 static const u32 states
[] = {
445 0xf00fffff, /* PM_SSC(0) */
446 0xffffffff, /* PM_SSC(1) */
447 0xffffffff, /* PM_SSC(2) */
448 0xffffffff, /* PM_SSC(3) */
450 return mid_set_initial_state(pwr
, states
);
453 static int tng_set_initial_state(struct mid_pwr
*pwr
)
455 static const u32 states
[] = {
456 0xffffffff, /* PM_SSC(0) */
457 0xffffffff, /* PM_SSC(1) */
458 0xffffffff, /* PM_SSC(2) */
459 0xffffffff, /* PM_SSC(3) */
461 return mid_set_initial_state(pwr
, states
);
464 static const struct mid_pwr_device_info pnw_info
= {
465 .set_initial_state
= pnw_set_initial_state
,
468 static const struct mid_pwr_device_info tng_info
= {
469 .set_initial_state
= tng_set_initial_state
,
472 /* This table should be in sync with the one in drivers/pci/pci-mid.c */
473 static const struct pci_device_id mid_pwr_pci_ids
[] = {
474 { PCI_VDEVICE(INTEL
, PCI_DEVICE_ID_PENWELL
), (kernel_ulong_t
)&pnw_info
},
475 { PCI_VDEVICE(INTEL
, PCI_DEVICE_ID_TANGIER
), (kernel_ulong_t
)&tng_info
},
479 static struct pci_driver mid_pwr_pci_driver
= {
480 .name
= "intel_mid_pwr",
481 .probe
= mid_pwr_probe
,
482 .id_table
= mid_pwr_pci_ids
,
485 builtin_pci_driver(mid_pwr_pci_driver
);