1 /* $NetBSD: bt_subr.c,v 1.7 2003/08/07 16:29:54 agc Exp $ */ 2 3 /* 4 * Copyright (c) 1993 5 * The Regents of the University of California. All rights reserved. 6 * 7 * This software was developed by the Computer Systems Engineering group 8 * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and 9 * contributed to Berkeley. 10 * 11 * All advertising materials mentioning features or use of this software 12 * must display the following acknowledgement: 13 * This product includes software developed by the University of 14 * California, Lawrence Berkeley Laboratory. 15 * 16 * Redistribution and use in source and binary forms, with or without 17 * modification, are permitted provided that the following conditions 18 * are met: 19 * 1. Redistributions of source code must retain the above copyright 20 * notice, this list of conditions and the following disclaimer. 21 * 2. Redistributions in binary form must reproduce the above copyright 22 * notice, this list of conditions and the following disclaimer in the 23 * documentation and/or other materials provided with the distribution. 24 * 3. Neither the name of the University nor the names of its contributors 25 * may be used to endorse or promote products derived from this software 26 * without specific prior written permission. 27 * 28 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 29 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 30 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 31 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 32 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 33 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 34 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 35 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 36 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 37 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 38 * SUCH DAMAGE. 39 * 40 * @(#)bt_subr.c 8.2 (Berkeley) 1/21/94 41 */ 42 43 #include <sys/cdefs.h> 44 __KERNEL_RCSID(0, "$NetBSD: bt_subr.c,v 1.7 2003/08/07 16:29:54 agc Exp $"); 45 46 #include <sys/param.h> 47 #include <sys/buf.h> 48 #include <sys/errno.h> 49 50 #include <dev/sun/fbio.h> 51 52 #include "btreg.h" 53 #include "btvar.h" 54 55 /* 56 * Common code for dealing with Brooktree video DACs. 57 * (Contains some software-only code as well, since the colormap 58 * ioctls are shared between the cgthree and cgsix drivers.) 59 */ 60 61 /* 62 * Implement an FBIOGETCMAP-like ioctl. 63 */ 64 int 65 bt_getcmap(p, cm, cmsize) 66 struct fbcmap *p; 67 union bt_cmap *cm; 68 int cmsize; 69 { 70 u_int i, start, count; 71 u_char *cp; 72 73 start = p->index; 74 count = p->count; 75 if (start >= cmsize || count > cmsize - start) 76 return (EINVAL); 77 if (!useracc(p->red, count, B_WRITE) || 78 !useracc(p->green, count, B_WRITE) || 79 !useracc(p->blue, count, B_WRITE)) 80 return (EFAULT); 81 for (cp = &cm->cm_map[start][0], i = 0; i < count; cp += 3, i++) { 82 p->red[i] = cp[0]; 83 p->green[i] = cp[1]; 84 p->blue[i] = cp[2]; 85 } 86 return (0); 87 } 88 89 /* 90 * Implement the software portion of an FBIOPUTCMAP-like ioctl. 91 */ 92 int 93 bt_putcmap(p, cm, cmsize) 94 struct fbcmap *p; 95 union bt_cmap *cm; 96 int cmsize; 97 { 98 u_int i, start, count; 99 u_char *cp; 100 101 start = p->index; 102 count = p->count; 103 if (start >= cmsize || count > cmsize - start) 104 return (EINVAL); 105 if (!useracc(p->red, count, B_READ) || 106 !useracc(p->green, count, B_READ) || 107 !useracc(p->blue, count, B_READ)) 108 return (EFAULT); 109 for (cp = &cm->cm_map[start][0], i = 0; i < count; cp += 3, i++) { 110 cp[0] = p->red[i]; 111 cp[1] = p->green[i]; 112 cp[2] = p->blue[i]; 113 } 114 return (0); 115 } 116