d/freebsd-dev
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Add ACPI S2-S4BIOS Suspend/Resume code.

Browse Source 
Some problems may remain.

Reviewed by:iwasaki
This commit is contained in:
takawata 2001-07-20 06:07:34 +00:00
parent 6236550bdb
commit 8085002fc5
16 changed files with 1093 additions and 29 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

328
sys/amd64/acpica/acpi_wakeup.c Normal file
View File

@ -0,0 +1,328 @@
/*-
* Copyright (c) 2001 Takanori Watanabe <takawata@jp.freebsd.org>
* Copyright (c) 2001 Mitsuru IWASAKI <iwasaki@jp.freebsd.org>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* $FreeBSD$
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <sys/lock.h>
#include <sys/mutex.h>
#include <sys/proc.h>
#include <sys/sysctl.h>
#include <vm/vm.h>
#include <vm/vm_param.h>
#include <vm/pmap.h>
#include <vm/vm_page.h>
#include <vm/vm_map.h>
#include <vm/vm_kern.h>
#include <vm/vm_extern.h>
#include <machine/bus.h>
#include <machine/cpufunc.h>
#include <machine/segments.h>
#include <i386/isa/intr_machdep.h>
#include "acpi.h"
#include <dev/acpica/acpivar.h>
#include "acpi_wakecode.h"
extern void initializecpu(void);
struct region_descriptor r_idt, r_gdt, *p_gdt;
static u_int16_t r_ldt;
static u_int32_t r_eax, r_ebx, r_ecx, r_edx, r_ebp, r_esi, r_edi,
r_efl, r_cr0, r_cr2, r_cr3, r_cr4, ret_addr;
static u_int16_t r_cs, r_ds, r_es, r_fs, r_gs, r_ss, r_tr;
static u_int32_t r_esp = 0;
static int debug_wakeup = 1;
SYSCTL_INT(_debug, OID_AUTO, acpi_wakeup, CTLFLAG_RW, &debug_wakeup, 0, "")
static void acpi_printcpu(void);
static void acpi_realmodeinst(void *arg, bus_dma_segment_t *segs,
int nsegs, int error);
static void acpi_alloc_wakeup_handler(void);
/* XXX shut gcc up */
extern int acpi_savecpu(void);
extern int acpi_restorecpu(void);
__asm__("
.text
.p2align 2, 0x90
.type acpi_restorecpu, @function
acpi_restorecpu:
.align 4
movl r_eax,%eax
movl r_ebx,%ebx
movl r_ecx,%ecx
movl r_edx,%edx
movl r_ebp,%ebp
movl r_esi,%esi
movl r_edi,%edi
movl r_esp,%esp
pushl r_efl
popfl
pushl ret_addr
xorl %eax,%eax
ret
.text
.p2align 2, 0x90
.type acpi_savecpu, @function
acpi_savecpu:
movw %cs,r_cs
movw %ds,r_ds
movw %es,r_es
movw %fs,r_fs
movw %gs,r_gs
movw %ss,r_ss
movl %eax,r_eax
movl %ebx,r_ebx
movl %ecx,r_ecx
movl %edx,r_edx
movl %ebp,r_ebp
movl %esi,r_esi
movl %edi,r_edi
movl %cr0,%eax
movl %eax,r_cr0
movl %cr2,%eax
movl %eax,r_cr2
movl %cr3,%eax
movl %eax,r_cr3
movl %cr4,%eax
movl %eax,r_cr4
pushfl
popl r_efl
movl %esp,r_esp
sgdt r_gdt
sidt r_idt
sldt r_ldt
str r_tr
movl (%esp),%eax
movl %eax,ret_addr
movl $1,%eax
ret
");
static void
acpi_printcpu(void)
{
printf("======== acpi_printcpu() debug dump ========\n");
printf("gdt[%04x:%08x] idt[%04x:%08x] ldt[%04x] tr[%04x] efl[%08x]\n",
r_gdt.rd_limit, r_gdt.rd_base, r_idt.rd_limit, r_idt.rd_base,
r_ldt, r_tr, r_efl);
printf("eax[%08x] ebx[%08x] ecx[%08x] edx[%08x]\n",
r_eax, r_ebx, r_ecx, r_edx);
printf("esi[%08x] edi[%08x] ebp[%08x] esp[%08x]\n",
r_esi, r_edi, r_ebp, r_esp);
printf("cr0[%08x] cr2[%08x] cr3[%08x] cr4[%08x]\n",
r_cr0, r_cr2, r_cr3, r_cr4);
printf("cs[%04x] ds[%04x] es[%04x] fs[%04x] gs[%04x] ss[%04x]\n",
r_cs, r_ds, r_es, r_fs, r_gs, r_ss);
}
int
acpi_sleep_machdep(struct acpi_softc *sc, int state)
{
ACPI_STATUS status;
void **addr;
vm_offset_t oldphys;
struct pmap *pm;
vm_page_t page;
static vm_page_t opage = NULL;
int ret = 0;
u_long ef;
if (sc->acpi_wakeaddr == NULL) {
return (0);
}
AcpiSetFirmwareWakingVector(sc->acpi_wakephys);
ef = read_eflags();
disable_intr();
/* Create Identity Mapping */
pm = &CURPROC->p_vmspace->vm_pmap;
oldphys = pmap_extract(pm, sc->acpi_wakephys);
if (oldphys) {
opage = PHYS_TO_VM_PAGE(oldphys);
}
page = PHYS_TO_VM_PAGE(sc->acpi_wakephys);
pmap_enter(pm, sc->acpi_wakephys, page,
VM_PROT_READ | VM_PROT_WRITE | VM_PROT_EXECUTE, 1);
ret_addr = 0;
if (acpi_savecpu()) {
/* Execute Sleep */
p_gdt = (struct region_descriptor *)(sc->acpi_wakeaddr + physical_gdt);
p_gdt->rd_limit = r_gdt.rd_limit;
p_gdt->rd_base = vtophys(r_gdt.rd_base);
addr = (void **)(sc->acpi_wakeaddr + physical_esp);
(u_int32_t *)*addr = vtophys(r_esp);
addr = (void **)(sc->acpi_wakeaddr + previous_cr0);
(u_int32_t *)*addr = r_cr0;
addr = (void **)(sc->acpi_wakeaddr + previous_cr2);
(u_int32_t *)*addr = r_cr2;
addr = (void **)(sc->acpi_wakeaddr + previous_cr3);
(u_int32_t *)*addr = r_cr3;
addr = (void **)(sc->acpi_wakeaddr + previous_cr4);
(u_int32_t *)*addr = r_cr4;
addr = (void **)(sc->acpi_wakeaddr + previous_tr);
(u_int16_t *)*addr = r_tr;
addr = (void **)(sc->acpi_wakeaddr + previous_gdt);
bcopy(&r_gdt, addr, sizeof(r_gdt));
addr = (void **)(sc->acpi_wakeaddr + previous_ldt);
(u_int16_t *)*addr = r_ldt;
addr = (void **)(sc->acpi_wakeaddr + previous_idt);
bcopy(&r_idt, addr, sizeof(r_idt));
addr = (void **)(sc->acpi_wakeaddr + where_to_recover);
*addr = acpi_restorecpu;
addr = (void **)(sc->acpi_wakeaddr + previous_ds);
(u_int16_t *)*addr = r_ds;
addr = (void **)(sc->acpi_wakeaddr + previous_es);
(u_int16_t *)*addr = r_es;
addr = (void **)(sc->acpi_wakeaddr + previous_fs);
(u_int16_t *)*addr = r_fs;
addr = (void **)(sc->acpi_wakeaddr + previous_gs);
(u_int16_t *)*addr = r_gs;
addr = (void **)(sc->acpi_wakeaddr + previous_ss);
(u_int16_t *)*addr = r_ss;
if (debug_wakeup) {
acpi_printcpu();
}
if ((status = AcpiEnterSleepState(state)) != AE_OK) {
device_printf(sc->acpi_dev,
"AcpiEnterSleepState failed - %s\n",
acpi_strerror(status));
ret = -1;
goto out;
}
wbinvd();
for (;;) ;
} else {
/* Execute Wakeup */
#if 0
initializecpu();
#endif
icu_reinit();
pmap_remove(pm, sc->acpi_wakephys,
sc->acpi_wakephys + PAGE_SIZE);
if (opage) {
pmap_enter(pm, sc->acpi_wakephys, page,
VM_PROT_READ | VM_PROT_WRITE, 0);
}
if (debug_wakeup) {
acpi_savecpu();
acpi_printcpu();
}
}
out:
write_eflags(ef);
return (ret);
}
static bus_dma_tag_t acpi_waketag;
static bus_dmamap_t acpi_wakemap;
static vm_offset_t acpi_wakeaddr = 0;
static void
acpi_alloc_wakeup_handler(void)
{
if (bus_dma_tag_create(/* parent */ NULL, /* alignment */ 2, 0,
/* lowaddr below 1MB */ 0x9ffff,
/* highaddr */ BUS_SPACE_MAXADDR, NULL, NULL,
PAGE_SIZE, 1, PAGE_SIZE, 0, &acpi_waketag) != 0) {
printf("acpi_alloc_wakeup_handler: unable to create wake tag\n");
return;
}
if (bus_dmamem_alloc(acpi_waketag, (void **)&acpi_wakeaddr,
BUS_DMA_NOWAIT, &acpi_wakemap)) {
printf("acpi_alloc_wakeup_handler: unable to allocate wake memory\n");
return;
}
}
SYSINIT(acpiwakeup, SI_SUB_KMEM, SI_ORDER_ANY, acpi_alloc_wakeup_handler, 0)
static void
acpi_realmodeinst(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
{
struct acpi_softc *sc = arg;
u_int32_t *addr;
addr = (u_int32_t *)&wakecode[wakeup_sw32 + 2];
*addr = segs[0].ds_addr + wakeup_32;
bcopy(wakecode, (void *)sc->acpi_wakeaddr, sizeof(wakecode));
sc->acpi_wakephys = segs[0].ds_addr;
}
void
acpi_install_wakeup_handler(struct acpi_softc *sc)
{
if (acpi_wakeaddr == 0) {
return;
}
sc->acpi_waketag = acpi_waketag;
sc->acpi_wakeaddr = acpi_wakeaddr;
sc->acpi_wakemap = acpi_wakemap;
bus_dmamap_load(sc->acpi_waketag, sc->acpi_wakemap,
(void *)sc->acpi_wakeaddr, PAGE_SIZE,
acpi_realmodeinst, sc, 0);
}

27
sys/amd64/isa/intr_machdep.c
View File

@ -135,6 +135,7 @@ static driver_intr_t isa_strayintr;
static void ithds_init(void *dummy);
static void ithread_enable(int vector);
static void ithread_disable(int vector);
static void init_i8259(void);
#ifdef PC98
#define NMI_PARITY 0x04
@ -281,6 +282,22 @@ isa_nmi(cd)
return(retval);
}
/*
* ICU reinitialize when ICU configuration has lost.
*/
void icu_reinit()
{
int i;
u_int32_t eflags;
eflags = read_eflags();
disable_intr();
init_i8259();
for(i=0;i<ICU_LEN;i++)
if(intr_handler[i] != isa_strayintr)
INTREN(1<<i);
write_eflags(eflags);
}
/*
* Create a default interrupt table to avoid problems caused by
* spurious interrupts during configuration of kernel, then setup
@ -294,8 +311,16 @@ isa_defaultirq()
/* icu vectors */
for (i = 0; i < ICU_LEN; i++)
icu_unset(i, (driver_intr_t *)NULL);
init_i8259();
}
/*
*initialize 8259's
*/
static void init_i8259()
{
/* initialize 8259's */
#ifdef DEV_MCA
if (MCA_system)
outb(IO_ICU1, 0x19); /* reset; program device, four bytes */

1
sys/amd64/isa/intr_machdep.h
View File

@ -210,6 +210,7 @@ int isa_nmi __P((int cd));
int icu_setup __P((int intr, driver_intr_t *func, void *arg,
int flags));
int icu_unset __P((int intr, driver_intr_t *handler));
void icu_reinit(void);
/*
* WARNING: These are internal functions and not to be used by device drivers!

27
sys/amd64/isa/nmi.c
View File

@ -135,6 +135,7 @@ static driver_intr_t isa_strayintr;
static void ithds_init(void *dummy);
static void ithread_enable(int vector);
static void ithread_disable(int vector);
static void init_i8259(void);
#ifdef PC98
#define NMI_PARITY 0x04
@ -281,6 +282,22 @@ isa_nmi(cd)
return(retval);
}
/*
* ICU reinitialize when ICU configuration has lost.
*/
void icu_reinit()
{
int i;
u_int32_t eflags;
eflags = read_eflags();
disable_intr();
init_i8259();
for(i=0;i<ICU_LEN;i++)
if(intr_handler[i] != isa_strayintr)
INTREN(1<<i);
write_eflags(eflags);
}
/*
* Create a default interrupt table to avoid problems caused by
* spurious interrupts during configuration of kernel, then setup
@ -294,8 +311,16 @@ isa_defaultirq()
/* icu vectors */
for (i = 0; i < ICU_LEN; i++)
icu_unset(i, (driver_intr_t *)NULL);
init_i8259();
}
/*
*initialize 8259's
*/
static void init_i8259()
{
/* initialize 8259's */
#ifdef DEV_MCA
if (MCA_system)
outb(IO_ICU1, 0x19); /* reset; program device, four bytes */

7
sys/conf/files.i386
View File

@ -158,6 +158,13 @@ gnu/i386/fpemul/reg_u_mul.s optional gpl_math_emulate
gnu/i386/fpemul/reg_u_sub.s optional gpl_math_emulate
gnu/i386/fpemul/wm_shrx.s optional gpl_math_emulate
gnu/i386/fpemul/wm_sqrt.s optional gpl_math_emulate
i386/acpica/acpi_wakeup.c optional acpica
acpi_wakecode.h optional acpica \
dependency "$S/i386/acpica/acpi_wakecode.S" \
compile-with "${MAKE} -f $S/i386/acpica/Makefile MAKESRCPATH=$S/i386/acpica" \
no-obj no-implicit-rule before-depend \
clean "acpi_wakecode.h acpi_wakecode.o acpi_wakecode.bin"
#
i386/apm/apm.c optional apm
i386/i386/atomic.c standard \
compile-with "${CC} -c ${CFLAGS} ${DEFINED_PROF:S/^$/-fomit-frame-pointer/} ${.IMPSRC}"

60
sys/dev/acpica/acpi.c
View File

@ -262,6 +262,8 @@ acpi_attach(device_t dev)
bzero(sc, sizeof(*sc));
sc->acpi_dev = dev;
acpi_install_wakeup_handler(sc);
#ifdef ENABLE_DEBUGGER
if (debugpoint && !strcmp(debugpoint, "spaces"))
acpi_EnterDebugger();
@ -959,7 +961,6 @@ acpi_FindIndexedResource(ACPI_RESOURCE *resbuf, int index, ACPI_RESOURCE **resp)
static ACPI_STATUS __inline
acpi_wakeup(UINT8 state)
{
UINT16 Count;
ACPI_STATUS Status;
ACPI_OBJECT_LIST Arg_list;
ACPI_OBJECT Arg;
@ -968,21 +969,6 @@ acpi_wakeup(UINT8 state)
FUNCTION_TRACE_U32(__func__, state);
ACPI_ASSERTLOCK;
/* wait for the WAK_STS bit */
Count = 0;
while (!(AcpiHwRegisterBitAccess(ACPI_READ, ACPI_MTX_LOCK, WAK_STS))) {
AcpiOsSleepUsec(1000);
/*
* Some BIOSes don't set WAK_STS at all,
* give up waiting for wakeup if we time out.
*/
if (Count > 1000) {
printf("ACPI: timed out waiting for WAK_STS, continuing\n");
break; /* giving up */
}
Count++;
}
/*
* Evaluate the _WAK method
@ -1056,6 +1042,7 @@ ACPI_STATUS
acpi_SetSleepState(struct acpi_softc *sc, int state)
{
ACPI_STATUS status = AE_OK;
UINT16 Count;
FUNCTION_TRACE_U32(__func__, state);
ACPI_ASSERTLOCK;
@ -1069,6 +1056,9 @@ acpi_SetSleepState(struct acpi_softc *sc, int state)
break;
case ACPI_STATE_S1:
case ACPI_STATE_S2:
case ACPI_STATE_S3:
case ACPI_STATE_S4:
/*
* Inform all devices that we are going to sleep.
*/
@ -1084,10 +1074,37 @@ acpi_SetSleepState(struct acpi_softc *sc, int state)
return_ACPI_STATUS(AE_ERROR);
}
sc->acpi_sstate = state;
status = AcpiEnterSleepState((UINT8)state);
if (status != AE_OK) {
device_printf(sc->acpi_dev, "AcpiEnterSleepState failed - %s\n", acpi_strerror(status));
break;
if (state != ACPI_STATE_S1) {
acpi_sleep_machdep(sc, state);
/* AcpiEnterSleepState() maybe incompleted, unlock here. */
AcpiUtReleaseMutex(ACPI_MTX_HARDWARE);
/* Re-enable ACPI hardware on wakeup from sleep state 4. */
if (state >= ACPI_STATE_S4) {
acpi_Disable(sc);
acpi_Enable(sc);
}
} else {
status = AcpiEnterSleepState((UINT8)state);
if (status != AE_OK) {
device_printf(sc->acpi_dev, "AcpiEnterSleepState failed - %s\n", acpi_strerror(status));
break;
}
/* wait for the WAK_STS bit */
Count = 0;
while (!(AcpiHwRegisterBitAccess(ACPI_READ, ACPI_MTX_LOCK, WAK_STS))) {
AcpiOsSleepUsec(1000);
/*
* Some BIOSes don't set WAK_STS at all,
* give up waiting for wakeup if we time out.
*/
if (Count > 1000) {
break; /* giving up */
}
Count++;
}
}
acpi_wakeup((UINT8)state);
DEVICE_RESUME(root_bus);
@ -1095,9 +1112,6 @@ acpi_SetSleepState(struct acpi_softc *sc, int state)
acpi_enable_fixed_events(sc);
break;
case ACPI_STATE_S3:
acpi_off_state = ACPI_STATE_S3;
/* FALLTHROUGH */
case ACPI_STATE_S5:
/*
* Shut down cleanly and power off. This will call us back through the

11
sys/dev/acpica/acpivar.h
View File

@ -32,6 +32,9 @@
#include <sys/eventhandler.h>
#include <sys/sysctl.h>
#include <machine/bus.h>
#include <machine/resource.h>
extern devclass_t acpi_devclass;
struct acpi_softc {
@ -54,6 +57,11 @@ struct acpi_softc {
int acpi_sleep_button_sx;
int acpi_lid_switch_sx;
bus_dma_tag_t acpi_waketag;
bus_dmamap_t acpi_wakemap;
vm_offset_t acpi_wakeaddr;
vm_offset_t acpi_wakephys;
struct sysctl_ctx_list acpi_battery_sysctl_ctx;
struct sysctl_oid *acpi_battery_sysctl_tree;
};
@ -267,6 +275,9 @@ extern char *acpi_name(ACPI_HANDLE handle);
extern int acpi_avoid(ACPI_HANDLE handle);
extern int acpi_disabled(char *subsys);
extern void acpi_install_wakeup_handler(struct acpi_softc *sc);
extern int acpi_sleep_machdep(struct acpi_softc *sc, int state);
/*
* Battery Abstruction.
*/

24
sys/i386/acpica/Makefile Normal file
View File

@ -0,0 +1,24 @@
# $FreeBSD$
# Correct path for kernel builds
# Don't rely on the kernel's .depend file
.ifdef MAKESRCPATH
.PATH: ${MAKESRCPATH}
DEPENDFILE=
.else
MAKESRCPATH= ${.CURDIR}
CLEANFILES= acpi_wakecode.h acpi_wakecode.bin acpi_wakecode.o
.endif
all: acpi_wakecode.h
acpi_wakecode.o: acpi_wakecode.S
acpi_wakecode.bin: acpi_wakecode.o
objcopy -S -O binary acpi_wakecode.o acpi_wakecode.bin
acpi_wakecode.h: acpi_wakecode.bin acpi_wakecode.o
perl ${MAKESRCPATH}/genwakecode.pl > acpi_wakecode.h
.include <bsd.prog.mk>

218
sys/i386/acpica/acpi_wakecode.S Normal file
View File

@ -0,0 +1,218 @@
/*-
* Copyright (c) 2001 Takanori Watanabe <takawata@jp.freebsd.org>
* Copyright (c) 2001 Mitsuru IWASAKI <iwasaki@jp.freebsd.org>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* $FreeBSD$
*/
#define LOCORE
#include <machine/specialreg.h>
.align 4
.code16
wakeup_16:
nop
cli
/* Set up segment registers for real mode */
movw %cs,%ax
movw %ax,%ds
movw %ax,%ss
/* Load GDT for real mode */
lgdt physical_gdt
/* Restore CR2, CR3 and CR4 */
mov previous_cr2,%eax
mov %eax,%cr2
mov previous_cr3,%eax
mov %eax,%cr3
mov previous_cr4,%eax
mov %eax,%cr4
/* Transfer some values to protected mode */
#define NVALUES 9
#define TRANSFER_STACK32(val, idx) \
mov val,%eax; \
mov %eax,wakeup_32stack+(idx+1)+(idx*4);
TRANSFER_STACK32(previous_ss, (NVALUES - 9))
TRANSFER_STACK32(previous_fs, (NVALUES - 8))
TRANSFER_STACK32(previous_ds, (NVALUES - 7))
TRANSFER_STACK32(physical_gdt+2, (NVALUES - 6))
TRANSFER_STACK32(where_to_recover, (NVALUES - 5))
TRANSFER_STACK32(previous_idt+2, (NVALUES - 4))
TRANSFER_STACK32(previous_ldt, (NVALUES - 3))
TRANSFER_STACK32(previous_gdt+2, (NVALUES - 2))
TRANSFER_STACK32(previous_tr, (NVALUES - 1))
TRANSFER_STACK32(previous_cr0, (NVALUES - 0))
mov physical_esp,%esi /* to be used in 32bit code */
/* Enable protected mode */
mov %cr0,%eax
orl $(CR0_PE),%eax
mov %eax,%cr0
wakeup_sw32:
/* Switch to protected mode by intersegmental jump */
ljmpl $0x8,$0x12345678 /* Code location, to be replaced */
.code32
wakeup_32:
/*
* Switched to protected mode w/o paging
* %esi: KERNEL stack pointer (physical address)
*/
nop
/* Set up segment registers for protected mode */
movw $0x10,%ax /* KDSEL to segment registers */
movw %ax,%ds
movw %ax,%es
movw %ax,%gs
movw %ax,%ss
movw $0x18,%ax /* KPSEL to %fs */
movw %ax,%fs
movl %esi,%esp /* physical address stack pointer */
wakeup_32stack:
/* Operands are overwritten in 16bit code */
pushl $0xabcdef09 /* ss + dummy */
pushl $0xabcdef08 /* fs + gs */
pushl $0xabcdef07 /* ds + es */
pushl $0xabcdef06 /* gdt:base (physical address) */
pushl $0xabcdef05 /* recover address */
pushl $0xabcdef04 /* idt:base */
pushl $0xabcdef03 /* ldt + idt:limit */
pushl $0xabcdef02 /* gdt:base */
pushl $0xabcdef01 /* TR + gdt:limit */
pushl $0xabcdef00 /* CR0 */
movl %esp,%ebp
#define CR0_REGISTER 0(%ebp)
#define TASK_REGISTER 4(%ebp)
#define PREVIOUS_GDT 6(%ebp)
#define PREVIOUS_LDT 12(%ebp)
#define PREVIOUS_IDT 14(%ebp)
#define RECOVER_ADDR 20(%ebp)
#define PHYSICAL_GDT_BASE 24(%ebp)
#define PREVIOUS_DS 28(%ebp)
#define PREVIOUS_ES 30(%ebp)
#define PREVIOUS_FS 32(%ebp)
#define PREVIOUS_GS 34(%ebp)
#define PREVIOUS_SS 36(%ebp)
/* Fixup TSS type field */
#define TSS_TYPEFIX_MASK 0xf9
xorl %esi,%esi
movl PHYSICAL_GDT_BASE,%ebx
movw TASK_REGISTER,%si
leal (%ebx,%esi),%eax /* get TSS segment descriptor */
andb $TSS_TYPEFIX_MASK,5(%eax)
/* Prepare to return to sleep/wakeup code point */
lgdt PREVIOUS_GDT
lidt PREVIOUS_IDT
xorl %eax,%eax
movl %eax,%ebx
movl %eax,%ecx
movl %eax,%edx
movl %eax,%esi
movl %eax,%edi
movl PREVIOUS_DS,%ebx
movl PREVIOUS_FS,%ecx
movl PREVIOUS_SS,%edx
movw TASK_REGISTER,%si
shll $16,%esi
movw PREVIOUS_LDT,%si
movl RECOVER_ADDR,%edi
/* Enable paging and etc. */
movl CR0_REGISTER,%eax
movl %eax,%cr0
/* Flush the prefetch queue */
jmp 1f
1: jmp 1f
1:
/*
* Now that we are in kernel virtual memory addressing
* %ebx: ds + es
* %ecx: fs + gs
* %edx: ss + dummy
* %esi: LDTR + TR
* %edi: recover address
*/
nop
movl %esi,%eax /* LDTR + TR */
lldt %ax /* load LDT register */
shrl $16,%eax
ltr %ax /* load task register */
/* Restore segment registers */
movl %ebx,%eax /* ds + es */
movw %ax,%ds
shrl $16,%eax
movw %ax,%es
movl %ecx,%eax /* fs + gs */
movw %ax,%fs
shrl $16,%eax
movw %ax,%gs
movl %edx,%eax /* ss */
movw %ax,%ss
/* Jump to acpi_restorecpu() */
jmp *%edi
/* used in real mode */
physical_gdt: .word 0
.long 0
physical_esp: .long 0
previous_cr2: .long 0
previous_cr3: .long 0
previous_cr4: .long 0
/* transfer from real mode to protected mode */
previous_cr0: .long 0
previous_tr: .word 0
previous_gdt: .word 0
.long 0
previous_ldt: .word 0
previous_idt: .word 0
.long 0
where_to_recover: .long 0
previous_ds: .word 0
previous_es: .word 0
previous_fs: .word 0
previous_gs: .word 0
previous_ss: .word 0
dummy: .word 0

328
sys/i386/acpica/acpi_wakeup.c Normal file
View File

@ -0,0 +1,328 @@
/*-
* Copyright (c) 2001 Takanori Watanabe <takawata@jp.freebsd.org>
* Copyright (c) 2001 Mitsuru IWASAKI <iwasaki@jp.freebsd.org>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* $FreeBSD$
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <sys/lock.h>
#include <sys/mutex.h>
#include <sys/proc.h>
#include <sys/sysctl.h>
#include <vm/vm.h>
#include <vm/vm_param.h>
#include <vm/pmap.h>
#include <vm/vm_page.h>
#include <vm/vm_map.h>
#include <vm/vm_kern.h>
#include <vm/vm_extern.h>
#include <machine/bus.h>
#include <machine/cpufunc.h>
#include <machine/segments.h>
#include <i386/isa/intr_machdep.h>
#include "acpi.h"
#include <dev/acpica/acpivar.h>
#include "acpi_wakecode.h"
extern void initializecpu(void);
struct region_descriptor r_idt, r_gdt, *p_gdt;
static u_int16_t r_ldt;
static u_int32_t r_eax, r_ebx, r_ecx, r_edx, r_ebp, r_esi, r_edi,
r_efl, r_cr0, r_cr2, r_cr3, r_cr4, ret_addr;
static u_int16_t r_cs, r_ds, r_es, r_fs, r_gs, r_ss, r_tr;
static u_int32_t r_esp = 0;
static int debug_wakeup = 1;
SYSCTL_INT(_debug, OID_AUTO, acpi_wakeup, CTLFLAG_RW, &debug_wakeup, 0, "")
static void acpi_printcpu(void);
static void acpi_realmodeinst(void *arg, bus_dma_segment_t *segs,
int nsegs, int error);
static void acpi_alloc_wakeup_handler(void);
/* XXX shut gcc up */
extern int acpi_savecpu(void);
extern int acpi_restorecpu(void);
__asm__("
.text
.p2align 2, 0x90
.type acpi_restorecpu, @function
acpi_restorecpu:
.align 4
movl r_eax,%eax
movl r_ebx,%ebx
movl r_ecx,%ecx
movl r_edx,%edx
movl r_ebp,%ebp
movl r_esi,%esi
movl r_edi,%edi
movl r_esp,%esp
pushl r_efl
popfl
pushl ret_addr
xorl %eax,%eax
ret
.text
.p2align 2, 0x90
.type acpi_savecpu, @function
acpi_savecpu:
movw %cs,r_cs
movw %ds,r_ds
movw %es,r_es
movw %fs,r_fs
movw %gs,r_gs
movw %ss,r_ss
movl %eax,r_eax
movl %ebx,r_ebx
movl %ecx,r_ecx
movl %edx,r_edx
movl %ebp,r_ebp
movl %esi,r_esi
movl %edi,r_edi
movl %cr0,%eax
movl %eax,r_cr0
movl %cr2,%eax
movl %eax,r_cr2
movl %cr3,%eax
movl %eax,r_cr3
movl %cr4,%eax
movl %eax,r_cr4
pushfl
popl r_efl
movl %esp,r_esp
sgdt r_gdt
sidt r_idt
sldt r_ldt
str r_tr
movl (%esp),%eax
movl %eax,ret_addr
movl $1,%eax
ret
");
static void
acpi_printcpu(void)
{
printf("======== acpi_printcpu() debug dump ========\n");
printf("gdt[%04x:%08x] idt[%04x:%08x] ldt[%04x] tr[%04x] efl[%08x]\n",
r_gdt.rd_limit, r_gdt.rd_base, r_idt.rd_limit, r_idt.rd_base,
r_ldt, r_tr, r_efl);
printf("eax[%08x] ebx[%08x] ecx[%08x] edx[%08x]\n",
r_eax, r_ebx, r_ecx, r_edx);
printf("esi[%08x] edi[%08x] ebp[%08x] esp[%08x]\n",
r_esi, r_edi, r_ebp, r_esp);
printf("cr0[%08x] cr2[%08x] cr3[%08x] cr4[%08x]\n",
r_cr0, r_cr2, r_cr3, r_cr4);
printf("cs[%04x] ds[%04x] es[%04x] fs[%04x] gs[%04x] ss[%04x]\n",
r_cs, r_ds, r_es, r_fs, r_gs, r_ss);
}
int
acpi_sleep_machdep(struct acpi_softc *sc, int state)
{
ACPI_STATUS status;
void **addr;
vm_offset_t oldphys;
struct pmap *pm;
vm_page_t page;
static vm_page_t opage = NULL;
int ret = 0;
u_long ef;
if (sc->acpi_wakeaddr == NULL) {
return (0);
}
AcpiSetFirmwareWakingVector(sc->acpi_wakephys);
ef = read_eflags();
disable_intr();
/* Create Identity Mapping */
pm = &CURPROC->p_vmspace->vm_pmap;
oldphys = pmap_extract(pm, sc->acpi_wakephys);
if (oldphys) {
opage = PHYS_TO_VM_PAGE(oldphys);
}
page = PHYS_TO_VM_PAGE(sc->acpi_wakephys);
pmap_enter(pm, sc->acpi_wakephys, page,
VM_PROT_READ | VM_PROT_WRITE | VM_PROT_EXECUTE, 1);
ret_addr = 0;
if (acpi_savecpu()) {
/* Execute Sleep */
p_gdt = (struct region_descriptor *)(sc->acpi_wakeaddr + physical_gdt);
p_gdt->rd_limit = r_gdt.rd_limit;
p_gdt->rd_base = vtophys(r_gdt.rd_base);
addr = (void **)(sc->acpi_wakeaddr + physical_esp);
(u_int32_t *)*addr = vtophys(r_esp);
addr = (void **)(sc->acpi_wakeaddr + previous_cr0);
(u_int32_t *)*addr = r_cr0;
addr = (void **)(sc->acpi_wakeaddr + previous_cr2);
(u_int32_t *)*addr = r_cr2;
addr = (void **)(sc->acpi_wakeaddr + previous_cr3);
(u_int32_t *)*addr = r_cr3;
addr = (void **)(sc->acpi_wakeaddr + previous_cr4);
(u_int32_t *)*addr = r_cr4;
addr = (void **)(sc->acpi_wakeaddr + previous_tr);
(u_int16_t *)*addr = r_tr;
addr = (void **)(sc->acpi_wakeaddr + previous_gdt);
bcopy(&r_gdt, addr, sizeof(r_gdt));
addr = (void **)(sc->acpi_wakeaddr + previous_ldt);
(u_int16_t *)*addr = r_ldt;
addr = (void **)(sc->acpi_wakeaddr + previous_idt);
bcopy(&r_idt, addr, sizeof(r_idt));
addr = (void **)(sc->acpi_wakeaddr + where_to_recover);
*addr = acpi_restorecpu;
addr = (void **)(sc->acpi_wakeaddr + previous_ds);
(u_int16_t *)*addr = r_ds;
addr = (void **)(sc->acpi_wakeaddr + previous_es);
(u_int16_t *)*addr = r_es;
addr = (void **)(sc->acpi_wakeaddr + previous_fs);
(u_int16_t *)*addr = r_fs;
addr = (void **)(sc->acpi_wakeaddr + previous_gs);
(u_int16_t *)*addr = r_gs;
addr = (void **)(sc->acpi_wakeaddr + previous_ss);
(u_int16_t *)*addr = r_ss;
if (debug_wakeup) {
acpi_printcpu();
}
if ((status = AcpiEnterSleepState(state)) != AE_OK) {
device_printf(sc->acpi_dev,
"AcpiEnterSleepState failed - %s\n",
acpi_strerror(status));
ret = -1;
goto out;
}
wbinvd();
for (;;) ;
} else {
/* Execute Wakeup */
#if 0
initializecpu();
#endif
icu_reinit();
pmap_remove(pm, sc->acpi_wakephys,
sc->acpi_wakephys + PAGE_SIZE);
if (opage) {
pmap_enter(pm, sc->acpi_wakephys, page,
VM_PROT_READ | VM_PROT_WRITE, 0);
}
if (debug_wakeup) {
acpi_savecpu();
acpi_printcpu();
}
}
out:
write_eflags(ef);
return (ret);
}
static bus_dma_tag_t acpi_waketag;
static bus_dmamap_t acpi_wakemap;
static vm_offset_t acpi_wakeaddr = 0;
static void
acpi_alloc_wakeup_handler(void)
{
if (bus_dma_tag_create(/* parent */ NULL, /* alignment */ 2, 0,
/* lowaddr below 1MB */ 0x9ffff,
/* highaddr */ BUS_SPACE_MAXADDR, NULL, NULL,
PAGE_SIZE, 1, PAGE_SIZE, 0, &acpi_waketag) != 0) {
printf("acpi_alloc_wakeup_handler: unable to create wake tag\n");
return;
}
if (bus_dmamem_alloc(acpi_waketag, (void **)&acpi_wakeaddr,
BUS_DMA_NOWAIT, &acpi_wakemap)) {
printf("acpi_alloc_wakeup_handler: unable to allocate wake memory\n");
return;
}
}
SYSINIT(acpiwakeup, SI_SUB_KMEM, SI_ORDER_ANY, acpi_alloc_wakeup_handler, 0)
static void
acpi_realmodeinst(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
{
struct acpi_softc *sc = arg;
u_int32_t *addr;
addr = (u_int32_t *)&wakecode[wakeup_sw32 + 2];
*addr = segs[0].ds_addr + wakeup_32;
bcopy(wakecode, (void *)sc->acpi_wakeaddr, sizeof(wakecode));
sc->acpi_wakephys = segs[0].ds_addr;
}
void
acpi_install_wakeup_handler(struct acpi_softc *sc)
{
if (acpi_wakeaddr == 0) {
return;
}
sc->acpi_waketag = acpi_waketag;
sc->acpi_wakeaddr = acpi_wakeaddr;
sc->acpi_wakemap = acpi_wakemap;
bus_dmamap_load(sc->acpi_waketag, sc->acpi_wakemap,
(void *)sc->acpi_wakeaddr, PAGE_SIZE,
acpi_realmodeinst, sc, 0);
}

22
sys/i386/acpica/genwakecode.pl Normal file
View File

@ -0,0 +1,22 @@
#!/usr/bin/perl
# $FreeBSD$
print "static char wakecode[] = {\n";
open(BIN, "hexdump -Cv acpi_wakecode.bin|");
while (<BIN>) {
s/^[0-9a-f]+//;
s/\|.*$//;
foreach (split()) {
print "0x$_,";
}
print "\n";
}
print "};\n";
close(BIN);
open(NM, "nm -n acpi_wakecode.o|");
while (<NM>) {
split;
print "#define $_[2] 0x$_[0]\n";
}
close(NM);

27
sys/i386/isa/intr_machdep.c
View File

@ -135,6 +135,7 @@ static driver_intr_t isa_strayintr;
static void ithds_init(void *dummy);
static void ithread_enable(int vector);
static void ithread_disable(int vector);
static void init_i8259(void);
#ifdef PC98
#define NMI_PARITY 0x04
@ -281,6 +282,22 @@ isa_nmi(cd)
return(retval);
}
/*
* ICU reinitialize when ICU configuration has lost.
*/
void icu_reinit()
{
int i;
u_int32_t eflags;
eflags = read_eflags();
disable_intr();
init_i8259();
for(i=0;i<ICU_LEN;i++)
if(intr_handler[i] != isa_strayintr)
INTREN(1<<i);
write_eflags(eflags);
}
/*
* Create a default interrupt table to avoid problems caused by
* spurious interrupts during configuration of kernel, then setup
@ -294,8 +311,16 @@ isa_defaultirq()
/* icu vectors */
for (i = 0; i < ICU_LEN; i++)
icu_unset(i, (driver_intr_t *)NULL);
init_i8259();
}
/*
*initialize 8259's
*/
static void init_i8259()
{
/* initialize 8259's */
#ifdef DEV_MCA
if (MCA_system)
outb(IO_ICU1, 0x19); /* reset; program device, four bytes */

1
sys/i386/isa/intr_machdep.h
View File

@ -210,6 +210,7 @@ int isa_nmi __P((int cd));
int icu_setup __P((int intr, driver_intr_t *func, void *arg,
int flags));
int icu_unset __P((int intr, driver_intr_t *handler));
void icu_reinit(void);
/*
* WARNING: These are internal functions and not to be used by device drivers!

27
sys/i386/isa/nmi.c
View File

@ -135,6 +135,7 @@ static driver_intr_t isa_strayintr;
static void ithds_init(void *dummy);
static void ithread_enable(int vector);
static void ithread_disable(int vector);
static void init_i8259(void);
#ifdef PC98
#define NMI_PARITY 0x04
@ -281,6 +282,22 @@ isa_nmi(cd)
return(retval);
}
/*
* ICU reinitialize when ICU configuration has lost.
*/
void icu_reinit()
{
int i;
u_int32_t eflags;
eflags = read_eflags();
disable_intr();
init_i8259();
for(i=0;i<ICU_LEN;i++)
if(intr_handler[i] != isa_strayintr)
INTREN(1<<i);
write_eflags(eflags);
}
/*
* Create a default interrupt table to avoid problems caused by
* spurious interrupts during configuration of kernel, then setup
@ -294,8 +311,16 @@ isa_defaultirq()
/* icu vectors */
for (i = 0; i < ICU_LEN; i++)
icu_unset(i, (driver_intr_t *)NULL);
init_i8259();
}
/*
*initialize 8259's
*/
static void init_i8259()
{
/* initialize 8259's */
#ifdef DEV_MCA
if (MCA_system)
outb(IO_ICU1, 0x19); /* reset; program device, four bytes */

7
sys/modules/acpi/Makefile
View File

@ -2,7 +2,7 @@
.PATH: ${.CURDIR}/../../contrib/dev/acpica \
${.CURDIR}/../../pci ${.CURDIR}/../../dev/acpica \
${.CURDIR}/../../dev/acpica/Osd
${.CURDIR}/../../dev/acpica/Osd ${.CURDIR}/../../${MACHINE}/acpica
KMOD= acpica
@ -30,6 +30,7 @@ SRCS+= utglobal.c utinit.c utmisc.c utobject.c utxface.c
SRCS+= acpi.c acpi_acad.c acpi_battery.c acpi_button.c acpi_cmbat.c acpi_cpu.c
SRCS+= acpi_ec.c acpi_isa.c acpi_lid.c acpi_pcib.c acpi_powerprofile.c
SRCS+= acpi_powerres.c acpi_resource.c acpi_thermal.c acpi_timer.c
SRCS+= acpi_wakecode.h acpi_wakeup.c
SRCS+= OsdDebug.c
SRCS+= OsdHardware.c OsdInterrupt.c OsdMemory.c OsdSchedule.c
SRCS+= OsdStream.c OsdSynch.c OsdEnvironment.c
@ -37,8 +38,12 @@ SRCS+= opt_acpi.h opt_ddb.h
SRCS+= device_if.h bus_if.h pci_if.h pcib_if.h isa_if.h
CFLAGS+= -I${.CURDIR}/../../contrib/dev/acpica
CLEANFILES+= acpi_wakecode.h acpi_wakecode.o acpi_wakecode.bin
opt_ddb.h: Makefile
echo '#define DDB 1' >opt_ddb.h
acpi_wakecode.h: acpi_wakecode.S
${MAKE} -f ${.CURDIR}/../../${MACHINE}/acpica/Makefile MAKESRCPATH=${.CURDIR}/../../${MACHINE}/acpica
.include <bsd.kmod.mk>

7
sys/modules/acpica/Makefile
View File

@ -2,7 +2,7 @@
.PATH: ${.CURDIR}/../../contrib/dev/acpica \
${.CURDIR}/../../pci ${.CURDIR}/../../dev/acpica \
${.CURDIR}/../../dev/acpica/Osd
${.CURDIR}/../../dev/acpica/Osd ${.CURDIR}/../../${MACHINE}/acpica
KMOD= acpica
@ -30,6 +30,7 @@ SRCS+= utglobal.c utinit.c utmisc.c utobject.c utxface.c
SRCS+= acpi.c acpi_acad.c acpi_battery.c acpi_button.c acpi_cmbat.c acpi_cpu.c
SRCS+= acpi_ec.c acpi_isa.c acpi_lid.c acpi_pcib.c acpi_powerprofile.c
SRCS+= acpi_powerres.c acpi_resource.c acpi_thermal.c acpi_timer.c
SRCS+= acpi_wakecode.h acpi_wakeup.c
SRCS+= OsdDebug.c
SRCS+= OsdHardware.c OsdInterrupt.c OsdMemory.c OsdSchedule.c
SRCS+= OsdStream.c OsdSynch.c OsdEnvironment.c
@ -37,8 +38,12 @@ SRCS+= opt_acpi.h opt_ddb.h
SRCS+= device_if.h bus_if.h pci_if.h pcib_if.h isa_if.h
CFLAGS+= -I${.CURDIR}/../../contrib/dev/acpica
CLEANFILES+= acpi_wakecode.h acpi_wakecode.o acpi_wakecode.bin
opt_ddb.h: Makefile
echo '#define DDB 1' >opt_ddb.h
acpi_wakecode.h: acpi_wakecode.S
${MAKE} -f ${.CURDIR}/../../${MACHINE}/acpica/Makefile MAKESRCPATH=${.CURDIR}/../../${MACHINE}/acpica
.include <bsd.kmod.mk>