X-Git-Url: http://wien.tomnetworks.com/gitweb/?a=blobdiff_plain;f=src%2Fapm.c;h=c497dbecd8306b514d1d07e9baf2dac889b1f50b;hb=refs%2Fheads%2Fcoreboot;hp=6efead02f683e8b97bf80636d1efc886549dcbb5;hpb=b1b7c2a1c3b940b787fdb5da67fc37003e9d7b0e;p=seabios.git diff --git a/src/apm.c b/src/apm.c index 6efead0..c497dbe 100644 --- a/src/apm.c +++ b/src/apm.c @@ -9,7 +9,7 @@ #include "farptr.h" // GET_VAR #include "bregs.h" // struct bregs #include "ioport.h" // outb -#include "util.h" // irq_enable +#include "util.h" // wait_irq #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL @@ -53,14 +53,14 @@ handle_155301(struct bregs *regs) } // Assembler entry points defined in romlayout.S -extern void apm16protected_entry(); -extern void apm32protected_entry(); +extern void entry_apm16(void); +extern void entry_apm32(void); // APM 16 bit protected mode interface connect static void handle_155302(struct bregs *regs) { - regs->bx = (u32)apm16protected_entry; + regs->bx = (u32)entry_apm16; regs->ax = SEG_BIOS; // 16 bit code segment base regs->si = 0xfff0; // 16 bit code segment size regs->cx = SEG_BIOS; // data segment address @@ -73,7 +73,7 @@ static void handle_155303(struct bregs *regs) { regs->ax = SEG_BIOS; // 32 bit code segment base - regs->ebx = (u32)apm32protected_entry; + regs->ebx = (u32)entry_apm32; regs->cx = SEG_BIOS; // 16 bit code segment base // 32 bit code segment size (low 16 bits) // 16 bit code segment size (high 16 bits) @@ -94,8 +94,7 @@ handle_155304(struct bregs *regs) static void handle_155305(struct bregs *regs) { - irq_enable(); - hlt(); + wait_irq(); set_success(regs); } @@ -106,6 +105,15 @@ handle_155306(struct bregs *regs) set_success(regs); } +void +apm_shutdown(void) +{ + irq_disable(); + out_str("Shutdown"); + for (;;) + hlt(); +} + // APM Set Power State static void handle_155307(struct bregs *regs) @@ -122,10 +130,7 @@ handle_155307(struct bregs *regs) out_str("Suspend"); break; case 3: - irq_disable(); - out_str("Shutdown"); - for (;;) - hlt(); + apm_shutdown(); break; } set_success(regs); @@ -156,7 +161,7 @@ handle_15530a(struct bregs *regs) static void handle_15530b(struct bregs *regs) { - set_code_fail_silent(regs, RET_ENOEVENT); + set_code_invalid_silent(regs, RET_ENOEVENT); } // APM Driver Version @@ -187,14 +192,14 @@ handle_155310(struct bregs *regs) static void handle_1553XX(struct bregs *regs) { - set_fail(regs); + set_unimplemented(regs); } -void VISIBLE16 +void handle_1553(struct bregs *regs) { if (! CONFIG_APMBIOS) { - set_code_fail(regs, RET_EUNSUPPORTED); + set_code_invalid(regs, RET_EUNSUPPORTED); return; } @@ -217,3 +222,17 @@ handle_1553(struct bregs *regs) default: handle_1553XX(regs); break; } } + +void VISIBLE16 +handle_apm16(struct bregs *regs) +{ + debug_enter(regs, DEBUG_HDL_apm); + handle_1553(regs); +} + +void VISIBLE32SEG +handle_apm32(struct bregs *regs) +{ + debug_enter(regs, DEBUG_HDL_apm); + handle_1553(regs); +}