WebSVN – HelenOS – Blame – /branches/dynload/uspace/srv/fb/fb.c

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

Subversion Repositories HelenOS

(root)/branches/dynload/uspace/srv/fb/fb.c – Rev 4338