Home | History | Annotate | Line # | Download | only in tpctl
fb.c revision 1.4 
      1 /*	$NetBSD: fb.c,v 1.4 2008/05/10 15:31:05 martin Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2002 TAKEMRUA Shin
      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  * 3. Neither the name of The NetBSD Foundation nor the names of its
     16  *    contributors may be used to endorse or promote products derived
     17  *    from this software without specific prior written permission.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <string.h>
     33 #include <stdio.h>
     34 #include <unistd.h>
     35 #include <stdlib.h>
     36 #include <sys/ioctl.h>
     37 #include <sys/fcntl.h>
     38 #include <sys/mman.h>
     39 
     40 #include "tpctl.h"
     41 
     42 #ifndef lint
     43 #include <sys/cdefs.h>
     44 __RCSID("$NetBSD: fb.c,v 1.4 2008/05/10 15:31:05 martin Exp $");
     45 #endif /* not lint */
     46 
     47 #define INVALID_CACHE -1
     48 #define ALIGN(a, n)	((typeof(a))(((int)(a) + (n) - 1) / (n) * (n)))
     49 #define ABS(a)		((a) < 0 ? -(a) : (a))
     50 #define SWAP(a, b)	do {				\
     51 		typeof(a) tmp;				\
     52 		tmp = (a); (a) = (b); (b) = tmp;	\
     53 	} while(0)
     54 #define bitsizeof(t)	(sizeof(t) * 8)
     55 
     56 int
     57 fb_dispmode(struct fb *fb, int dispmode)
     58 {
     59 
     60 	if (fb->dispmode != dispmode) {
     61 	    if (ioctl(fb->fd, WSDISPLAYIO_SMODE, &dispmode) < 0)
     62 		return (-1);
     63 	    fb->dispmode = dispmode;
     64 	}
     65 
     66 	return (0);
     67 }
     68 
     69 int
     70 fb_init(struct fb *fb, int fd)
     71 {
     72 	int y;
     73 	size_t size;
     74 
     75 	fb->fd = fd;
     76 	fb->linecache_y = INVALID_CACHE;
     77 	fb->conf.hf_conf_index = HPCFB_CURRENT_CONFIG;
     78 	if (ioctl(fb->fd, WSDISPLAYIO_GMODE, &fb->dispmode) < 0)
     79 		return (-1);
     80 	if (ioctl(fb->fd, HPCFBIO_GCONF, &fb->conf) < 0)
     81 		return (-1);
     82 
     83 	if (fb_dispmode(fb, WSDISPLAYIO_MODE_MAPPED) < 0)
     84 		return (-1);
     85 
     86 	size = (size_t)fb->conf.hf_bytes_per_line * fb->conf.hf_height;
     87 	size += fb->conf.hf_offset;
     88 	size = ALIGN(size, getpagesize());
     89 	fb->baseaddr = mmap(0, size, PROT_READ | PROT_WRITE, MAP_SHARED, fd,0);
     90 	if (fb->baseaddr == MAP_FAILED)
     91 		return (-1);
     92 	fb->baseaddr += fb->conf.hf_offset;
     93 
     94 	size = ALIGN(fb->conf.hf_bytes_per_line, 16);
     95 	fb->linecache = (fb_pixel_t*)malloc(size);
     96 	if (fb->linecache == NULL)
     97 		return (-1);
     98 	fb->workbuf = (fb_pixel_t*)malloc(size);
     99 	if (fb->workbuf == NULL)
    100 		return (-1);
    101 
    102 	if (fb->conf.hf_access_flags & HPCFB_ACCESS_REVERSE) {
    103 		fb->white = 0;
    104 		fb->black = ~0;
    105 	} else {
    106 		fb->white = ~0;
    107 		fb->black = 0;
    108 	}
    109 
    110 	/*
    111 	 * clear screen
    112 	 */
    113 	for (y = 0; y < fb->conf.hf_height; y++) {
    114 		fb_getline(fb, y);
    115 		memset(fb->linecache, fb->black,
    116 		    ALIGN(fb->conf.hf_bytes_per_line, 16));
    117 		fb_putline(fb, y);
    118 	}
    119 
    120 	return (0);
    121 }
    122 
    123 static void
    124 __fb_swap_workbuf(struct fb *fb)
    125 {
    126 	int i, n;
    127 
    128 	n = ALIGN(fb->conf.hf_bytes_per_line, 16) / sizeof(fb_pixel_t);
    129 	if (fb->conf.hf_order_flags & HPCFB_REVORDER_BYTE) {
    130 		for (i = 0; i < n; i++)
    131 			fb->workbuf[i] =
    132 			    ((fb->workbuf[i] << 8) & 0xff00ff00) |
    133 			    ((fb->workbuf[i] >> 8) & 0x00ff00ff);
    134 	}
    135 	if (fb->conf.hf_order_flags & HPCFB_REVORDER_WORD) {
    136 		for (i = 0; i < n; i++)
    137 			fb->workbuf[i] =
    138 			    ((fb->workbuf[i] << 16) & 0xffff0000) |
    139 			    ((fb->workbuf[i] >> 16) & 0x0000ffff);
    140 	}
    141 	if (fb->conf.hf_order_flags & HPCFB_REVORDER_DWORD) {
    142 		for (i = 0; i < n; i += 2) {
    143 			fb_pixel_t tmp;
    144 			tmp = fb->workbuf[i];
    145 			fb->workbuf[i] = fb->workbuf[i + 1];
    146 			fb->workbuf[i + 1] = tmp;
    147 		}
    148 	}
    149 	if (fb->conf.hf_order_flags & HPCFB_REVORDER_QWORD) {
    150 		for (i = 0; i < n; i += 4) {
    151 			fb_pixel_t tmp;
    152 			tmp = fb->workbuf[i + 0];
    153 			fb->workbuf[i + 0] = fb->workbuf[i + 2];
    154 			fb->workbuf[i + 2] = tmp;
    155 			tmp = fb->workbuf[i + 1];
    156 			fb->workbuf[i + 1] = fb->workbuf[i + 3];
    157 			fb->workbuf[i + 3] = tmp;
    158 		}
    159 	}
    160 }
    161 
    162 static void
    163 __fb_put_pixel(struct fb *fb, fb_pixel_t pixel, int width, int x)
    164 {
    165 	fb_pixel_t mask = (1 << width) - 1;
    166 
    167 	x -= (bitsizeof(fb_pixel_t) - width);
    168 	if (x < 0) {
    169 		pixel <<= -x;
    170 		mask <<= -x;
    171 		fb->linecache[0] = (fb->linecache[0]&~mask) | (pixel&~mask);
    172 	} else {
    173 		fb_pixel_t *dst = &fb->linecache[x / bitsizeof(fb_pixel_t)];
    174 		x %= bitsizeof(fb_pixel_t);
    175 		*dst = (*dst & ~(mask>>x)) | ((pixel>>x) & (mask>>x));
    176 		dst++;
    177 		if (x == 0)
    178 			return;
    179 		x = bitsizeof(fb_pixel_t) - x;
    180 		*dst = (*dst & ~(mask<<x)) | ((pixel<<x) & (mask<<x));
    181 	}
    182 }
    183 
    184 void
    185 fb_getline(struct fb *fb, int y)
    186 {
    187 	int i, n;
    188 	unsigned char *src;
    189 	fb_pixel_t *dst;
    190 
    191 	src = fb->baseaddr + fb->conf.hf_bytes_per_line * y;
    192 	dst = fb->workbuf;
    193 	n = ALIGN(fb->conf.hf_bytes_per_line, 16) / sizeof(fb_pixel_t);
    194 	for (i = 0; i < n; i++) {
    195 		*dst++ = ((fb_pixel_t)src[0] << 24) |
    196 		    ((fb_pixel_t)src[1] << 16) |
    197 		    ((fb_pixel_t)src[2] << 8) |
    198 		    ((fb_pixel_t)src[3] << 0);
    199 		src += 4;
    200 	}
    201 
    202 	__fb_swap_workbuf(fb);
    203 	memcpy(fb->linecache, fb->workbuf, n * sizeof(fb_pixel_t));
    204 }
    205 
    206 void
    207 fb_putline(struct fb *fb, int y)
    208 {
    209 	int i, n;
    210 	unsigned char *dst;
    211 	fb_pixel_t *src;
    212 
    213 	src = fb->workbuf;
    214 	dst = fb->baseaddr + fb->conf.hf_bytes_per_line * y;
    215 	n = ALIGN(fb->conf.hf_bytes_per_line, 16) / sizeof(fb_pixel_t);
    216 	memcpy(fb->workbuf, fb->linecache, n * sizeof(fb_pixel_t));
    217 	__fb_swap_workbuf(fb);
    218 	for (i = 0; i < n; i++) {
    219 		*dst++ = (*src >> 24) & 0xff;
    220 		*dst++ = (*src >> 16) & 0xff;
    221 		*dst++ = (*src >>  8) & 0xff;
    222 		*dst++ = (*src >>  0) & 0xff;
    223 		src++;
    224 	}
    225 }
    226 
    227 void
    228 fb_fetchline(struct fb *fb, int y)
    229 {
    230 	if (fb->linecache_y == y)
    231 		return;
    232 	fb_getline(fb, y);
    233 	fb->linecache_y = y;
    234 }
    235 
    236 void
    237 fb_flush(struct fb *fb)
    238 {
    239 	if (fb->linecache_y != INVALID_CACHE)
    240 		fb_putline(fb, fb->linecache_y);
    241 }
    242 
    243 void
    244 fb_drawpixel(struct fb *fb, int x, int y, fb_pixel_t pixel)
    245 {
    246 	int pack;
    247 
    248 	if (fb->conf.hf_access_flags & HPCFB_ACCESS_Y_TO_X)
    249 		SWAP(x, y);
    250 	if (fb->conf.hf_access_flags & HPCFB_ACCESS_R_TO_L)
    251 		x = fb->conf.hf_width - x - 1;
    252 	if (fb->conf.hf_access_flags & HPCFB_ACCESS_B_TO_T)
    253 		y = fb->conf.hf_height - y - 1;
    254 
    255 	if (x < 0 || y < 0 || fb->conf.hf_width <= x || fb->conf.hf_height < y)
    256 		return;
    257 
    258 	pack = x / fb->conf.hf_pixels_per_pack;
    259 	x %= fb->conf.hf_pixels_per_pack;
    260 	if (fb->conf.hf_access_flags & HPCFB_ACCESS_LSB_TO_MSB)
    261 		x = fb->conf.hf_pixels_per_pack - x - 1;
    262 	x *= fb->conf.hf_pixel_width;
    263 	if (fb->conf.hf_access_flags & HPCFB_ACCESS_PACK_BLANK)
    264 		x += (fb->conf.hf_pack_width -
    265 		    fb->conf.hf_pixel_width * fb->conf.hf_pixels_per_pack);
    266 	x += pack * fb->conf.hf_pack_width;
    267 
    268 	if (fb->linecache_y != y) {
    269 		fb_flush(fb);
    270 		fb_fetchline(fb, y);
    271 	}
    272 
    273 	__fb_put_pixel(fb, pixel, fb->conf.hf_pixel_width, x);
    274 }
    275 
    276 void
    277 fb_drawline(struct fb *fb, int x0, int y0, int x1, int y1, fb_pixel_t pixel)
    278 {
    279 	int i, dx, dy, d, incdec;
    280 
    281 	dx = ABS(x1 - x0);
    282 	dy = ABS(y1 - y0);
    283 	if (dx < dy) {
    284 		if (y1 < y0) {
    285 			SWAP(x0, x1);
    286 			SWAP(y0, y1);
    287 		}
    288 		if (x0 < x1)
    289 			incdec = 1;
    290 		else
    291 			incdec = -1;
    292 		d = -dy;
    293 		dx *= 2;
    294 		dy *= 2;
    295 		for (i = y0; i <= y1; i++) {
    296 			fb_drawpixel(fb, x0, i, pixel);
    297 			d += dx;
    298 			if (0 <= d) {
    299 				d -= dy;
    300 				x0 += incdec;
    301 			}
    302 		}
    303 	} else {
    304 		if (x1 < x0) {
    305 			SWAP(x0, x1);
    306 			SWAP(y0, y1);
    307 		}
    308 		if (y0 < y1)
    309 			incdec = 1;
    310 		else
    311 			incdec = -1;
    312 		d = -dx;
    313 		dx *= 2;
    314 		dy *= 2;
    315 		for (i = x0; i <= x1; i++) {
    316 			fb_drawpixel(fb, i, y0, pixel);
    317 			d += dy;
    318 			if (0 <= d) {
    319 				d -= dx;
    320 				y0 += incdec;
    321 			}
    322 		}
    323 	}
    324 }
    325