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$ 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 41 MOD_MISC(green_saver); 42 43 static void 44 green_saver(int blank) 45 { 46 u_char val; 47 if (blank) { 48 scrn_blanked = 1; 49 switch (crtc_type) { 50 case KD_VGA: 51 outb(TSIDX, 0x01); val = inb(TSREG); 52 outb(TSIDX, 0x01); outb(TSREG, val | 0x20); 53 outb(crtc_addr, 0x17); val = inb(crtc_addr + 1); 54 outb(crtc_addr + 1, val & ~0x80); 55 break; 56 case KD_EGA: 57 /* not yet done XXX */ 58 break; 59 case KD_CGA: 60 outb(crtc_addr + 4, 0x25); 61 break; 62 case KD_MONO: 63 case KD_HERCULES: 64 outb(crtc_addr + 4, 0x21); 65 break; 66 default: 67 break; 68 } 69 } 70 else { 71 switch (crtc_type) { 72 case KD_VGA: 73 outb(TSIDX, 0x01); val = inb(TSREG); 74 outb(TSIDX, 0x01); outb(TSREG, val & 0xDF); 75 outb(crtc_addr, 0x17); val = inb(crtc_addr + 1); 76 outb(crtc_addr + 1, val | 0x80); 77 break; 78 case KD_EGA: 79 /* not yet done XXX */ 80 break; 81 case KD_CGA: 82 outb(crtc_addr + 4, 0x2d); 83 break; 84 case KD_MONO: 85 case KD_HERCULES: 86 outb(crtc_addr + 4, 0x29); 87 break; 88 default: 89 break; 90 } 91 scrn_blanked = 0; 92 } 93 } 94 95 static int 96 green_saver_load(struct lkm_table *lkmtp, int cmd) 97 { 98 switch (crtc_type) { 99 case KD_MONO: 100 case KD_HERCULES: 101 case KD_CGA: 102 /* 103 * `green' saver is not fully implemented for MDA and CGA. 104 * It simply blanks the display instead. 105 */ 106 case KD_VGA: 107 break; 108 case KD_EGA: 109 /* EGA is yet to be supported */ 110 default: 111 return ENODEV; 112 } 113 return add_scrn_saver(green_saver); 114 } 115 116 static int 117 green_saver_unload(struct lkm_table *lkmtp, int cmd) 118 { 119 return remove_scrn_saver(green_saver); 120 } 121 122 int 123 green_saver_mod(struct lkm_table *lkmtp, int cmd, int ver) 124 { 125 MOD_DISPATCH(green_saver, lkmtp, cmd, ver, 126 green_saver_load, green_saver_unload, lkm_nullcmd); 127 } 128