Annotation of sys/arch/i386/stand/libsa/apmprobe.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: apmprobe.c,v 1.14 2005/11/14 23:50:26 martin Exp $ */
! 2:
! 3: /*
! 4: * Copyright (c) 1997-2000 Michael Shalayeff
! 5: * All rights reserved.
! 6: *
! 7: * Redistribution and use in source and binary forms, with or without
! 8: * modification, are permitted provided that the following conditions
! 9: * are met:
! 10: * 1. Redistributions of source code must retain the above copyright
! 11: * notice, this list of conditions and the following disclaimer.
! 12: * 2. Redistributions in binary form must reproduce the above copyright
! 13: * notice, this list of conditions and the following disclaimer in the
! 14: * documentation and/or other materials provided with the distribution.
! 15: *
! 16: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
! 17: * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
! 18: * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
! 19: * IN NO EVENT SHALL THE AUTHOR OR HIS RELATIVES BE LIABLE FOR ANY DIRECT,
! 20: * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
! 21: * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
! 22: * SERVICES; LOSS OF MIND, USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 23: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
! 24: * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
! 25: * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
! 26: * THE POSSIBILITY OF SUCH DAMAGE.
! 27: */
! 28: /*
! 29: * APM derived from: apm_init.S, LP (Laptop Package)
! 30: * wich contained this:
! 31: * Copyright (C) 1994 by HOSOKAWA, Tatsumi <hosokawa@mt.cs.keio.ac.jp>
! 32: *
! 33: */
! 34: /*
! 35: * If you want to know the specification of APM BIOS, see the following
! 36: * documentations,
! 37: *
! 38: * [1] Intel Corporation and Microsoft Corporation, "Advanced Power
! 39: * Management, The Next Generation, Version 1.0", Feb.,1992.
! 40: *
! 41: * [2] Intel Corporation and Microsoft Corporation, "Advanced Power
! 42: * Management (APM) BIOS Interface Specification Revision 1.1",
! 43: * Sep.,1993, Intel Order Number: 241704-001, Microsoft Part
! 44: * Number: 781-110-X01
! 45: *
! 46: * or contact
! 47: *
! 48: * APM Support Desk (Intel Corporation, US)
! 49: * TEL: (800)628-8686
! 50: * FAX: (916)356-6100.
! 51: */
! 52:
! 53: #include <sys/param.h>
! 54: #include "libsa.h"
! 55: #include <stand/boot/bootarg.h>
! 56:
! 57: #include <uvm/uvm_extern.h>
! 58:
! 59: #include <dev/isa/isareg.h>
! 60:
! 61: #include <machine/apmvar.h>
! 62: #include <machine/biosvar.h>
! 63:
! 64: #define vm_page_size 4096
! 65:
! 66: #include "debug.h"
! 67:
! 68: extern int debug;
! 69:
! 70: static __inline u_int
! 71: apm_check(void)
! 72: {
! 73: register u_int detail;
! 74: register u_int8_t f;
! 75:
! 76: __asm __volatile(DOINT(0x15) "\n\t"
! 77: "setc %b1\n\t"
! 78: "movzwl %%ax, %0\n\t"
! 79: "shll $16, %%ecx\n\t"
! 80: "orl %%ecx, %0"
! 81: : "=a" (detail), "=b" (f)
! 82: : "0" (APM_INSTCHECK), "1" (APM_DEV_APM_BIOS)
! 83: : "%ecx", "cc");
! 84:
! 85: if (f || BIOS_regs.biosr_bx != 0x504d /* "PM" */ ) {
! 86: #ifdef DEBUG
! 87: if (debug)
! 88: printf("apm_check: %x, %x, %x\n",
! 89: f, BIOS_regs.biosr_bx, detail);
! 90: #endif
! 91: return 0;
! 92: } else
! 93: return detail;
! 94: }
! 95:
! 96: static __inline int
! 97: apm_disconnect(void)
! 98: {
! 99: register u_int16_t rv;
! 100:
! 101: __asm __volatile(DOINT(0x15) "\n\t"
! 102: "setc %b0"
! 103: : "=a" (rv)
! 104: : "0" (APM_DISCONNECT), "b" (APM_DEV_APM_BIOS)
! 105: : "%ecx", "%edx", "cc");
! 106:
! 107: return ((rv & 0xff)? rv >> 8 : 0);
! 108: }
! 109:
! 110: static __inline int
! 111: apm_connect(bios_apminfo_t *ai)
! 112: {
! 113: register u_int16_t f;
! 114:
! 115: __asm __volatile (DOINT(0x15) "\n\t"
! 116: "setc %b1\n\t"
! 117: "movb %%ah, %h1\n\t"
! 118: "movzwl %%ax, %%eax\n\tshll $4, %0\n\t"
! 119: "movzwl %%cx, %%ecx\n\tshll $4, %2\n\t"
! 120: "movzwl %%dx, %%edx\n\tshll $4, %3\n\t"
! 121: : "=a" (ai->apm_code32_base),
! 122: "=b" (f),
! 123: "=c" (ai->apm_code16_base),
! 124: "=d" (ai->apm_data_base)
! 125: : "0" (APM_PROT32_CONNECT), "1" (APM_DEV_APM_BIOS)
! 126: : "cc");
! 127:
! 128: if (f & 0xff)
! 129: return (f >> 8);
! 130:
! 131: ai->apm_entry = BIOS_regs.biosr_bx;
! 132: #if 0
! 133: ai->apm_code_len = BIOS_regs.biosr_si & 0xffff;
! 134: ai->apm_code16_len = BIOS_regs.biosr_si & 0xffff;
! 135: ai->apm_data_len = BIOS_regs.biosr_di & 0xffff;
! 136: #else
! 137: ai->apm_code_len = 0xffff - (ai->apm_code32_base & 0xffff);
! 138: ai->apm_code16_len = 0xffff - (ai->apm_code16_base & 0xffff);
! 139: ai->apm_data_len = 0xffff - (ai->apm_data_base & 0xffff);
! 140: #endif
! 141: if (ai->apm_data_base < BOOTARG_OFF)
! 142: ai->apm_data_len = NBPG - (ai->apm_data_base & PGOFSET) - 1;
! 143:
! 144: #ifdef DEBUG
! 145: if (debug)
! 146: printf("cs=%x:%x/%x:%x, ds=%x:%x\n",
! 147: ai->apm_code32_base, ai->apm_code_len,
! 148: ai->apm_code16_base, ai->apm_code16_len,
! 149: ai->apm_data_base, ai->apm_data_len);
! 150: #endif
! 151: /* inform apm bios about our driver version */
! 152: __asm __volatile (DOINT(0x15) "\n\t"
! 153: "setc %b1\n\t"
! 154: "movb %%ah, %h1"
! 155: : "=b" (f)
! 156: : "a" (APM_DRIVER_VERSION),
! 157: "0" (APM_DEV_APM_BIOS),
! 158: "c" (APM_VERSION)
! 159: : "cc");
! 160:
! 161: return 0;
! 162: }
! 163:
! 164: static bios_apminfo_t ai;
! 165:
! 166: void
! 167: apmprobe(void)
! 168: {
! 169: if ((ai.apm_detail = apm_check())) {
! 170:
! 171: apm_disconnect();
! 172:
! 173: if (apm_connect(&ai) != 0) {
! 174: printf("\napm: connect error\n");
! 175: return;
! 176: }
! 177: #ifdef DEBUG
! 178: if (debug)
! 179: printf("apm[%x cs=%x[%x]/%x[%x] ds=%x[%x] @ %x]",
! 180: ai.apm_detail,
! 181: ai.apm_code32_base, ai.apm_code_len,
! 182: ai.apm_code16_base, ai.apm_code16_len,
! 183: ai.apm_data_base, ai.apm_data_len,
! 184: ai.apm_entry);
! 185: else
! 186: printf(" apm");
! 187: #else
! 188: printf(" apm");
! 189: #endif
! 190: addbootarg(BOOTARG_APMINFO, sizeof(ai), &ai);
! 191: }
! 192: }
! 193:
! 194: void
! 195: apmfixmem(void)
! 196: {
! 197: #ifdef DEBUG
! 198: printf("apmremove (%d)", ai.apm_detail);
! 199: #endif
! 200: if (ai.apm_detail)
! 201: mem_delete(trunc_page(ai.apm_data_base),
! 202: round_page(ai.apm_data_base + ai.apm_data_len));
! 203: }
CVSweb
![[BACK]](/icons/back.gif){kind=icon}
Return to apmprobe.c CVS log ![[TXT]](/icons/text.gif){kind=icon}
![[DIR]](/icons/dir.gif){kind=icon}
Up to [local] / sys / arch / i386 / stand / libsa