Subversion Repositories HelenOS

/*

 * Copyright (c) 2006 Ondrej Palkovsky

 * Copyright (c) 2008 Martin Decky

 * Copyright (c) 2008 Pavel Rimsky

 * All rights reserved.

 *

 * Redistribution and use in source and binary forms, with or without

 * modification, are permitted provided that the following conditions

 * are met:

 *

 * - Redistributions of source code must retain the above copyright

 *   notice, this list of conditions and the following disclaimer.

 * - Redistributions in binary form must reproduce the above copyright

 *   notice, this list of conditions and the following disclaimer in the

 *   documentation and/or other materials provided with the distribution.

 * - The name of the author may not be used to endorse or promote products

 *   derived from this software without specific prior written permission.

 *

 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR

 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES

 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.

 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,

 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT

 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,

 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY

 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT

 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF

 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 */

/**

 * @defgroup serial Serial console

 * @brief    Serial console services (putc, puts, clear screen, cursor goto,...)

 * @{

 */ 

/** @file

 */

#include <stdio.h>

#include <ipc/ipc.h>

#include <async.h>

#include <ipc/fb.h>

#include <bool.h>

#include <errno.h>

#include "serial_console.h"

#define MAX_CONTROL 20

static int width;

static int height;

static putc_function_t putc_function;

/* Allow only 1 connection */

static int client_connected = 0;

void serial_puts(char *str)

{

	while (*str)

		putc_function(*(str++));

}

void serial_goto(const unsigned int row, const unsigned int col)

{

	if ((row > height) || (col > width))

		return;

	char control[20];

	snprintf(control, 20, "\033[%u;%uf", row + 1, col + 1);

	serial_puts(control);

}

void serial_clrscr(void)

{

	serial_puts("\033[2J");

}

void serial_scroll(int i)

{

	if (i > 0) {

		serial_goto(height - 1, 0);

		while (i--)

			serial_puts("\033D");

	} else if (i < 0) {

		serial_goto(0, 0);

		while (i++)

			serial_puts("\033M");

	}

}

void serial_set_style(const unsigned int mode)

{

	char control[MAX_CONTROL];

	snprintf(control, MAX_CONTROL, "\033[%um", mode);

	serial_puts(control);

}

/** Set scrolling region. */

void serial_set_scroll_region(unsigned last_row)

{

	char control[MAX_CONTROL];

	snprintf(control, MAX_CONTROL, "\033[0;%ur", last_row);

	serial_puts(control);

}

void serial_cursor_disable(void)

{

	serial_puts("\033[?25l");

}

void serial_cursor_enable(void)

{

	serial_puts("\033[?25h");

}

void serial_console_init(putc_function_t putc_fn, uint32_t w, uint32_t h)

{

	width = w;

	height = h;

	putc_function = putc_fn;

}

/**

 * Main function of the thread serving client connections.

 */

void serial_client_connection(ipc_callid_t iid, ipc_call_t *icall)

{

	int retval;

	ipc_callid_t callid;

	ipc_call_t call;

	char c;

	int lastcol = 0;

	int lastrow = 0;

	int newcol;

	int newrow;

	int fgcolor;

	int bgcolor;

	int i;

	if (client_connected) {

		ipc_answer_0(iid, ELIMIT);

		return;

	}

	client_connected = 1;

	ipc_answer_0(iid, EOK);

	/* Clear the terminal, set scrolling region

	   to 0 - height rows. */

	serial_clrscr();

	serial_goto(0, 0);

	serial_set_scroll_region(height);

	while (true) {

		callid = async_get_call(&call);

		switch (IPC_GET_METHOD(call)) {

		case IPC_M_PHONE_HUNGUP:

			client_connected = 0;

			ipc_answer_0(callid, EOK);

			return;

		case FB_PUTCHAR:

			c = IPC_GET_ARG1(call);

			newrow = IPC_GET_ARG2(call);

			newcol = IPC_GET_ARG3(call);

			if ((lastcol != newcol) || (lastrow != newrow))

				serial_goto(newrow, newcol);

			lastcol = newcol + 1;

			lastrow = newrow;

			(*putc_function)(c);

			retval = 0;

			break;

		case FB_CURSOR_GOTO:

			newrow = IPC_GET_ARG1(call);

			newcol = IPC_GET_ARG2(call);

			serial_goto(newrow, newcol);

			lastrow = newrow;

			lastcol = newcol;

			retval = 0;

			break;

		case FB_GET_CSIZE:

			ipc_answer_2(callid, EOK, height, width);

			continue;

		case FB_CLEAR:

			serial_clrscr();

			retval = 0;

			break;

		case FB_SET_STYLE:

			fgcolor = IPC_GET_ARG1(call);

			bgcolor = IPC_GET_ARG2(call);

			if (fgcolor < bgcolor)

				serial_set_style(0);

			else

				serial_set_style(7);

			retval = 0;

			break;

		case FB_SCROLL:

			i = IPC_GET_ARG1(call);

			if ((i > height) || (i < -height)) {

				retval = EINVAL;

				break;

			}

			serial_scroll(i);

			serial_goto(lastrow, lastcol);

			retval = 0;

			break;

		case FB_CURSOR_VISIBILITY:

			if(IPC_GET_ARG1(call))

				serial_cursor_enable();

			else

				serial_cursor_disable();

			retval = 0;

			break;

		default:

			retval = ENOENT;

		}

		ipc_answer_0(callid, retval);

	}

}

/** 

 * @}

 */