[BACK]Return to apmprobe.c CVS log [TXT][DIR] Up to [local] / sys / arch / i386 / stand / libsa

Annotation of sys/arch/i386/stand/libsa/apmprobe.c, Revision 1.1.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