4 * Copyright (c) 2006 Fabrice Bellard
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License version 2 as published by the Free Software Foundation.
10 * This library is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * Lesser General Public License for more details.
15 * You should have received a copy of the GNU Lesser General Public
16 * License along with this library; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA
22 #include "qemu-timer.h"
30 /* i82731AB (PIIX4) compatible power management function */
31 #define PM_FREQ 3579545
33 #define ACPI_DBG_IO_ADDR 0xb044
35 typedef struct PIIX4PMState
{
43 int64_t tmr_overflow_time
;
56 #define RSM_STS (1 << 15)
57 #define PWRBTN_STS (1 << 8)
58 #define RTC_EN (1 << 10)
59 #define PWRBTN_EN (1 << 8)
60 #define GBL_EN (1 << 5)
61 #define TMROF_EN (1 << 0)
63 #define SCI_EN (1 << 0)
65 #define SUS_EN (1 << 13)
67 #define ACPI_ENABLE 0xf1
68 #define ACPI_DISABLE 0xf0
70 #define SMBHSTSTS 0x00
71 #define SMBHSTCNT 0x02
72 #define SMBHSTCMD 0x03
73 #define SMBHSTADD 0x04
74 #define SMBHSTDAT0 0x05
75 #define SMBHSTDAT1 0x06
76 #define SMBBLKDAT 0x07
78 static PIIX4PMState
*pm_state
;
80 static uint32_t get_pmtmr(PIIX4PMState
*s
)
83 d
= muldiv64(qemu_get_clock(vm_clock
), PM_FREQ
, ticks_per_sec
);
87 static int get_pmsts(PIIX4PMState
*s
)
92 d
= muldiv64(qemu_get_clock(vm_clock
), PM_FREQ
, ticks_per_sec
);
93 if (d
>= s
->tmr_overflow_time
)
98 static void pm_update_sci(PIIX4PMState
*s
)
100 int sci_level
, pmsts
;
103 pmsts
= get_pmsts(s
);
104 sci_level
= (((pmsts
& s
->pmen
) &
105 (RTC_EN
| PWRBTN_EN
| GBL_EN
| TMROF_EN
)) != 0);
106 qemu_set_irq(s
->irq
, sci_level
);
107 /* schedule a timer interruption if needed */
108 if ((s
->pmen
& TMROF_EN
) && !(pmsts
& TMROF_EN
)) {
109 expire_time
= muldiv64(s
->tmr_overflow_time
, ticks_per_sec
, PM_FREQ
);
110 qemu_mod_timer(s
->tmr_timer
, expire_time
);
112 qemu_del_timer(s
->tmr_timer
);
116 static void pm_tmr_timer(void *opaque
)
118 PIIX4PMState
*s
= opaque
;
122 static void pm_ioport_writew(void *opaque
, uint32_t addr
, uint32_t val
)
124 PIIX4PMState
*s
= opaque
;
131 pmsts
= get_pmsts(s
);
132 if (pmsts
& val
& TMROF_EN
) {
133 /* if TMRSTS is reset, then compute the new overflow time */
134 d
= muldiv64(qemu_get_clock(vm_clock
), PM_FREQ
, ticks_per_sec
);
135 s
->tmr_overflow_time
= (d
+ 0x800000LL
) & ~0x7fffffLL
;
148 s
->pmcntrl
= val
& ~(SUS_EN
);
150 /* change suspend type */
151 sus_typ
= (val
>> 10) & 7;
153 case 0: /* soft power off */
154 qemu_system_shutdown_request();
157 /* RSM_STS should be set on resume. Pretend that resume
158 was caused by power button */
159 s
->pmsts
|= (RSM_STS
| PWRBTN_STS
);
160 qemu_system_reset_request();
161 #if defined(TARGET_I386)
162 cmos_set_s3_resume();
174 printf("PM writew port=0x%04x val=0x%04x\n", addr
, val
);
178 static uint32_t pm_ioport_readw(void *opaque
, uint32_t addr
)
180 PIIX4PMState
*s
= opaque
;
199 printf("PM readw port=0x%04x val=0x%04x\n", addr
, val
);
204 static void pm_ioport_writel(void *opaque
, uint32_t addr
, uint32_t val
)
206 // PIIX4PMState *s = opaque;
209 printf("PM writel port=0x%04x val=0x%08x\n", addr
, val
);
213 static uint32_t pm_ioport_readl(void *opaque
, uint32_t addr
)
215 PIIX4PMState
*s
= opaque
;
228 printf("PM readl port=0x%04x val=0x%08x\n", addr
, val
);
233 static void pm_smi_writeb(void *opaque
, uint32_t addr
, uint32_t val
)
235 PIIX4PMState
*s
= opaque
;
238 printf("pm_smi_writeb addr=0x%x val=0x%02x\n", addr
, val
);
243 /* ACPI specs 3.0, 4.7.2.5 */
244 if (val
== ACPI_ENABLE
) {
245 s
->pmcntrl
|= SCI_EN
;
246 } else if (val
== ACPI_DISABLE
) {
247 s
->pmcntrl
&= ~SCI_EN
;
250 if (s
->dev
.config
[0x5b] & (1 << 1)) {
251 cpu_interrupt(first_cpu
, CPU_INTERRUPT_SMI
);
258 static uint32_t pm_smi_readb(void *opaque
, uint32_t addr
)
260 PIIX4PMState
*s
= opaque
;
270 printf("pm_smi_readb addr=0x%x val=0x%02x\n", addr
, val
);
275 static void acpi_dbg_writel(void *opaque
, uint32_t addr
, uint32_t val
)
278 printf("ACPI: DBG: 0x%08x\n", val
);
282 static void smb_transaction(PIIX4PMState
*s
)
284 uint8_t prot
= (s
->smb_ctl
>> 2) & 0x07;
285 uint8_t read
= s
->smb_addr
& 0x01;
286 uint8_t cmd
= s
->smb_cmd
;
287 uint8_t addr
= s
->smb_addr
>> 1;
288 i2c_bus
*bus
= s
->smbus
;
291 printf("SMBus trans addr=0x%02x prot=0x%02x\n", addr
, prot
);
295 smbus_quick_command(bus
, addr
, read
);
299 s
->smb_data0
= smbus_receive_byte(bus
, addr
);
301 smbus_send_byte(bus
, addr
, cmd
);
306 s
->smb_data0
= smbus_read_byte(bus
, addr
, cmd
);
308 smbus_write_byte(bus
, addr
, cmd
, s
->smb_data0
);
314 val
= smbus_read_word(bus
, addr
, cmd
);
316 s
->smb_data1
= val
>> 8;
318 smbus_write_word(bus
, addr
, cmd
, (s
->smb_data1
<< 8) | s
->smb_data0
);
323 s
->smb_data0
= smbus_read_block(bus
, addr
, cmd
, s
->smb_data
);
325 smbus_write_block(bus
, addr
, cmd
, s
->smb_data
, s
->smb_data0
);
337 static void smb_ioport_writeb(void *opaque
, uint32_t addr
, uint32_t val
)
339 PIIX4PMState
*s
= opaque
;
342 printf("SMB writeb port=0x%04x val=0x%02x\n", addr
, val
);
367 s
->smb_data
[s
->smb_index
++] = val
;
368 if (s
->smb_index
> 31)
376 static uint32_t smb_ioport_readb(void *opaque
, uint32_t addr
)
378 PIIX4PMState
*s
= opaque
;
388 val
= s
->smb_ctl
& 0x1f;
403 val
= s
->smb_data
[s
->smb_index
++];
404 if (s
->smb_index
> 31)
412 printf("SMB readb port=0x%04x val=0x%02x\n", addr
, val
);
417 static void pm_io_space_update(PIIX4PMState
*s
)
421 if (s
->dev
.config
[0x80] & 1) {
422 pm_io_base
= le32_to_cpu(*(uint32_t *)(s
->dev
.config
+ 0x40));
423 pm_io_base
&= 0xffc0;
425 /* XXX: need to improve memory and ioport allocation */
427 printf("PM: mapping to 0x%x\n", pm_io_base
);
429 register_ioport_write(pm_io_base
, 64, 2, pm_ioport_writew
, s
);
430 register_ioport_read(pm_io_base
, 64, 2, pm_ioport_readw
, s
);
431 register_ioport_write(pm_io_base
, 64, 4, pm_ioport_writel
, s
);
432 register_ioport_read(pm_io_base
, 64, 4, pm_ioport_readl
, s
);
436 static void pm_write_config(PCIDevice
*d
,
437 uint32_t address
, uint32_t val
, int len
)
439 pci_default_write_config(d
, address
, val
, len
);
441 pm_io_space_update((PIIX4PMState
*)d
);
444 static void pm_save(QEMUFile
* f
,void *opaque
)
446 PIIX4PMState
*s
= opaque
;
448 pci_device_save(&s
->dev
, f
);
450 qemu_put_be16s(f
, &s
->pmsts
);
451 qemu_put_be16s(f
, &s
->pmen
);
452 qemu_put_be16s(f
, &s
->pmcntrl
);
453 qemu_put_8s(f
, &s
->apmc
);
454 qemu_put_8s(f
, &s
->apms
);
455 qemu_put_timer(f
, s
->tmr_timer
);
456 qemu_put_be64(f
, s
->tmr_overflow_time
);
459 static int pm_load(QEMUFile
* f
,void* opaque
,int version_id
)
461 PIIX4PMState
*s
= opaque
;
467 ret
= pci_device_load(&s
->dev
, f
);
471 qemu_get_be16s(f
, &s
->pmsts
);
472 qemu_get_be16s(f
, &s
->pmen
);
473 qemu_get_be16s(f
, &s
->pmcntrl
);
474 qemu_get_8s(f
, &s
->apmc
);
475 qemu_get_8s(f
, &s
->apms
);
476 qemu_get_timer(f
, s
->tmr_timer
);
477 s
->tmr_overflow_time
=qemu_get_be64(f
);
479 pm_io_space_update(s
);
484 static void piix4_reset(void *opaque
)
486 PIIX4PMState
*s
= opaque
;
487 uint8_t *pci_conf
= s
->dev
.config
;
495 i2c_bus
*piix4_pm_init(PCIBus
*bus
, int devfn
, uint32_t smb_io_base
,
501 s
= (PIIX4PMState
*)pci_register_device(bus
,
502 "PM", sizeof(PIIX4PMState
),
503 devfn
, NULL
, pm_write_config
);
505 pci_conf
= s
->dev
.config
;
506 pci_config_set_vendor_id(pci_conf
, PCI_VENDOR_ID_INTEL
);
507 pci_config_set_device_id(pci_conf
, PCI_DEVICE_ID_INTEL_82371AB_3
);
508 pci_conf
[0x06] = 0x80;
509 pci_conf
[0x07] = 0x02;
510 pci_conf
[0x08] = 0x03; // revision number
511 pci_conf
[0x09] = 0x00;
512 pci_config_set_class(pci_conf
, PCI_CLASS_BRIDGE_OTHER
);
513 pci_conf
[0x0e] = 0x00; // header_type
514 pci_conf
[0x3d] = 0x01; // interrupt pin 1
516 pci_conf
[0x40] = 0x01; /* PM io base read only bit */
518 register_ioport_write(0xb2, 2, 1, pm_smi_writeb
, s
);
519 register_ioport_read(0xb2, 2, 1, pm_smi_readb
, s
);
521 register_ioport_write(ACPI_DBG_IO_ADDR
, 4, 4, acpi_dbg_writel
, s
);
524 /* Mark SMM as already inited to prevent SMM from running. KVM does not
525 * support SMM mode. */
526 pci_conf
[0x5B] = 0x02;
529 /* XXX: which specification is used ? The i82731AB has different
531 pci_conf
[0x5f] = (parallel_hds
[0] != NULL
? 0x80 : 0) | 0x10;
532 pci_conf
[0x63] = 0x60;
533 pci_conf
[0x67] = (serial_hds
[0] != NULL
? 0x08 : 0) |
534 (serial_hds
[1] != NULL
? 0x90 : 0);
536 pci_conf
[0x90] = smb_io_base
| 1;
537 pci_conf
[0x91] = smb_io_base
>> 8;
538 pci_conf
[0xd2] = 0x09;
539 register_ioport_write(smb_io_base
, 64, 1, smb_ioport_writeb
, s
);
540 register_ioport_read(smb_io_base
, 64, 1, smb_ioport_readb
, s
);
542 s
->tmr_timer
= qemu_new_timer(vm_clock
, pm_tmr_timer
, s
);
544 register_savevm("piix4_pm", 0, 1, pm_save
, pm_load
, s
);
546 s
->smbus
= i2c_init_bus();
548 qemu_register_reset(piix4_reset
, s
);
553 #if defined(TARGET_I386)
554 void qemu_system_powerdown(void)
557 qemu_system_shutdown_request();
558 } else if (pm_state
->pmen
& PWRBTN_EN
) {
559 pm_state
->pmsts
|= PWRBTN_EN
;
560 pm_update_sci(pm_state
);
565 #define GPE_BASE 0xafe0
566 #define PCI_BASE 0xae00
567 #define PCI_EJ_BASE 0xae08
570 uint16_t sts
; /* status */
571 uint16_t en
; /* enabled */
579 static struct gpe_regs gpe
;
580 static struct pci_status pci0_status
;
582 static uint32_t gpe_readb(void *opaque
, uint32_t addr
)
585 struct gpe_regs
*g
= opaque
;
591 val
= (g
->sts
>> 8) & 0xFF;
597 val
= (g
->en
>> 8) & 0xFF;
604 printf("gpe read %lx == %lx\n", addr
, val
);
609 static void gpe_writeb(void *opaque
, uint32_t addr
, uint32_t val
)
611 struct gpe_regs
*g
= opaque
;
614 g
->sts
= (g
->sts
& ~0xFFFF) | (val
& 0xFFFF);
617 g
->sts
= (g
->sts
& 0xFFFF) | (val
<< 8);
620 g
->en
= (g
->en
& ~0xFFFF) | (val
& 0xFFFF);
623 g
->en
= (g
->en
& 0xFFFF) | (val
<< 8);
630 printf("gpe write %lx <== %d\n", addr
, val
);
634 static uint32_t pcihotplug_read(void *opaque
, uint32_t addr
)
637 struct pci_status
*g
= opaque
;
650 printf("pcihotplug read %lx == %lx\n", addr
, val
);
655 static void pcihotplug_write(void *opaque
, uint32_t addr
, uint32_t val
)
657 struct pci_status
*g
= opaque
;
668 printf("pcihotplug write %lx <== %d\n", addr
, val
);
672 static uint32_t pciej_read(void *opaque
, uint32_t addr
)
675 printf("pciej read %lx == %lx\n", addr
, val
);
680 static void pciej_write(void *opaque
, uint32_t addr
, uint32_t val
)
682 int slot
= ffs(val
) - 1;
685 printf("pciej write %lx <== %d\n", addr
, val
);
689 void qemu_system_hot_add_init(void)
691 register_ioport_write(GPE_BASE
, 4, 1, gpe_writeb
, &gpe
);
692 register_ioport_read(GPE_BASE
, 4, 1, gpe_readb
, &gpe
);
694 register_ioport_write(PCI_BASE
, 8, 4, pcihotplug_write
, &pci0_status
);
695 register_ioport_read(PCI_BASE
, 8, 4, pcihotplug_read
, &pci0_status
);
697 register_ioport_write(PCI_EJ_BASE
, 4, 4, pciej_write
, NULL
);
698 register_ioport_read(PCI_EJ_BASE
, 4, 4, pciej_read
, NULL
);
701 static void enable_device(struct pci_status
*p
, struct gpe_regs
*g
, int slot
)
705 p
->up
|= (1 << slot
);
708 static void disable_device(struct pci_status
*p
, struct gpe_regs
*g
, int slot
)
712 p
->down
|= (1 << slot
);
715 void qemu_system_device_hot_add(int bus
, int slot
, int state
)
717 qemu_set_irq(pm_state
->irq
, 1);
719 pci0_status
.down
= 0;
721 enable_device(&pci0_status
, &gpe
, slot
);
723 disable_device(&pci0_status
, &gpe
, slot
);
724 qemu_set_irq(pm_state
->irq
, 0);