WebSVN – HelenOS – Blame – /trunk/uspace/srv/fb/fb.c

Rev	Author	Line No.	Line
1363	vana	1	/*
3707	decky	2	* Copyright (c) 2008 Martin Decky
2071	jermar	3	* Copyright (c) 2006 Jakub Vana
		4	* Copyright (c) 2006 Ondrej Palkovsky
1363	vana	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	*
		11	* - Redistributions of source code must retain the above copyright
		12	* notice, this list of conditions and the following disclaimer.
		13	* - Redistributions in binary form must reproduce the above copyright
		14	* notice, this list of conditions and the following disclaimer in the
		15	* documentation and/or other materials provided with the distribution.
		16	* - The name of the author may not be used to endorse or promote products
		17	* derived from this software without specific prior written permission.
		18	*
		19	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
		20	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
		21	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
		22	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
		23	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
		24	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
		25	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
		26	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
		27	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
		28	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
		29	*/
		30
1740	jermar	31	/**
		32	* @defgroup fb Graphical framebuffer
		33	* @brief HelenOS graphical framebuffer.
1649	cejka	34	* @ingroup fbs
		35	* @{
3707	decky	36	*/
1888	jermar	37
1649	cejka	38	/** @file
		39	*/
		40
1430	jermar	41	#include <stdlib.h>
		42	#include <unistd.h>
		43	#include <string.h>
1363	vana	44	#include <ddi.h>
		45	#include <sysinfo.h>
		46	#include <align.h>
		47	#include <as.h>
		48	#include <ipc/fb.h>
		49	#include <ipc/ipc.h>
1430	jermar	50	#include <ipc/ns.h>
1363	vana	51	#include <ipc/services.h>
		52	#include <kernel/errno.h>
1993	decky	53	#include <kernel/genarch/fb/visuals.h>
3767	svoboda	54	#include <console/color.h>
		55	#include <console/style.h>
1392	palkovsky	56	#include <async.h>
1993	decky	57	#include <bool.h>
1505	palkovsky	58
1404	palkovsky	59	#include "font-8x16.h"
1363	vana	60	#include "fb.h"
1505	palkovsky	61	#include "main.h"
		62	#include "../console/screenbuffer.h"
1547	palkovsky	63	#include "ppm.h"
1363	vana	64
1711	palkovsky	65	#include "pointer.xbm"
		66	#include "pointer_mask.xbm"
		67
3707	decky	68	#define DEFAULT_BGCOLOR 0xf0f0f0
		69	#define DEFAULT_FGCOLOR 0x000000
1363	vana	70
3707	decky	71	#define MAX_ANIM_LEN 8
		72	#define MAX_ANIMATIONS 4
		73	#define MAX_PIXMAPS 256 /*< Maximum number of saved pixmaps /
		74	#define MAX_VIEWPORTS 128 /*< Viewport is a rectangular area on the screen /
1363	vana	75
3744	svoboda	76	/** Function to render a pixel from a RGB value. */
3707	decky	77	typedef void (rgb_conv_t)(void , uint32_t);
1363	vana	78
3744	svoboda	79	/** Function to draw a glyph. */
		80	typedef void (*dg_t)(unsigned int x, unsigned int y, bool cursor,
		81	uint8_t *glyphs, uint8_t glyph, uint32_t fg_color, uint32_t bg_color);
		82
1485	palkovsky	83	struct {
3707	decky	84	uint8_t *fb_addr;
		85
1875	jermar	86	unsigned int xres;
		87	unsigned int yres;
3707	decky	88
1875	jermar	89	unsigned int scanline;
3707	decky	90	unsigned int glyphscanline;
		91
1875	jermar	92	unsigned int pixelbytes;
3707	decky	93	unsigned int glyphbytes;
		94
		95	rgb_conv_t rgb_conv;
1485	palkovsky	96	} screen;
1363	vana	97
3767	svoboda	98	/** Backbuffer character cell. */
1485	palkovsky	99	typedef struct {
3767	svoboda	100	uint8_t glyph;
		101	uint32_t fg_color;
		102	uint32_t bg_color;
		103	} bb_cell_t;
		104
		105	typedef struct {
3707	decky	106	bool initialized;
		107	unsigned int x;
		108	unsigned int y;
		109	unsigned int width;
		110	unsigned int height;
		111
1485	palkovsky	112	/* Text support in window */
3707	decky	113	unsigned int cols;
		114	unsigned int rows;
		115
3744	svoboda	116	/*
		117	* Style and glyphs for text printing
		118	*/
		119
3767	svoboda	120	/** Current attributes. */
		121	attr_rgb_t attr;
3744	svoboda	122
		123	/** Pre-rendered mask for rendering glyphs. Different viewports
		124	* might use different drawing functions depending on whether their
		125	* scanlines are aligned on a word boundary.*/
3707	decky	126	uint8_t *glyphs;
3744	svoboda	127
3707	decky	128	uint8_t *bgpixel;
3744	svoboda	129
		130	/** Glyph drawing function for this viewport. */
		131	dg_t dglyph;
3707	decky	132
1485	palkovsky	133	/* Auto-cursor position */
3707	decky	134	bool cursor_active;
		135	unsigned int cur_col;
		136	unsigned int cur_row;
		137	bool cursor_shown;
		138
		139	/* Back buffer */
3767	svoboda	140	bb_cell_t *backbuf;
3707	decky	141	unsigned int bbsize;
1485	palkovsky	142	} viewport_t;
1363	vana	143
1646	palkovsky	144	typedef struct {
3707	decky	145	bool initialized;
		146	bool enabled;
1646	palkovsky	147	unsigned int vp;
3707	decky	148
1646	palkovsky	149	unsigned int pos;
		150	unsigned int animlen;
		151	unsigned int pixmaps[MAX_ANIM_LEN];
		152	} animation_t;
3707	decky	153
1646	palkovsky	154	static animation_t animations[MAX_ANIMATIONS];
3707	decky	155	static bool anims_enabled;
1646	palkovsky	156
1552	palkovsky	157	typedef struct {
		158	unsigned int width;
		159	unsigned int height;
1781	jermar	160	uint8_t *data;
1552	palkovsky	161	} pixmap_t;
3707	decky	162
1552	palkovsky	163	static pixmap_t pixmaps[MAX_PIXMAPS];
1485	palkovsky	164	static viewport_t viewports[128];
		165
3707	decky	166	static bool client_connected = false; /*< Allow only 1 connection /
1485	palkovsky	167
3767	svoboda	168	static uint32_t color_table[16] = {
		169	[COLOR_BLACK] = 0x000000,
		170	[COLOR_BLUE] = 0x0000f0,
		171	[COLOR_GREEN] = 0x00f000,
		172	[COLOR_CYAN] = 0x00f0f0,
		173	[COLOR_RED] = 0xf00000,
		174	[COLOR_MAGENTA] = 0xf000f0,
		175	[COLOR_YELLOW] = 0xf0f000,
		176	[COLOR_WHITE] = 0xf0f0f0,
		177
		178	[8 + COLOR_BLACK] = 0x000000,
		179	[8 + COLOR_BLUE] = 0x0000ff,
		180	[8 + COLOR_GREEN] = 0x00ff00,
		181	[8 + COLOR_CYAN] = 0x00ffff,
		182	[8 + COLOR_RED] = 0xff0000,
		183	[8 + COLOR_MAGENTA] = 0xff00ff,
		184	[8 + COLOR_YELLOW] = 0xffff00,
		185	[8 + COLOR_WHITE] = 0xffffff,
		186	};
		187
3792	svoboda	188	static int rgb_from_attr(attr_rgb_t rgb, const attrs_t a);
3767	svoboda	189	static int rgb_from_style(attr_rgb_t *rgb, int style);
		190	static int rgb_from_idx(attr_rgb_t *rgb, ipcarg_t fg_color,
		191	ipcarg_t bg_color, ipcarg_t flags);
		192
		193	static int fb_set_color(viewport_t *vport, ipcarg_t fg_color,
		194	ipcarg_t bg_color, ipcarg_t attr);
		195
3744	svoboda	196	static void draw_glyph_aligned(unsigned int x, unsigned int y, bool cursor,
		197	uint8_t *glyphs, uint8_t glyph, uint32_t fg_color, uint32_t bg_color);
		198	static void draw_glyph_fallback(unsigned int x, unsigned int y, bool cursor,
		199	uint8_t *glyphs, uint8_t glyph, uint32_t fg_color, uint32_t bg_color);
		200
3739	svoboda	201	static void draw_vp_glyph(viewport_t *vport, bool cursor, unsigned int col,
3723	svoboda	202	unsigned int row);
		203
		204
3707	decky	205	#define RED(x, bits) ((x >> (8 + 8 + 8 - bits)) & ((1 << bits) - 1))
		206	#define GREEN(x, bits) ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
		207	#define BLUE(x, bits) ((x >> (8 - bits)) & ((1 << bits) - 1))
1363	vana	208
3707	decky	209	#define COL2X(col) ((col) * FONT_WIDTH)
		210	#define ROW2Y(row) ((row) * FONT_SCANLINES)
1363	vana	211
3707	decky	212	#define X2COL(x) ((x) / FONT_WIDTH)
		213	#define Y2ROW(y) ((y) / FONT_SCANLINES)
1363	vana	214
3707	decky	215	#define FB_POS(x, y) ((y) * screen.scanline + (x) * screen.pixelbytes)
		216	#define BB_POS(vport, col, row) ((row) * vport->cols + (col))
		217	#define GLYPH_POS(glyph, y, cursor) (((glyph) + (cursor) * FONT_GLYPHS) * screen.glyphbytes + (y) * screen.glyphscanline)
1875	jermar	218
1363	vana	219
3707	decky	220	/** ARGB 8:8:8:8 conversion
		221	*
		222	*/
		223	static void rgb_0888(void *dst, uint32_t rgb)
1363	vana	224	{
3707	decky	225	((uint32_t ) dst) = rgb & 0xffffff;
1363	vana	226	}
		227
1994	decky	228
3707	decky	229	/** ABGR 8:8:8:8 conversion
		230	*
		231	*/
		232	static void bgr_0888(void *dst, uint32_t rgb)
1994	decky	233	{
3707	decky	234	((uint32_t ) dst)
		235	= (BLUE(rgb, 8) << 16) \| (GREEN(rgb, 8) << 8) \| RED(rgb, 8);
1994	decky	236	}
		237
3707	decky	238
		239	/** BGR 8:8:8 conversion
		240	*
		241	*/
		242	static void rgb_888(void *dst, uint32_t rgb)
1363	vana	243	{
1871	jermar	244	#if defined(FB_INVERT_ENDIAN)
3710	decky	245	((uint8_t *) dst)[0] = RED(rgb, 8);
		246	((uint8_t *) dst)[1] = GREEN(rgb, 8);
		247	((uint8_t *) dst)[2] = BLUE(rgb, 8);
1363	vana	248	#else
3710	decky	249	((uint8_t *) dst)[0] = BLUE(rgb, 8);
		250	((uint8_t *) dst)[1] = GREEN(rgb, 8);
		251	((uint8_t *) dst)[2] = RED(rgb, 8);
1363	vana	252	#endif
		253	}
		254
		255
3707	decky	256	/** RGB 5:5:5 conversion
		257	*
		258	*/
		259	static void rgb_555(void *dst, uint32_t rgb)
1993	decky	260	{
3707	decky	261	((uint16_t ) dst)
		262	= (RED(rgb, 5) << 10) \| (GREEN(rgb, 5) << 5) \| BLUE(rgb, 5);
1993	decky	263	}
		264
		265
3707	decky	266	/** RGB 5:6:5 conversion
		267	*
		268	*/
		269	static void rgb_565(void *dst, uint32_t rgb)
1363	vana	270	{
3707	decky	271	((uint16_t ) dst)
		272	= (RED(rgb, 5) << 11) \| (GREEN(rgb, 6) << 5) \| BLUE(rgb, 5);
1363	vana	273	}
		274
		275
3707	decky	276	/** RGB 3:2:3
		277	*
		278	*/
		279	static void rgb_323(void *dst, uint32_t rgb)
1363	vana	280	{
3707	decky	281	((uint8_t ) dst)
		282	= ~((RED(rgb, 3) << 5) \| (GREEN(rgb, 2) << 3) \| BLUE(rgb, 3));
1363	vana	283	}
		284
3725	svoboda	285	/** Draw a filled rectangle.
		286	*
		287	* @note Need real implementation that does not access VRAM twice.
		288	*/
3723	svoboda	289	static void draw_filled_rect(unsigned int x0, unsigned int y0, unsigned int x1,
		290	unsigned int y1, uint32_t color)
		291	{
		292	unsigned int x, y;
3725	svoboda	293	unsigned int copy_bytes;
		294
		295	uint8_t sp, dp;
3723	svoboda	296	uint8_t cbuf[4];
1363	vana	297
3725	svoboda	298	if (y0 >= y1 \|\| x0 >= x1) return;
3723	svoboda	299	screen.rgb_conv(cbuf, color);
		300
3725	svoboda	301	sp = &screen.fb_addr[FB_POS(x0, y0)];
		302	dp = sp;
		303
		304	/* Draw the first line. */
		305	for (x = x0; x < x1; x++) {
		306	memcpy(dp, cbuf, screen.pixelbytes);
		307	dp += screen.pixelbytes;
3723	svoboda	308	}
3725	svoboda	309
		310	dp = sp + screen.scanline;
		311	copy_bytes = (x1 - x0) * screen.pixelbytes;
		312
		313	/* Draw the remaining lines by copying. */
		314	for (y = y0 + 1; y < y1; y++) {
		315	memcpy(dp, sp, copy_bytes);
		316	dp += screen.scanline;
		317	}
3723	svoboda	318	}
		319
		320	/** Redraw viewport.
1498	palkovsky	321	*
3707	decky	322	* @param vport Viewport to redraw
		323	*
1498	palkovsky	324	*/
3707	decky	325	static void vport_redraw(viewport_t *vport)
1485	palkovsky	326	{
3723	svoboda	327	unsigned int row, col;
		328
3707	decky	329	for (row = 0; row < vport->rows; row++) {
3723	svoboda	330	for (col = 0; col < vport->cols; col++) {
3739	svoboda	331	draw_vp_glyph(vport, false, col, row);
3707	decky	332	}
1672	palkovsky	333	}
3723	svoboda	334
3707	decky	335	if (COL2X(vport->cols) < vport->width) {
3723	svoboda	336	draw_filled_rect(
		337	vport->x + COL2X(vport->cols), vport->y,
		338	vport->x + vport->width, vport->y + vport->height,
3767	svoboda	339	vport->attr.bg_color);
1672	palkovsky	340	}
3723	svoboda	341
3707	decky	342	if (ROW2Y(vport->rows) < vport->height) {
3723	svoboda	343	draw_filled_rect(
		344	vport->x, vport->y + ROW2Y(vport->rows),
		345	vport->x + vport->width, vport->y + vport->height,
3767	svoboda	346	vport->attr.bg_color);
1672	palkovsky	347	}
1559	palkovsky	348	}
		349
3767	svoboda	350	static void backbuf_clear(bb_cell_t *backbuf, size_t len, uint32_t fg_color,
		351	uint32_t bg_color)
		352	{
		353	unsigned i;
3707	decky	354
3767	svoboda	355	for (i = 0; i < len; i++) {
		356	backbuf[i].glyph = 0;
		357	backbuf[i].fg_color = fg_color;
		358	backbuf[i].bg_color = bg_color;
		359	}
		360	}
		361
3724	svoboda	362	/** Clear viewport.
3707	decky	363	*
		364	* @param vport Viewport to clear
		365	*
		366	*/
		367	static void vport_clear(viewport_t *vport)
1363	vana	368	{
3767	svoboda	369	backbuf_clear(vport->backbuf, vport->cols * vport->rows,
		370	vport->attr.fg_color, vport->attr.bg_color);
3707	decky	371	vport_redraw(vport);
1363	vana	372	}
		373
3724	svoboda	374	/** Scroll viewport by the specified number of lines.
1485	palkovsky	375	*
1709	jermar	376	* @param vport Viewport to scroll
3707	decky	377	* @param lines Number of lines to scroll
		378	*
1485	palkovsky	379	*/
3707	decky	380	static void vport_scroll(viewport_t *vport, int lines)
1363	vana	381	{
3726	svoboda	382	unsigned int row, col;
3739	svoboda	383	unsigned int x, y;
		384	uint8_t glyph;
3767	svoboda	385	uint32_t fg_color;
		386	uint32_t bg_color;
		387	bb_cell_t bbp, xbp;
3726	svoboda	388
3724	svoboda	389	/*
3739	svoboda	390	* Redraw.
		391	*/
		392
		393	y = vport->y;
		394	for (row = 0; row < vport->rows; row++) {
		395	x = vport->x;
		396	for (col = 0; col < vport->cols; col++) {
		397	if ((row + lines >= 0) && (row + lines < vport->rows)) {
3767	svoboda	398	xbp = &vport->backbuf[BB_POS(vport, col, row + lines)];
		399	bbp = &vport->backbuf[BB_POS(vport, col, row)];
3739	svoboda	400
3767	svoboda	401	glyph = xbp->glyph;
		402	fg_color = xbp->fg_color;
		403	bg_color = xbp->bg_color;
		404
		405	if (bbp->glyph == glyph &&
		406	bbp->fg_color == xbp->fg_color &&
		407	bbp->bg_color == xbp->bg_color) {
3739	svoboda	408	x += FONT_WIDTH;
		409	continue;
		410	}
		411	} else {
		412	glyph = 0;
3767	svoboda	413	fg_color = vport->attr.fg_color;
		414	bg_color = vport->attr.bg_color;
3739	svoboda	415	}
		416
3744	svoboda	417	(*vport->dglyph)(x, y, false, vport->glyphs, glyph,
3767	svoboda	418	fg_color, bg_color);
3739	svoboda	419	x += FONT_WIDTH;
		420	}
		421	y += FONT_SCANLINES;
		422	}
		423
		424	/*
3724	svoboda	425	* Scroll backbuffer.
		426	*/
3723	svoboda	427
1672	palkovsky	428	if (lines > 0) {
3739	svoboda	429	memmove(vport->backbuf, vport->backbuf + vport->cols * lines,
3767	svoboda	430	vport->cols * (vport->rows - lines) * sizeof(bb_cell_t));
		431	backbuf_clear(&vport->backbuf[BB_POS(vport, 0, vport->rows - lines)],
		432	vport->cols * lines, vport->attr.fg_color, vport->attr.bg_color);
3707	decky	433	} else {
3739	svoboda	434	memmove(vport->backbuf - vport->cols * lines, vport->backbuf,
3767	svoboda	435	vport->cols * (vport->rows + lines) * sizeof(bb_cell_t));
		436	backbuf_clear(vport->backbuf, - vport->cols * lines,
		437	vport->attr.fg_color, vport->attr.bg_color);
1672	palkovsky	438	}
		439	}
		440
3707	decky	441	/** Render glyphs
1558	palkovsky	442	*
3707	decky	443	* Convert glyphs from device independent font
		444	* description to current visual representation.
		445	*
		446	* @param vport Viewport
		447	*
1558	palkovsky	448	*/
3707	decky	449	static void render_glyphs(viewport_t* vport)
1363	vana	450	{
3707	decky	451	unsigned int glyph;
		452
		453	for (glyph = 0; glyph < FONT_GLYPHS; glyph++) {
		454	unsigned int y;
		455
		456	for (y = 0; y < FONT_SCANLINES; y++) {
		457	unsigned int x;
		458
		459	for (x = 0; x < FONT_WIDTH; x++) {
		460	screen.rgb_conv(&vport->glyphs[GLYPH_POS(glyph, y, false) + x * screen.pixelbytes],
		461	(fb_font[glyph * FONT_SCANLINES + y] & (1 << (7 - x)))
3744	svoboda	462	? 0xffffff : 0x000000);
3707	decky	463
3744	svoboda	464	screen.rgb_conv(&vport->glyphs[GLYPH_POS(glyph, y, true) + x * screen.pixelbytes],
		465	(fb_font[glyph * FONT_SCANLINES + y] & (1 << (7 - x)))
		466	? 0x000000 : 0xffffff);
3707	decky	467	}
1509	palkovsky	468	}
		469	}
3707	decky	470
3767	svoboda	471	screen.rgb_conv(vport->bgpixel, vport->attr.bg_color);
1363	vana	472	}
		473
		474
1485	palkovsky	475	/** Create new viewport
1363	vana	476	*
3707	decky	477	* @param x Origin of the viewport (x).
		478	* @param y Origin of the viewport (y).
		479	* @param width Width of the viewport.
		480	* @param height Height of the viewport.
		481	*
		482	* @return New viewport number.
		483	*
1363	vana	484	*/
3707	decky	485	static int vport_create(unsigned int x, unsigned int y,
		486	unsigned int width, unsigned int height)
1363	vana	487	{
3707	decky	488	unsigned int i;
		489
2070	jermar	490	for (i = 0; i < MAX_VIEWPORTS; i++) {
1485	palkovsky	491	if (!viewports[i].initialized)
1363	vana	492	break;
		493	}
1485	palkovsky	494	if (i == MAX_VIEWPORTS)
		495	return ELIMIT;
3707	decky	496
		497	unsigned int cols = width / FONT_WIDTH;
		498	unsigned int rows = height / FONT_SCANLINES;
3767	svoboda	499	unsigned int bbsize = cols * rows * sizeof(bb_cell_t);
3707	decky	500	unsigned int glyphsize = 2 * FONT_GLYPHS * screen.glyphbytes;
3744	svoboda	501	unsigned int word_size = sizeof(unsigned long);
3707	decky	502
3767	svoboda	503	bb_cell_t backbuf = (bb_cell_t ) malloc(bbsize);
3707	decky	504	if (!backbuf)
		505	return ENOMEM;
		506
		507	uint8_t glyphs = (uint8_t ) malloc(glyphsize);
		508	if (!glyphs) {
		509	free(backbuf);
		510	return ENOMEM;
		511	}
		512
		513	uint8_t bgpixel = (uint8_t ) malloc(screen.pixelbytes);
		514	if (!bgpixel) {
		515	free(glyphs);
		516	free(backbuf);
		517	return ENOMEM;
		518	}
3767	svoboda	519
		520	backbuf_clear(backbuf, cols * rows, DEFAULT_FGCOLOR, DEFAULT_BGCOLOR);
3707	decky	521	memset(glyphs, 0, glyphsize);
		522	memset(bgpixel, 0, screen.pixelbytes);
		523
1485	palkovsky	524	viewports[i].x = x;
		525	viewports[i].y = y;
		526	viewports[i].width = width;
		527	viewports[i].height = height;
1363	vana	528
3707	decky	529	viewports[i].cols = cols;
		530	viewports[i].rows = rows;
		531
3767	svoboda	532	viewports[i].attr.bg_color = DEFAULT_BGCOLOR;
		533	viewports[i].attr.fg_color = DEFAULT_FGCOLOR;
1363	vana	534
3707	decky	535	viewports[i].glyphs = glyphs;
		536	viewports[i].bgpixel = bgpixel;
3744	svoboda	537
		538	/*
		539	* Conditions necessary to select aligned version:
		540	*
		541	* - word size is divisible by pixelbytes
		542	* - cell scanline size is divisible by word size
		543	* - cell scanlines are word-aligned
		544	*/
		545	if ((word_size % screen.pixelbytes) == 0 &&
		546	(FONT_WIDTH * screen.pixelbytes) % word_size == 0 &&
		547	(x * screen.pixelbytes) % word_size == 0 &&
		548	screen.scanline % word_size == 0) {
		549
		550	viewports[i].dglyph = draw_glyph_aligned;
		551	} else {
		552	viewports[i].dglyph = draw_glyph_fallback;
		553	}
		554
1489	palkovsky	555	viewports[i].cur_col = 0;
		556	viewports[i].cur_row = 0;
3707	decky	557	viewports[i].cursor_active = false;
		558	viewports[i].cursor_shown = false;
		559
		560	viewports[i].bbsize = bbsize;
		561	viewports[i].backbuf = backbuf;
		562
		563	viewports[i].initialized = true;
		564
		565	render_glyphs(&viewports[i]);
		566
1485	palkovsky	567	return i;
1363	vana	568	}
		569
3707	decky	570
1363	vana	571	/** Initialize framebuffer as a chardev output device
		572	*
3707	decky	573	* @param addr Address of the framebuffer
		574	* @param xres Screen width in pixels
		575	* @param yres Screen height in pixels
		576	* @param visual Bits per pixel (8, 16, 24, 32)
		577	* @param scan Bytes per one scanline
1363	vana	578	*
		579	*/
3707	decky	580	static bool screen_init(void *addr, unsigned int xres, unsigned int yres,
		581	unsigned int scan, unsigned int visual)
1363	vana	582	{
1993	decky	583	switch (visual) {
		584	case VISUAL_INDIRECT_8:
3707	decky	585	screen.rgb_conv = rgb_323;
1886	jermar	586	screen.pixelbytes = 1;
		587	break;
1993	decky	588	case VISUAL_RGB_5_5_5:
3707	decky	589	screen.rgb_conv = rgb_555;
1886	jermar	590	screen.pixelbytes = 2;
		591	break;
1993	decky	592	case VISUAL_RGB_5_6_5:
3707	decky	593	screen.rgb_conv = rgb_565;
1993	decky	594	screen.pixelbytes = 2;
1886	jermar	595	break;
1993	decky	596	case VISUAL_RGB_8_8_8:
3707	decky	597	screen.rgb_conv = rgb_888;
1993	decky	598	screen.pixelbytes = 3;
		599	break;
		600	case VISUAL_RGB_8_8_8_0:
3707	decky	601	screen.rgb_conv = rgb_888;
1886	jermar	602	screen.pixelbytes = 4;
		603	break;
1993	decky	604	case VISUAL_RGB_0_8_8_8:
3707	decky	605	screen.rgb_conv = rgb_0888;
1993	decky	606	screen.pixelbytes = 4;
		607	break;
1994	decky	608	case VISUAL_BGR_0_8_8_8:
3707	decky	609	screen.rgb_conv = bgr_0888;
1994	decky	610	screen.pixelbytes = 4;
		611	break;
1993	decky	612	default:
		613	return false;
1363	vana	614	}
		615
3707	decky	616	screen.fb_addr = (unsigned char *) addr;
1485	palkovsky	617	screen.xres = xres;
		618	screen.yres = yres;
		619	screen.scanline = scan;
1363	vana	620
3707	decky	621	screen.glyphscanline = FONT_WIDTH * screen.pixelbytes;
		622	screen.glyphbytes = screen.glyphscanline * FONT_SCANLINES;
		623
1485	palkovsky	624	/* Create first viewport */
3707	decky	625	vport_create(0, 0, xres, yres);
1993	decky	626
		627	return true;
1485	palkovsky	628	}
1363	vana	629
3707	decky	630
3744	svoboda	631	/** Draw a glyph, takes advantage of alignment.
3707	decky	632	*
3744	svoboda	633	* This version can only be used if the following conditions are met:
3739	svoboda	634	*
3744	svoboda	635	* - word size is divisible by pixelbytes
		636	* - cell scanline size is divisible by word size
		637	* - cell scanlines are word-aligned
		638	*
		639	* It makes use of the pre-rendered mask to process (possibly) several
		640	* pixels at once (word size / pixelbytes pixels at a time are processed)
		641	* making it very fast. Most notably this version is not applicable at 24 bits
		642	* per pixel.
		643	*
		644	* @param x x coordinate of top-left corner on screen.
		645	* @param y y coordinate of top-left corner on screen.
		646	* @param cursor Draw glyph with cursor
		647	* @param glyphs Pointer to font bitmap.
		648	* @param glyph Code of the glyph to draw.
		649	* @param fg_color Foreground color.
		650	* @param bg_color Backgroudn color.
3739	svoboda	651	*/
3744	svoboda	652	static void draw_glyph_aligned(unsigned int x, unsigned int y, bool cursor,
		653	uint8_t *glyphs, uint8_t glyph, uint32_t fg_color, uint32_t bg_color)
3739	svoboda	654	{
3744	svoboda	655	unsigned int i, yd;
		656	unsigned long fg_buf, bg_buf;
		657	unsigned long maskp, dp;
		658	unsigned long mask;
		659	unsigned int ww, d_add;
		660
		661	/*
		662	* Prepare a pair of words, one filled with foreground-color
		663	* pattern and the other filled with background-color pattern.
		664	*/
		665	for (i = 0; i < sizeof(unsigned long) / screen.pixelbytes; i++) {
		666	screen.rgb_conv(&((uint8_t )&fg_buf)[i screen.pixelbytes],
		667	fg_color);
		668	screen.rgb_conv(&((uint8_t )&bg_buf)[i screen.pixelbytes],
		669	bg_color);
		670	}
		671
		672
		673	/* Pointer to the current position in the mask. */
		674	maskp = (unsigned long *) &glyphs[GLYPH_POS(glyph, 0, cursor)];
		675
		676	/* Pointer to the current position on the screen. */
		677	dp = (unsigned long *) &screen.fb_addr[FB_POS(x, y)];
		678
		679	/* Width of the character cell in words. */
		680	ww = FONT_WIDTH * screen.pixelbytes / sizeof(unsigned long);
		681
		682	/* Offset to add when moving to another screen scanline. */
		683	d_add = screen.scanline - FONT_WIDTH * screen.pixelbytes;
		684
		685	for (yd = 0; yd < FONT_SCANLINES; yd++) {
		686	/*
		687	* Now process the cell scanline, combining foreground
		688	* and background color patters using the pre-rendered mask.
		689	*/
		690	for (i = 0; i < ww; i++) {
		691	mask = *maskp++;
		692	*dp++ = (fg_buf & mask) \| (bg_buf & ~mask);
		693	}
		694
		695	/* Move to the beginning of the next scanline of the cell. */
		696	dp = (unsigned long ) ((uint8_t ) dp + d_add);
		697	}
3739	svoboda	698	}
		699
3744	svoboda	700	/** Draw a glyph, fallback version.
		701	*
		702	* This version does not make use of the pre-rendered mask, it uses
		703	* the font bitmap directly. It works always, but it is slower.
		704	*
		705	* @param x x coordinate of top-left corner on screen.
		706	* @param y y coordinate of top-left corner on screen.
		707	* @param cursor Draw glyph with cursor
		708	* @param glyphs Pointer to font bitmap.
		709	* @param glyph Code of the glyph to draw.
		710	* @param fg_color Foreground color.
		711	* @param bg_color Backgroudn color.
		712	*/
		713	void draw_glyph_fallback(unsigned int x, unsigned int y, bool cursor,
		714	uint8_t *glyphs, uint8_t glyph, uint32_t fg_color, uint32_t bg_color)
		715	{
		716	unsigned int i, j, yd;
		717	uint8_t fg_buf[4], bg_buf[4];
		718	uint8_t dp, sp;
		719	unsigned int d_add;
		720	uint8_t b;
		721
		722	/* Pre-render 1x the foreground and background color pixels. */
		723	if (cursor) {
		724	screen.rgb_conv(fg_buf, bg_color);
		725	screen.rgb_conv(bg_buf, fg_color);
		726	} else {
		727	screen.rgb_conv(fg_buf, fg_color);
		728	screen.rgb_conv(bg_buf, bg_color);
		729	}
		730
		731	/* Pointer to the current position on the screen. */
		732	dp = (uint8_t *) &screen.fb_addr[FB_POS(x, y)];
		733
		734	/* Offset to add when moving to another screen scanline. */
		735	d_add = screen.scanline - FONT_WIDTH * screen.pixelbytes;
		736
		737	for (yd = 0; yd < FONT_SCANLINES; yd++) {
		738	/* Byte containing bits of the glyph scanline. */
		739	b = fb_font[glyph * FONT_SCANLINES + yd];
		740
		741	for (i = 0; i < FONT_WIDTH; i++) {
		742	/* Choose color based on the current bit. */
		743	sp = (b & 0x80) ? fg_buf : bg_buf;
		744
		745	/* Copy the pixel. */
		746	for (j = 0; j < screen.pixelbytes; j++) {
		747	dp++ = sp++;
		748	}
		749
		750	/* Move to the next bit. */
		751	b = b << 1;
		752	}
		753
		754	/* Move to the beginning of the next scanline of the cell. */
		755	dp += d_add;
		756	}
		757	}
		758
3739	svoboda	759	/** Draw glyph at specified position in viewport.
		760	*
3707	decky	761	* @param vport Viewport identification
		762	* @param cursor Draw glyph with cursor
		763	* @param col Screen position relative to viewport
		764	* @param row Screen position relative to viewport
		765	*
		766	*/
3739	svoboda	767	static void draw_vp_glyph(viewport_t *vport, bool cursor, unsigned int col,
		768	unsigned int row)
1500	palkovsky	769	{
3707	decky	770	unsigned int x = vport->x + COL2X(col);
		771	unsigned int y = vport->y + ROW2Y(row);
3767	svoboda	772
3739	svoboda	773	uint8_t glyph;
3767	svoboda	774	uint32_t fg_color;
		775	uint32_t bg_color;
3707	decky	776
3767	svoboda	777	glyph = vport->backbuf[BB_POS(vport, col, row)].glyph;
		778	fg_color = vport->backbuf[BB_POS(vport, col, row)].fg_color;
		779	bg_color = vport->backbuf[BB_POS(vport, col, row)].bg_color;
3744	svoboda	780
		781	(*vport->dglyph)(x, y, cursor, vport->glyphs, glyph,
3767	svoboda	782	fg_color, bg_color);
3707	decky	783	}
		784
		785	/** Hide cursor if it is shown
		786	*
		787	*/
		788	static void cursor_hide(viewport_t *vport)
		789	{
		790	if ((vport->cursor_active) && (vport->cursor_shown)) {
3739	svoboda	791	draw_vp_glyph(vport, false, vport->cur_col, vport->cur_row);
3707	decky	792	vport->cursor_shown = false;
1500	palkovsky	793	}
		794	}
		795
3707	decky	796
		797	/** Show cursor if cursor showing is enabled
		798	*
		799	*/
		800	static void cursor_show(viewport_t *vport)
1500	palkovsky	801	{
		802	/* Do not check for cursor_shown */
		803	if (vport->cursor_active) {
3739	svoboda	804	draw_vp_glyph(vport, true, vport->cur_col, vport->cur_row);
3707	decky	805	vport->cursor_shown = true;
1500	palkovsky	806	}
		807	}
		808
3707	decky	809
		810	/** Invert cursor, if it is enabled
		811	*
		812	*/
		813	static void cursor_blink(viewport_t *vport)
1500	palkovsky	814	{
		815	if (vport->cursor_shown)
1673	palkovsky	816	cursor_hide(vport);
1500	palkovsky	817	else
3707	decky	818	cursor_show(vport);
1500	palkovsky	819	}
		820
3707	decky	821
		822	/** Draw character at given position relative to viewport
		823	*
		824	* @param vport Viewport identification
		825	* @param c Character to draw
		826	* @param col Screen position relative to viewport
		827	* @param row Screen position relative to viewport
		828	*
1498	palkovsky	829	*/
3707	decky	830	static void draw_char(viewport_t *vport, uint8_t c, unsigned int col, unsigned int row)
1486	palkovsky	831	{
3767	svoboda	832	bb_cell_t *bbp;
		833
3707	decky	834	/* Do not hide cursor if we are going to overwrite it */
		835	if ((vport->cursor_active) && (vport->cursor_shown) &&
		836	((vport->cur_col != col) \|\| (vport->cur_row != row)))
		837	cursor_hide(vport);
3767	svoboda	838
		839	bbp = &vport->backbuf[BB_POS(vport, col, row)];
		840	bbp->glyph = c;
		841	bbp->fg_color = vport->attr.fg_color;
		842	bbp->bg_color = vport->attr.bg_color;
		843
3739	svoboda	844	draw_vp_glyph(vport, false, col, row);
3707	decky	845
1489	palkovsky	846	vport->cur_col = col;
		847	vport->cur_row = row;
3707	decky	848
1489	palkovsky	849	vport->cur_col++;
2025	jermar	850	if (vport->cur_col >= vport->cols) {
1489	palkovsky	851	vport->cur_col = 0;
		852	vport->cur_row++;
		853	if (vport->cur_row >= vport->rows)
		854	vport->cur_row--;
1486	palkovsky	855	}
3707	decky	856
		857	cursor_show(vport);
1486	palkovsky	858	}
		859
3707	decky	860
1552	palkovsky	861	/** Draw text data to viewport
		862	*
1709	jermar	863	* @param vport Viewport id
3707	decky	864	* @param data Text data fitting exactly into viewport
		865	*
1552	palkovsky	866	*/
3707	decky	867	static void draw_text_data(viewport_t vport, keyfield_t data)
1505	palkovsky	868	{
3707	decky	869	unsigned int i;
3767	svoboda	870	bb_cell_t *bbp;
		871	attrs_t *a;
		872	attr_rgb_t rgb;
3707	decky	873
2025	jermar	874	for (i = 0; i < vport->cols * vport->rows; i++) {
3707	decky	875	unsigned int col = i % vport->cols;
		876	unsigned int row = i / vport->cols;
		877
3767	svoboda	878	bbp = &vport->backbuf[BB_POS(vport, col, row)];
		879	uint8_t glyph = bbp->glyph;
		880
3792	svoboda	881	a = &data[i].attrs;
		882	rgb_from_attr(&rgb, a);
3767	svoboda	883
3792	svoboda	884	if (glyph != data[i].character \|\|
		885	rgb.fg_color != bbp->fg_color \|\|
		886	rgb.bg_color != bbp->bg_color) {
		887	bbp->glyph = data[i].character;
3767	svoboda	888
		889	bbp->fg_color = rgb.fg_color;
		890	bbp->bg_color = rgb.bg_color;
		891
3739	svoboda	892	draw_vp_glyph(vport, false, col, row);
3707	decky	893	}
1505	palkovsky	894	}
3707	decky	895	cursor_show(vport);
1505	palkovsky	896	}
		897
3707	decky	898
		899	static void putpixel_pixmap(void *data, unsigned int x, unsigned int y, uint32_t color)
1555	palkovsky	900	{
3707	decky	901	int pm = ((int ) data);
		902	pixmap_t *pmap = &pixmaps[pm];
		903	unsigned int pos = (y * pmap->width + x) * screen.pixelbytes;
1555	palkovsky	904
3707	decky	905	screen.rgb_conv(&pmap->data[pos], color);
		906	}
		907
		908
		909	static void putpixel(void *data, unsigned int x, unsigned int y, uint32_t color)
		910	{
		911	viewport_t vport = (viewport_t ) data;
		912	unsigned int dx = vport->x + x;
		913	unsigned int dy = vport->y + y;
		914
		915	screen.rgb_conv(&screen.fb_addr[FB_POS(dx, dy)], color);
		916	}
		917
		918
		919	/** Return first free pixmap
		920	*
		921	*/
		922	static int find_free_pixmap(void)
		923	{
		924	unsigned int i;
		925
		926	for (i = 0; i < MAX_PIXMAPS; i++)
1555	palkovsky	927	if (!pixmaps[i].data)
		928	return i;
3707	decky	929
1555	palkovsky	930	return -1;
		931	}
		932
		933
3707	decky	934	/** Create a new pixmap and return appropriate ID
		935	*
		936	*/
		937	static int shm2pixmap(unsigned char *shm, size_t size)
1555	palkovsky	938	{
		939	int pm;
		940	pixmap_t *pmap;
3707	decky	941
1555	palkovsky	942	pm = find_free_pixmap();
		943	if (pm == -1)
		944	return ELIMIT;
3707	decky	945
1555	palkovsky	946	pmap = &pixmaps[pm];
		947
		948	if (ppm_get_data(shm, size, &pmap->width, &pmap->height))
		949	return EINVAL;
		950
		951	pmap->data = malloc(pmap->width * pmap->height * screen.pixelbytes);
		952	if (!pmap->data)
		953	return ENOMEM;
3707	decky	954
		955	ppm_draw(shm, size, 0, 0, pmap->width, pmap->height, putpixel_pixmap, (void *) &pm);
		956
1555	palkovsky	957	return pm;
		958	}
		959
3707	decky	960
1552	palkovsky	961	/** Handle shared memory communication calls
		962	*
		963	* Protocol for drawing pixmaps:
		964	* - FB_PREPARE_SHM(client shm identification)
2025	jermar	965	* - IPC_M_AS_AREA_SEND
3707	decky	966	* - FB_DRAW_PPM(startx, starty)
1552	palkovsky	967	* - FB_DROP_SHM
		968	*
		969	* Protocol for text drawing
2025	jermar	970	* - IPC_M_AS_AREA_SEND
1552	palkovsky	971	* - FB_DRAW_TEXT_DATA
		972	*
		973	* @param callid Callid of the current call
3707	decky	974	* @param call Current call data
		975	* @param vp Active viewport
1552	palkovsky	976	*
3707	decky	977	* @return false if the call was not handled byt this function, true otherwise
		978	*
		979	* Note: this function is not threads safe, you would have
1552	palkovsky	980	* to redefine static variables with __thread
3707	decky	981	*
1552	palkovsky	982	*/
3707	decky	983	static bool shm_handle(ipc_callid_t callid, ipc_call_t *call, int vp)
1547	palkovsky	984	{
		985	static keyfield_t *interbuffer = NULL;
		986	static size_t intersize = 0;
3707	decky	987
1720	palkovsky	988	static unsigned char *shm = NULL;
1555	palkovsky	989	static ipcarg_t shm_id = 0;
		990	static size_t shm_size;
3707	decky	991
		992	bool handled = true;
		993	int retval = EOK;
1547	palkovsky	994	viewport_t *vport = &viewports[vp];
3707	decky	995	unsigned int x;
		996	unsigned int y;
		997
1547	palkovsky	998	switch (IPC_GET_METHOD(*call)) {
2677	jermar	999	case IPC_M_SHARE_OUT:
1547	palkovsky	1000	/* We accept one area for data interchange */
1555	palkovsky	1001	if (IPC_GET_ARG1(*call) == shm_id) {
2141	jermar	1002	void dest = as_get_mappable_page(IPC_GET_ARG2(call));
1555	palkovsky	1003	shm_size = IPC_GET_ARG2(*call);
3707	decky	1004	if (!ipc_answer_1(callid, EOK, (sysarg_t) dest))
1555	palkovsky	1005	shm = dest;
1547	palkovsky	1006	else
1555	palkovsky	1007	shm_id = 0;
3707	decky	1008
1555	palkovsky	1009	if (shm[0] != 'P')
3707	decky	1010	return false;
		1011
		1012	return true;
1547	palkovsky	1013	} else {
		1014	intersize = IPC_GET_ARG2(*call);
2015	jermar	1015	receive_comm_area(callid, call, (void *) &interbuffer);
1547	palkovsky	1016	}
3707	decky	1017	return true;
1547	palkovsky	1018	case FB_PREPARE_SHM:
1555	palkovsky	1019	if (shm_id)
1547	palkovsky	1020	retval = EBUSY;
		1021	else
1555	palkovsky	1022	shm_id = IPC_GET_ARG1(*call);
1547	palkovsky	1023	break;
		1024
		1025	case FB_DROP_SHM:
1555	palkovsky	1026	if (shm) {
		1027	as_area_destroy(shm);
		1028	shm = NULL;
1547	palkovsky	1029	}
1555	palkovsky	1030	shm_id = 0;
1547	palkovsky	1031	break;
3707	decky	1032
1555	palkovsky	1033	case FB_SHM2PIXMAP:
		1034	if (!shm) {
		1035	retval = EINVAL;
		1036	break;
		1037	}
		1038	retval = shm2pixmap(shm, shm_size);
		1039	break;
1547	palkovsky	1040	case FB_DRAW_PPM:
1555	palkovsky	1041	if (!shm) {
1547	palkovsky	1042	retval = EINVAL;
		1043	break;
		1044	}
		1045	x = IPC_GET_ARG1(*call);
		1046	y = IPC_GET_ARG2(*call);
3707	decky	1047
		1048	if ((x > vport->width) \|\| (y > vport->height)) {
1547	palkovsky	1049	retval = EINVAL;
		1050	break;
		1051	}
		1052
2025	jermar	1053	ppm_draw(shm, shm_size, IPC_GET_ARG1(*call),
3707	decky	1054	IPC_GET_ARG2(call), vport->width - x, vport->height - y, putpixel, (void ) vport);
1547	palkovsky	1055	break;
		1056	case FB_DRAW_TEXT_DATA:
		1057	if (!interbuffer) {
		1058	retval = EINVAL;
		1059	break;
		1060	}
3707	decky	1061	if (intersize < vport->cols * vport->rows * sizeof(*interbuffer)) {
1547	palkovsky	1062	retval = EINVAL;
		1063	break;
		1064	}
1673	palkovsky	1065	draw_text_data(vport, interbuffer);
1547	palkovsky	1066	break;
		1067	default:
3707	decky	1068	handled = false;
1547	palkovsky	1069	}
		1070
		1071	if (handled)
2619	jermar	1072	ipc_answer_0(callid, retval);
1547	palkovsky	1073	return handled;
		1074	}
		1075
3707	decky	1076
		1077	static void copy_vp_to_pixmap(viewport_t vport, pixmap_t pmap)
1552	palkovsky	1078	{
3707	decky	1079	unsigned int width = vport->width;
		1080	unsigned int height = vport->height;
		1081
1711	palkovsky	1082	if (width + vport->x > screen.xres)
		1083	width = screen.xres - vport->x;
2301	decky	1084	if (height + vport->y > screen.yres)
1711	palkovsky	1085	height = screen.yres - vport->y;
2301	decky	1086
3707	decky	1087	unsigned int realwidth = pmap->width <= width ? pmap->width : width;
		1088	unsigned int realheight = pmap->height <= height ? pmap->height : height;
2301	decky	1089
3707	decky	1090	unsigned int srcrowsize = vport->width * screen.pixelbytes;
		1091	unsigned int realrowsize = realwidth * screen.pixelbytes;
		1092
		1093	unsigned int y;
2301	decky	1094	for (y = 0; y < realheight; y++) {
3707	decky	1095	unsigned int tmp = (vport->y + y) * screen.scanline + vport->x * screen.pixelbytes;
		1096	memcpy(pmap->data + srcrowsize * y, screen.fb_addr + tmp, realrowsize);
1711	palkovsky	1097	}
		1098	}
		1099
3707	decky	1100
		1101	/** Save viewport to pixmap
		1102	*
		1103	*/
		1104	static int save_vp_to_pixmap(viewport_t *vport)
1711	palkovsky	1105	{
		1106	int pm;
		1107	pixmap_t *pmap;
3707	decky	1108
1552	palkovsky	1109	pm = find_free_pixmap();
		1110	if (pm == -1)
		1111	return ELIMIT;
		1112
		1113	pmap = &pixmaps[pm];
		1114	pmap->data = malloc(screen.pixelbytes * vport->width * vport->height);
		1115	if (!pmap->data)
		1116	return ENOMEM;
3707	decky	1117
1552	palkovsky	1118	pmap->width = vport->width;
		1119	pmap->height = vport->height;
3707	decky	1120
1711	palkovsky	1121	copy_vp_to_pixmap(vport, pmap);
1552	palkovsky	1122
		1123	return pm;
		1124	}
		1125
3707	decky	1126
1552	palkovsky	1127	/** Draw pixmap on screen
		1128	*
		1129	* @param vp Viewport to draw on
		1130	* @param pm Pixmap identifier
3707	decky	1131	*
1552	palkovsky	1132	*/
		1133	static int draw_pixmap(int vp, int pm)
		1134	{
		1135	pixmap_t *pmap = &pixmaps[pm];
		1136	viewport_t *vport = &viewports[vp];
3707	decky	1137
		1138	unsigned int width = vport->width;
		1139	unsigned int height = vport->height;
		1140
1711	palkovsky	1141	if (width + vport->x > screen.xres)
		1142	width = screen.xres - vport->x;
		1143	if (height + vport->y > screen.yres)
		1144	height = screen.yres - vport->y;
3707	decky	1145
1552	palkovsky	1146	if (!pmap->data)
		1147	return EINVAL;
3707	decky	1148
		1149	unsigned int realwidth = pmap->width <= width ? pmap->width : width;
		1150	unsigned int realheight = pmap->height <= height ? pmap->height : height;
		1151
		1152	unsigned int srcrowsize = vport->width * screen.pixelbytes;
		1153	unsigned int realrowsize = realwidth * screen.pixelbytes;
		1154
		1155	unsigned int y;
2070	jermar	1156	for (y = 0; y < realheight; y++) {
3707	decky	1157	unsigned int tmp = (vport->y + y) * screen.scanline + vport->x * screen.pixelbytes;
		1158	memcpy(screen.fb_addr + tmp, pmap->data + y * srcrowsize, realrowsize);
1552	palkovsky	1159	}
3707	decky	1160
		1161	return EOK;
1552	palkovsky	1162	}
		1163
3707	decky	1164
		1165	/** Tick animation one step forward
		1166	*
		1167	*/
		1168	static void anims_tick(void)
1646	palkovsky	1169	{
3707	decky	1170	unsigned int i;
1646	palkovsky	1171	static int counts = 0;
		1172
		1173	/* Limit redrawing */
2025	jermar	1174	counts = (counts + 1) % 8;
1646	palkovsky	1175	if (counts)
		1176	return;
		1177
2070	jermar	1178	for (i = 0; i < MAX_ANIMATIONS; i++) {
3707	decky	1179	if ((!animations[i].animlen) \|\| (!animations[i].initialized) \|\|
		1180	(!animations[i].enabled))
1646	palkovsky	1181	continue;
3707	decky	1182
		1183	draw_pixmap(animations[i].vp, animations[i].pixmaps[animations[i].pos]);
		1184	animations[i].pos = (animations[i].pos + 1) % animations[i].animlen;
1646	palkovsky	1185	}
		1186	}
		1187
1711	palkovsky	1188
3707	decky	1189	static unsigned int pointer_x;
		1190	static unsigned int pointer_y;
		1191	static bool pointer_shown, pointer_enabled;
1711	palkovsky	1192	static int pointer_vport = -1;
		1193	static int pointer_pixmap = -1;
		1194
3707	decky	1195
		1196	static void mouse_show(void)
1711	palkovsky	1197	{
2070	jermar	1198	int i, j;
1711	palkovsky	1199	int visibility;
		1200	int color;
		1201	int bytepos;
3707	decky	1202
		1203	if ((pointer_shown) \|\| (!pointer_enabled))
1723	palkovsky	1204	return;
3707	decky	1205
3723	svoboda	1206	/* Save image under the pointer. */
1711	palkovsky	1207	if (pointer_vport == -1) {
3707	decky	1208	pointer_vport = vport_create(pointer_x, pointer_y, pointer_width, pointer_height);
1711	palkovsky	1209	if (pointer_vport < 0)
		1210	return;
		1211	} else {
		1212	viewports[pointer_vport].x = pointer_x;
		1213	viewports[pointer_vport].y = pointer_y;
		1214	}
3707	decky	1215
1711	palkovsky	1216	if (pointer_pixmap == -1)
		1217	pointer_pixmap = save_vp_to_pixmap(&viewports[pointer_vport]);
		1218	else
3707	decky	1219	copy_vp_to_pixmap(&viewports[pointer_vport], &pixmaps[pointer_pixmap]);
		1220
3723	svoboda	1221	/* Draw mouse pointer. */
2025	jermar	1222	for (i = 0; i < pointer_height; i++)
		1223	for (j = 0; j < pointer_width; j++) {
		1224	bytepos = i * ((pointer_width - 1) / 8 + 1) + j / 8;
2070	jermar	1225	visibility = pointer_mask_bits[bytepos] &
2619	jermar	1226	(1 << (j % 8));
1711	palkovsky	1227	if (visibility) {
2619	jermar	1228	color = pointer_bits[bytepos] &
		1229	(1 << (j % 8)) ? 0 : 0xffffff;
2025	jermar	1230	if (pointer_x + j < screen.xres && pointer_y +
2619	jermar	1231	i < screen.yres)
2025	jermar	1232	putpixel(&viewports[0], pointer_x + j,
2619	jermar	1233	pointer_y + i, color);
1711	palkovsky	1234	}
		1235	}
		1236	pointer_shown = 1;
		1237	}
		1238
3707	decky	1239
		1240	static void mouse_hide(void)
1711	palkovsky	1241	{
3723	svoboda	1242	/* Restore image under the pointer. */
1711	palkovsky	1243	if (pointer_shown) {
		1244	draw_pixmap(pointer_vport, pointer_pixmap);
		1245	pointer_shown = 0;
		1246	}
		1247	}
		1248
3707	decky	1249
		1250	static void mouse_move(unsigned int x, unsigned int y)
1711	palkovsky	1251	{
		1252	mouse_hide();
		1253	pointer_x = x;
		1254	pointer_y = y;
		1255	mouse_show();
		1256	}
		1257
3707	decky	1258
		1259	static int anim_handle(ipc_callid_t callid, ipc_call_t *call, int vp)
1646	palkovsky	1260	{
3707	decky	1261	bool handled = true;
		1262	int retval = EOK;
		1263	int i, nvp;
1646	palkovsky	1264	int newval;
3707	decky	1265
1646	palkovsky	1266	switch (IPC_GET_METHOD(*call)) {
		1267	case FB_ANIM_CREATE:
		1268	nvp = IPC_GET_ARG1(*call);
		1269	if (nvp == -1)
		1270	nvp = vp;
2025	jermar	1271	if (nvp >= MAX_VIEWPORTS \|\| nvp < 0 \|\|
		1272	!viewports[nvp].initialized) {
1646	palkovsky	1273	retval = EINVAL;
		1274	break;
		1275	}
2025	jermar	1276	for (i = 0; i < MAX_ANIMATIONS; i++) {
		1277	if (!animations[i].initialized)
1646	palkovsky	1278	break;
		1279	}
		1280	if (i == MAX_ANIMATIONS) {
		1281	retval = ELIMIT;
		1282	break;
		1283	}
		1284	animations[i].initialized = 1;
		1285	animations[i].animlen = 0;
		1286	animations[i].pos = 0;
		1287	animations[i].enabled = 0;
		1288	animations[i].vp = nvp;
		1289	retval = i;
		1290	break;
		1291	case FB_ANIM_DROP:
		1292	i = IPC_GET_ARG1(*call);
1720	palkovsky	1293	if (i >= MAX_ANIMATIONS \|\| i < 0) {
1646	palkovsky	1294	retval = EINVAL;
		1295	break;
		1296	}
		1297	animations[i].initialized = 0;
		1298	break;
		1299	case FB_ANIM_ADDPIXMAP:
		1300	i = IPC_GET_ARG1(*call);
2025	jermar	1301	if (i >= MAX_ANIMATIONS \|\| i < 0 \|\|
		1302	!animations[i].initialized) {
1646	palkovsky	1303	retval = EINVAL;
		1304	break;
		1305	}
		1306	if (animations[i].animlen == MAX_ANIM_LEN) {
		1307	retval = ELIMIT;
		1308	break;
		1309	}
		1310	newval = IPC_GET_ARG2(*call);
2025	jermar	1311	if (newval < 0 \|\| newval > MAX_PIXMAPS \|\|
		1312	!pixmaps[newval].data) {
1646	palkovsky	1313	retval = EINVAL;
		1314	break;
		1315	}
		1316	animations[i].pixmaps[animations[i].animlen++] = newval;
		1317	break;
		1318	case FB_ANIM_CHGVP:
		1319	i = IPC_GET_ARG1(*call);
		1320	if (i >= MAX_ANIMATIONS \|\| i < 0) {
		1321	retval = EINVAL;
		1322	break;
		1323	}
		1324	nvp = IPC_GET_ARG2(*call);
		1325	if (nvp == -1)
		1326	nvp = vp;
2025	jermar	1327	if (nvp >= MAX_VIEWPORTS \|\| nvp < 0 \|\|
		1328	!viewports[nvp].initialized) {
1646	palkovsky	1329	retval = EINVAL;
		1330	break;
		1331	}
		1332	animations[i].vp = nvp;
		1333	break;
		1334	case FB_ANIM_START:
		1335	case FB_ANIM_STOP:
		1336	i = IPC_GET_ARG1(*call);
		1337	if (i >= MAX_ANIMATIONS \|\| i < 0) {
		1338	retval = EINVAL;
		1339	break;
		1340	}
		1341	newval = (IPC_GET_METHOD(*call) == FB_ANIM_START);
		1342	if (newval ^ animations[i].enabled) {
		1343	animations[i].enabled = newval;
		1344	anims_enabled += newval ? 1 : -1;
		1345	}
		1346	break;
		1347	default:
		1348	handled = 0;
		1349	}
		1350	if (handled)
2619	jermar	1351	ipc_answer_0(callid, retval);
1646	palkovsky	1352	return handled;
		1353	}
		1354
3707	decky	1355
		1356	/** Handler for messages concerning pixmap handling
		1357	*
		1358	*/
		1359	static int pixmap_handle(ipc_callid_t callid, ipc_call_t *call, int vp)
1552	palkovsky	1360	{
3707	decky	1361	bool handled = true;
		1362	int retval = EOK;
		1363	int i, nvp;
		1364
1552	palkovsky	1365	switch (IPC_GET_METHOD(*call)) {
		1366	case FB_VP_DRAW_PIXMAP:
		1367	nvp = IPC_GET_ARG1(*call);
		1368	if (nvp == -1)
		1369	nvp = vp;
2025	jermar	1370	if (nvp < 0 \|\| nvp >= MAX_VIEWPORTS \|\|
		1371	!viewports[nvp].initialized) {
1552	palkovsky	1372	retval = EINVAL;
		1373	break;
		1374	}
		1375	i = IPC_GET_ARG2(*call);
		1376	retval = draw_pixmap(nvp, i);
		1377	break;
		1378	case FB_VP2PIXMAP:
		1379	nvp = IPC_GET_ARG1(*call);
		1380	if (nvp == -1)
		1381	nvp = vp;
2025	jermar	1382	if (nvp < 0 \|\| nvp >= MAX_VIEWPORTS \|\|
		1383	!viewports[nvp].initialized)
1552	palkovsky	1384	retval = EINVAL;
		1385	else
1711	palkovsky	1386	retval = save_vp_to_pixmap(&viewports[nvp]);
1552	palkovsky	1387	break;
		1388	case FB_DROP_PIXMAP:
		1389	i = IPC_GET_ARG1(*call);
		1390	if (i >= MAX_PIXMAPS) {
		1391	retval = EINVAL;
		1392	break;
		1393	}
		1394	if (pixmaps[i].data) {
		1395	free(pixmaps[i].data);
		1396	pixmaps[i].data = NULL;
		1397	}
		1398	break;
		1399	default:
		1400	handled = 0;
		1401	}
3707	decky	1402
1552	palkovsky	1403	if (handled)
2619	jermar	1404	ipc_answer_0(callid, retval);
1552	palkovsky	1405	return handled;
		1406
		1407	}
		1408
3767	svoboda	1409	static int rgb_from_style(attr_rgb_t *rgb, int style)
		1410	{
		1411	switch (style) {
		1412	case STYLE_NORMAL:
		1413	rgb->fg_color = color_table[COLOR_BLACK];
		1414	rgb->bg_color = color_table[COLOR_WHITE];
		1415	break;
		1416	case STYLE_EMPHASIS:
		1417	rgb->fg_color = color_table[COLOR_RED];
		1418	rgb->bg_color = color_table[COLOR_WHITE];
		1419	break;
		1420	default:
		1421	return EINVAL;
		1422	}
		1423
		1424	return EOK;
		1425	}
		1426
		1427	static int rgb_from_idx(attr_rgb_t *rgb, ipcarg_t fg_color,
		1428	ipcarg_t bg_color, ipcarg_t flags)
		1429	{
		1430	fg_color = (fg_color & 7) \| ((flags & CATTR_BRIGHT) ? 8 : 0);
		1431	bg_color = (bg_color & 7) \| ((flags & CATTR_BRIGHT) ? 8 : 0);
		1432
		1433	rgb->fg_color = color_table[fg_color];
		1434	rgb->bg_color = color_table[bg_color];
		1435
		1436	return EOK;
		1437	}
		1438
3792	svoboda	1439	static int rgb_from_attr(attr_rgb_t rgb, const attrs_t a)
		1440	{
		1441	int rc;
		1442
		1443	switch (a->t) {
		1444	case at_style:
		1445	rc = rgb_from_style(rgb, a->a.s.style);
		1446	break;
		1447	case at_idx:
		1448	rc = rgb_from_idx(rgb, a->a.i.fg_color,
		1449	a->a.i.bg_color, a->a.i.flags);
		1450	break;
		1451	case at_rgb:
		1452	*rgb = a->a.r;
		1453	rc = EOK;
		1454	break;
		1455	}
		1456
		1457	return rc;
		1458	}
		1459
3767	svoboda	1460	static int fb_set_style(viewport_t *vport, ipcarg_t style)
		1461	{
		1462	return rgb_from_style(&vport->attr, (int) style);
		1463	}
		1464
		1465	static int fb_set_color(viewport_t *vport, ipcarg_t fg_color,
		1466	ipcarg_t bg_color, ipcarg_t flags)
		1467	{
		1468	return rgb_from_idx(&vport->attr, fg_color, bg_color, flags);
		1469	}
		1470
1498	palkovsky	1471	/** Function for handling connections to FB
		1472	*
		1473	*/
3707	decky	1474	static void fb_client_connection(ipc_callid_t iid, ipc_call_t *icall)
1363	vana	1475	{
3707	decky	1476	unsigned int vp = 0;
		1477	viewport_t *vport = &viewports[vp];
		1478
1485	palkovsky	1479	if (client_connected) {
2619	jermar	1480	ipc_answer_0(iid, ELIMIT);
1485	palkovsky	1481	return;
		1482	}
3707	decky	1483
		1484	/* Accept connection */
		1485	client_connected = true;
		1486	ipc_answer_0(iid, EOK);
		1487
		1488	while (true) {
		1489	ipc_callid_t callid;
		1490	ipc_call_t call;
		1491	int retval;
		1492	unsigned int i;
		1493	int scroll;
		1494	uint8_t glyph;
		1495	unsigned int row, col;
		1496
		1497	if ((vport->cursor_active) \|\| (anims_enabled))
2070	jermar	1498	callid = async_get_call_timeout(&call, 250000);
1640	palkovsky	1499	else
		1500	callid = async_get_call(&call);
3707	decky	1501
1713	palkovsky	1502	mouse_hide();
1500	palkovsky	1503	if (!callid) {
1673	palkovsky	1504	cursor_blink(vport);
1646	palkovsky	1505	anims_tick();
1723	palkovsky	1506	mouse_show();
1500	palkovsky	1507	continue;
		1508	}
3707	decky	1509
1547	palkovsky	1510	if (shm_handle(callid, &call, vp))
		1511	continue;
3707	decky	1512
1552	palkovsky	1513	if (pixmap_handle(callid, &call, vp))
		1514	continue;
3707	decky	1515
1646	palkovsky	1516	if (anim_handle(callid, &call, vp))
		1517	continue;
3707	decky	1518
		1519	switch (IPC_GET_METHOD(call)) {
1485	palkovsky	1520	case IPC_M_PHONE_HUNGUP:
3707	decky	1521	client_connected = false;
		1522
		1523	/* Cleanup other viewports */
2025	jermar	1524	for (i = 1; i < MAX_VIEWPORTS; i++)
3707	decky	1525	vport->initialized = false;
		1526
		1527	/* Exit thread */
		1528	return;
		1529
1485	palkovsky	1530	case FB_PUTCHAR:
3707	decky	1531	glyph = IPC_GET_ARG1(call);
1485	palkovsky	1532	row = IPC_GET_ARG2(call);
		1533	col = IPC_GET_ARG3(call);
3707	decky	1534
		1535	if ((col >= vport->cols) \|\| (row >= vport->rows)) {
1485	palkovsky	1536	retval = EINVAL;
		1537	break;
		1538	}
2619	jermar	1539	ipc_answer_0(callid, EOK);
3707	decky	1540
		1541	draw_char(vport, glyph, col, row);
		1542
		1543	/* Message already answered */
		1544	continue;
1485	palkovsky	1545	case FB_CLEAR:
3707	decky	1546	vport_clear(vport);
		1547	cursor_show(vport);
		1548	retval = EOK;
1485	palkovsky	1549	break;
3707	decky	1550	case FB_CURSOR_GOTO:
1486	palkovsky	1551	row = IPC_GET_ARG1(call);
		1552	col = IPC_GET_ARG2(call);
3707	decky	1553
		1554	if ((col >= vport->cols) \|\| (row >= vport->rows)) {
1486	palkovsky	1555	retval = EINVAL;
		1556	break;
		1557	}
3707	decky	1558	retval = EOK;
		1559
1673	palkovsky	1560	cursor_hide(vport);
1486	palkovsky	1561	vport->cur_col = col;
		1562	vport->cur_row = row;
3707	decky	1563	cursor_show(vport);
		1564	break;
1486	palkovsky	1565	case FB_CURSOR_VISIBILITY:
1673	palkovsky	1566	cursor_hide(vport);
1500	palkovsky	1567	vport->cursor_active = IPC_GET_ARG1(call);
3707	decky	1568	cursor_show(vport);
		1569	retval = EOK;
1486	palkovsky	1570	break;
1485	palkovsky	1571	case FB_GET_CSIZE:
2619	jermar	1572	ipc_answer_2(callid, EOK, vport->rows, vport->cols);
1485	palkovsky	1573	continue;
1486	palkovsky	1574	case FB_SCROLL:
3707	decky	1575	scroll = IPC_GET_ARG1(call);
		1576	if ((scroll > (int) vport->rows) \|\| (scroll < (-(int) vport->rows))) {
1486	palkovsky	1577	retval = EINVAL;
		1578	break;
		1579	}
1673	palkovsky	1580	cursor_hide(vport);
3707	decky	1581	vport_scroll(vport, scroll);
		1582	cursor_show(vport);
		1583	retval = EOK;
1486	palkovsky	1584	break;
		1585	case FB_VIEWPORT_SWITCH:
		1586	i = IPC_GET_ARG1(call);
3707	decky	1587	if (i >= MAX_VIEWPORTS) {
1486	palkovsky	1588	retval = EINVAL;
		1589	break;
		1590	}
3707	decky	1591	if (!viewports[i].initialized) {
1486	palkovsky	1592	retval = EADDRNOTAVAIL;
		1593	break;
		1594	}
1673	palkovsky	1595	cursor_hide(vport);
1486	palkovsky	1596	vp = i;
		1597	vport = &viewports[vp];
3707	decky	1598	cursor_show(vport);
		1599	retval = EOK;
1486	palkovsky	1600	break;
		1601	case FB_VIEWPORT_CREATE:
3707	decky	1602	retval = vport_create(IPC_GET_ARG1(call) >> 16,
2619	jermar	1603	IPC_GET_ARG1(call) & 0xffff,
		1604	IPC_GET_ARG2(call) >> 16,
		1605	IPC_GET_ARG2(call) & 0xffff);
1486	palkovsky	1606	break;
		1607	case FB_VIEWPORT_DELETE:
		1608	i = IPC_GET_ARG1(call);
3707	decky	1609	if (i >= MAX_VIEWPORTS) {
1486	palkovsky	1610	retval = EINVAL;
		1611	break;
		1612	}
3707	decky	1613	if (!viewports[i].initialized) {
1486	palkovsky	1614	retval = EADDRNOTAVAIL;
		1615	break;
		1616	}
3707	decky	1617	viewports[i].initialized = false;
		1618	if (viewports[i].glyphs)
		1619	free(viewports[i].glyphs);
		1620	if (viewports[i].bgpixel)
		1621	free(viewports[i].bgpixel);
		1622	if (viewports[i].backbuf)
		1623	free(viewports[i].backbuf);
		1624	retval = EOK;
1486	palkovsky	1625	break;
		1626	case FB_SET_STYLE:
3767	svoboda	1627	retval = fb_set_style(vport, IPC_GET_ARG1(call));
		1628	break;
		1629	case FB_SET_COLOR:
		1630	retval = fb_set_color(vport, IPC_GET_ARG1(call),
		1631	IPC_GET_ARG2(call), IPC_GET_ARG3(call));
		1632	break;
		1633	case FB_SET_RGB_COLOR:
		1634	vport->attr.fg_color = IPC_GET_ARG1(call);
		1635	vport->attr.bg_color = IPC_GET_ARG2(call);
3707	decky	1636	retval = EOK;
1486	palkovsky	1637	break;
		1638	case FB_GET_RESOLUTION:
2619	jermar	1639	ipc_answer_2(callid, EOK, screen.xres, screen.yres);
1486	palkovsky	1640	continue;
1707	palkovsky	1641	case FB_POINTER_MOVE:
3707	decky	1642	pointer_enabled = true;
1711	palkovsky	1643	mouse_move(IPC_GET_ARG1(call), IPC_GET_ARG2(call));
3707	decky	1644	retval = EOK;
1707	palkovsky	1645	break;
1485	palkovsky	1646	default:
		1647	retval = ENOENT;
		1648	}
2619	jermar	1649	ipc_answer_0(callid, retval);
1363	vana	1650	}
1485	palkovsky	1651	}
1363	vana	1652
3707	decky	1653	/** Initialization of framebuffer
		1654	*
		1655	*/
		1656	int fb_init(void)
1485	palkovsky	1657	{
1490	palkovsky	1658	async_set_client_connection(fb_client_connection);
1485	palkovsky	1659
3707	decky	1660	void fb_ph_addr = (void ) sysinfo_value("fb.address.physical");
		1661	unsigned int fb_offset = sysinfo_value("fb.offset");
		1662	unsigned int fb_width = sysinfo_value("fb.width");
		1663	unsigned int fb_height = sysinfo_value("fb.height");
		1664	unsigned int fb_scanline = sysinfo_value("fb.scanline");
		1665	unsigned int fb_visual = sysinfo_value("fb.visual");
		1666
		1667	unsigned int fbsize = fb_scanline * fb_height;
		1668	void *fb_addr = as_get_mappable_page(fbsize);
		1669
		1670	physmem_map(fb_ph_addr + fb_offset, fb_addr,
		1671	ALIGN_UP(fbsize, PAGE_SIZE) >> PAGE_WIDTH, AS_AREA_READ \| AS_AREA_WRITE);
		1672
		1673	if (screen_init(fb_addr, fb_width, fb_height, fb_scanline, fb_visual))
1993	decky	1674	return 0;
		1675
		1676	return -1;
1363	vana	1677	}
1490	palkovsky	1678
3707	decky	1679	/**
1649	cejka	1680	* @}
		1681	*/

Subversion Repositories HelenOS

(root)/trunk/uspace/srv/fb/fb.c @ 4685 – Rev 3792