220 lines
4.6 KiB
C
220 lines
4.6 KiB
C
// Basic support for apmbios callbacks.
|
|
//
|
|
// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
|
|
// Copyright (C) 2005 Struan Bartlett
|
|
// Copyright (C) 2004 Fabrice Bellard
|
|
//
|
|
// This file may be distributed under the terms of the GNU LGPLv3 license.
|
|
|
|
#include "farptr.h" // GET_VAR
|
|
#include "bregs.h" // struct bregs
|
|
#include "ioport.h" // outb
|
|
#include "util.h" // irq_enable
|
|
#include "config.h" // CONFIG_*
|
|
#include "biosvar.h" // GET_GLOBAL
|
|
|
|
static void
|
|
out_str(const char *str_cs)
|
|
{
|
|
if (CONFIG_COREBOOT) {
|
|
dprintf(1, "APM request '%s'\n", str_cs);
|
|
return;
|
|
}
|
|
|
|
u8 *s = (u8*)str_cs;
|
|
for (;;) {
|
|
u8 c = GET_GLOBAL(*s);
|
|
if (!c)
|
|
break;
|
|
outb(c, PORT_BIOS_APM);
|
|
s++;
|
|
}
|
|
}
|
|
|
|
// APM installation check
|
|
static void
|
|
handle_155300(struct bregs *regs)
|
|
{
|
|
regs->ah = 1; // APM major version
|
|
regs->al = 2; // APM minor version
|
|
regs->bh = 'P';
|
|
regs->bl = 'M';
|
|
// bit 0 : 16 bit interface supported
|
|
// bit 1 : 32 bit interface supported
|
|
regs->cx = 0x03;
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM real mode interface connect
|
|
static void
|
|
handle_155301(struct bregs *regs)
|
|
{
|
|
set_success(regs);
|
|
}
|
|
|
|
// Assembler entry points defined in romlayout.S
|
|
extern void apm16protected_entry();
|
|
extern void apm32protected_entry();
|
|
|
|
// APM 16 bit protected mode interface connect
|
|
static void
|
|
handle_155302(struct bregs *regs)
|
|
{
|
|
regs->bx = (u32)apm16protected_entry;
|
|
regs->ax = SEG_BIOS; // 16 bit code segment base
|
|
regs->si = 0xfff0; // 16 bit code segment size
|
|
regs->cx = SEG_BIOS; // data segment address
|
|
regs->di = 0xfff0; // data segment length
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM 32 bit protected mode interface connect
|
|
static void
|
|
handle_155303(struct bregs *regs)
|
|
{
|
|
regs->ax = SEG_BIOS; // 32 bit code segment base
|
|
regs->ebx = (u32)apm32protected_entry;
|
|
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)
|
|
regs->esi = 0xfff0fff0;
|
|
regs->dx = SEG_BIOS; // data segment address
|
|
regs->di = 0xfff0; // data segment length
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM interface disconnect
|
|
static void
|
|
handle_155304(struct bregs *regs)
|
|
{
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM cpu idle
|
|
static void
|
|
handle_155305(struct bregs *regs)
|
|
{
|
|
irq_enable();
|
|
hlt();
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM cpu busy
|
|
static void
|
|
handle_155306(struct bregs *regs)
|
|
{
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM Set Power State
|
|
static void
|
|
handle_155307(struct bregs *regs)
|
|
{
|
|
if (regs->bx != 1) {
|
|
set_success(regs);
|
|
return;
|
|
}
|
|
switch (regs->cx) {
|
|
case 1:
|
|
out_str("Standby");
|
|
break;
|
|
case 2:
|
|
out_str("Suspend");
|
|
break;
|
|
case 3:
|
|
irq_disable();
|
|
out_str("Shutdown");
|
|
for (;;)
|
|
hlt();
|
|
break;
|
|
}
|
|
set_success(regs);
|
|
}
|
|
|
|
static void
|
|
handle_155308(struct bregs *regs)
|
|
{
|
|
set_success(regs);
|
|
}
|
|
|
|
// Get Power Status
|
|
static void
|
|
handle_15530a(struct bregs *regs)
|
|
{
|
|
regs->bh = 0x01; // on line
|
|
regs->bl = 0xff; // unknown battery status
|
|
regs->ch = 0x80; // no system battery
|
|
regs->cl = 0xff; // unknown remaining time
|
|
regs->dx = 0xffff; // unknown remaining time
|
|
regs->si = 0x00; // zero battery
|
|
set_success(regs);
|
|
}
|
|
|
|
#define RET_ENOEVENT 0x80
|
|
|
|
// Get PM Event
|
|
static void
|
|
handle_15530b(struct bregs *regs)
|
|
{
|
|
set_code_fail_silent(regs, RET_ENOEVENT);
|
|
}
|
|
|
|
// APM Driver Version
|
|
static void
|
|
handle_15530e(struct bregs *regs)
|
|
{
|
|
regs->ah = 1;
|
|
regs->al = 2;
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM Engage / Disengage
|
|
static void
|
|
handle_15530f(struct bregs *regs)
|
|
{
|
|
set_success(regs);
|
|
}
|
|
|
|
// APM Get Capabilities
|
|
static void
|
|
handle_155310(struct bregs *regs)
|
|
{
|
|
regs->bl = 0;
|
|
regs->cx = 0;
|
|
set_success(regs);
|
|
}
|
|
|
|
static void
|
|
handle_1553XX(struct bregs *regs)
|
|
{
|
|
set_fail(regs);
|
|
}
|
|
|
|
void VISIBLE16
|
|
handle_1553(struct bregs *regs)
|
|
{
|
|
if (! CONFIG_APMBIOS) {
|
|
set_code_fail(regs, RET_EUNSUPPORTED);
|
|
return;
|
|
}
|
|
|
|
//debug_stub(regs);
|
|
switch (regs->al) {
|
|
case 0x00: handle_155300(regs); break;
|
|
case 0x01: handle_155301(regs); break;
|
|
case 0x02: handle_155302(regs); break;
|
|
case 0x03: handle_155303(regs); break;
|
|
case 0x04: handle_155304(regs); break;
|
|
case 0x05: handle_155305(regs); break;
|
|
case 0x06: handle_155306(regs); break;
|
|
case 0x07: handle_155307(regs); break;
|
|
case 0x08: handle_155308(regs); break;
|
|
case 0x0a: handle_15530a(regs); break;
|
|
case 0x0b: handle_15530b(regs); break;
|
|
case 0x0e: handle_15530e(regs); break;
|
|
case 0x0f: handle_15530f(regs); break;
|
|
case 0x10: handle_155310(regs); break;
|
|
default: handle_1553XX(regs); break;
|
|
}
|
|
}
|