green_saver.c revision 39428
1/*- 2 * Copyright (c) 1995-1998 S�ren Schmidt 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer, 10 * without modification, immediately at the beginning of the file. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. The name of the author may not be used to endorse or promote products 15 * derived from this software without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 * 28 * $Id: green_saver.c,v 1.12 1998/09/15 18:16:39 sos Exp $ 29 */ 30 31#include <sys/param.h> 32#include <sys/systm.h> 33#include <sys/exec.h> 34#include <sys/sysent.h> 35#include <sys/lkm.h> 36 37#include <i386/isa/isa.h> 38 39#include <saver.h> 40 41MOD_MISC(green_saver); 42 43static void 44green_saver(int blank) 45{ 46 u_char val; 47 if (blank) { 48 scrn_blanked = 1; 49 cur_console->status |= SAVER_RUNNING; 50 switch (crtc_type) { 51 case KD_VGA: 52 outb(TSIDX, 0x01); val = inb(TSREG); 53 outb(TSIDX, 0x01); outb(TSREG, val | 0x20); 54 outb(crtc_addr, 0x17); val = inb(crtc_addr + 1); 55 outb(crtc_addr + 1, val & ~0x80); 56 break; 57 case KD_EGA: 58 /* not yet done XXX */ 59 break; 60 case KD_CGA: 61 outb(crtc_addr + 4, 0x25); 62 break; 63 case KD_MONO: 64 case KD_HERCULES: 65 outb(crtc_addr + 4, 0x21); 66 break; 67 default: 68 break; 69 } 70 } 71 else { 72 switch (crtc_type) { 73 case KD_VGA: 74 outb(TSIDX, 0x01); val = inb(TSREG); 75 outb(TSIDX, 0x01); outb(TSREG, val & 0xDF); 76 outb(crtc_addr, 0x17); val = inb(crtc_addr + 1); 77 outb(crtc_addr + 1, val | 0x80); 78 break; 79 case KD_EGA: 80 /* not yet done XXX */ 81 break; 82 case KD_CGA: 83 outb(crtc_addr + 4, 0x2d); 84 break; 85 case KD_MONO: 86 case KD_HERCULES: 87 outb(crtc_addr + 4, 0x29); 88 break; 89 default: 90 break; 91 } 92 cur_console->status &= ~SAVER_RUNNING; 93 scrn_blanked = 0; 94 } 95} 96 97static int 98green_saver_load(struct lkm_table *lkmtp, int cmd) 99{ 100 switch (crtc_type) { 101 case KD_MONO: 102 case KD_HERCULES: 103 case KD_CGA: 104 /* 105 * `green' saver is not fully implemented for MDA and CGA. 106 * It simply blanks the display instead. 107 */ 108 case KD_VGA: 109 break; 110 case KD_EGA: 111 /* EGA is yet to be supported */ 112 default: 113 return ENODEV; 114 } 115 return add_scrn_saver(green_saver); 116} 117 118static int 119green_saver_unload(struct lkm_table *lkmtp, int cmd) 120{ 121 return remove_scrn_saver(green_saver); 122} 123 124int 125green_saver_mod(struct lkm_table *lkmtp, int cmd, int ver) 126{ 127 MOD_DISPATCH(green_saver, lkmtp, cmd, ver, 128 green_saver_load, green_saver_unload, lkm_nullcmd); 129} 130