console.c

fairysky系统,是一个小型的内核,模拟linux原始版本的

/*文件名: console.c
  说明:   控制台驱动
  作者:   marsinfan
  日期:   2005/12/05
*/

#include <asm/io.h>
#include <asm/system.h>
#include <fairysky/types.h>
#include <fairysky/tty.h>

#define MAX_CONSOLES 8
#define NPAR 16
#define RESPONSE "\033[?1;2c"

static u16 video_port_reg = 0x3d4;      /* 显卡寄存器选择端口   */
static u16 video_port_val = 0x3d5;      /* 显卡寄存器写值端口   */
static u32 video_mem_base;              /* 显卡内存开始处       */
static u32 video_mem_term;              /* 显卡内存结束处       */
static u32 video_size_row;              /* 每行占的字节数       */
static s32 can_do_color = 1;

#ifdef WINDOWS_CYGWIN
#define VIDEO_NUM_COLUMNS video_num_columns
#else
#define VIDEO_NUM_COLUMNS _video_num_columns
#endif
static u32 VIDEO_NUM_COLUMNS = 80;      /* 行字符数             */
static u32 video_num_lines = 25;        /* 每屏行数             */
static u32 x = 0;                       /* 光标的位置           */
static u32 y = 0;                       /* 光标的位置           */
static u32 show_cursor = 1;             /* 是否显示光标         */
static u32 pos;                         /* 当前字符的位置       */
static u32 origin;                      /* 窗口的起始位置       */
static u32 screen_end;
static u32 top = 0;                     /* 显示的起始行         */
static u32 bottom = 0;                  /* 显示的终止行         */
static u32 video_mem_end;
static u32 video_mem_start;
static u16 video_erase_char;
#ifdef WINDOWS_CYGWIN
#define ATTR attr
#else
#define ATTR _attr
#endif
static u8 ATTR = 0x07;                  /*字符显示属性（黑底白字）*/

static unsigned long	ques=0;
static unsigned long	npar, par[NPAR];
static u8 state = 0;
unsigned long need_wrap = 0;
char * translate;

extern void sysbeep(void);

/*
video_mem_start +----------------+
                |                |
                |                |
                |                |
          origin+----------------+
                | x,y(相对于屏幕)|
                |                |
                +----------------+screen_end
                |                |
                |                |
                |                |
                |                |
                |                |
                +----------------+video_mem_end

*/
#ifdef WINDOWS_CYGWIN
static void memcpyl(void *dest, const void *src, size_t n)
{
    int i = 0;
    for (; i < n; ++i) {
        *(long *) dest++ = *(long *) src++;
    }
}    
#endif

//设置窗口的起始位置
static void set_origin()
{
    cli();
    outb_p(12, video_port_reg);
    outb_p(0xff & ((origin - video_mem_base) >> 9), video_port_val);
    outb_p(13, video_port_reg);
    outb_p(0xff & ((origin - video_mem_base) >> 1), video_port_val);
    sti();
}

//隐藏光标
static inline void hide_cursor()
{
    outb_p(14, video_port_reg);
    outb_p(0xff & ((screen_end - video_mem_base) >> 9), video_port_val);
    outb_p(15, video_port_reg);
    outb_p(0xff & ((screen_end - video_mem_base) >> 1), video_port_val);
}

//设置光标位置
static inline void set_cursor()
{
    cli();
    if (show_cursor) {
        outb_p(14, video_port_reg);
        outb_p(0xff & ((pos - video_mem_base) >> 9), video_port_val);
        outb_p(15, video_port_reg);
        outb_p(0xff & ((pos - video_mem_base) >> 1), video_port_val);
    } else {
        hide_cursor();
    }
    sti();
}

//移动光标到x， y处，相对于屏幕
void goto_xy(int new_x, int new_y)
{
    int max_y;

    //设置x值
    if (new_x < 0) {
        x = 0;
    } else if (new_x >= VIDEO_NUM_COLUMNS) {
        x = VIDEO_NUM_COLUMNS - 1;
    } else {
        x = new_x;
    }

    if (show_cursor) {
        new_y += top;
        max_y = bottom;
    } else {
        max_y = video_num_lines;
    }

    //设置y值
    if (new_y < 0) {
        y = 0;
    } else if (new_y >= max_y) {
        y = max_y - 1;
    } else {
        y = new_y;
    }

    pos = origin + y * video_size_row + (x << 1);
}

//屏幕向上翻一页或一行
static void screen_up(u32 atop, u32 abottom)
{
    int hardscroll = 1;

    if (abottom > video_num_lines || atop >= abottom) {
        return;
    }
    if (atop || abottom != video_num_lines) {
        hardscroll = 0;
    }
    if (hardscroll) {
        origin += video_size_row;
        pos += video_size_row;
        screen_end += video_size_row;
        if (screen_end > video_mem_end) {
//#ifdef WINDOWS_CYGWIN
//            memcpyl((void *) video_mem_start, (void *) origin,
//                    ((video_num_lines - 1) * VIDEO_NUM_COLUMNS >> 1));
            /*__asm__("cld\n\t"
                "movl _video_num_columns, %%ecx\n\t"
                "rep\n\t"
                "stosw"
                :
                :"a" (video_erase_char)     
                 );    */

//#else
            __asm__ __volatile__("cld\n\t"
                                 "rep\n\t"
                                 "movsl\n\t"
                                 "movl _video_num_columns, %1\n\t"
                                 "rep\n\t"
                                 "stosw" :
                                 :
                                 "a" (video_erase_char),
                                 "c" ((video_num_lines - 1) * VIDEO_NUM_COLUMNS >>
                                      1),
                                 "D" (video_mem_start),
            "S" (origin)
            );
//#endif    

            screen_end -= origin - video_mem_start;
            pos -= origin - video_mem_start;
            origin = video_mem_start;
        } else {
            __asm__("cld\n\t"
            "rep\n\t" "stosw"
            ::"a" (video_erase_char),
            "c" (VIDEO_NUM_COLUMNS),
            "D" (screen_end - video_size_row)
            );
        }
        set_origin();
    } else {
//#ifdef WINDOWS_CYGWIN
//        memcpyl((void *) (origin + video_size_row * atop),
//                (void *) (origin + video_size_row * (atop + 1)),
//                (abottom - atop - 1) * VIDEO_NUM_COLUMNS >> 1);
        /*         
        __asm__("cld\n\t"
            "movl _video_num_columns, %%ecx\n\t"
            "rep\n\t"
            "stosw"
            ::"a" (video_erase_char)
            );    */         
//#else        
        __asm__("cld\n\t"
                "rep\n\t"
                "movsl\n\t"
                "movl _video_num_columns, %%ecx\n\t"
                "rep\n\t"
                "stosw"
        ::"a" (video_erase_char),
        "c" ((abottom - atop - 1) * VIDEO_NUM_COLUMNS >> 1),
        "D" (origin + video_size_row * atop),
        "S" (origin + video_size_row * (atop + 1))
        );
//#endif            
    }
}

static void screen_down(void)
{
		__asm__("std\n\t"
			"rep\n\t"
			"movsl\n\t"
			"addl $2,%%edi\n\t"	/* %edi has been decremented by 4 */
			"movl _video_num_columns,%%ecx\n\t"
			"rep\n\t"
			"stosw"
			::"a" (video_erase_char),
			"c" ((bottom-top-1) * VIDEO_NUM_COLUMNS >> 1),
			"D" (origin + video_size_row * bottom - 4),
			"S" (origin + video_size_row * (bottom - 1) - 4)
			);

}

static void insert_char(void)
{
	int i=x;
	unsigned short tmp, old = video_erase_char;
	unsigned short * p = (unsigned short *) pos;

	while (i++<VIDEO_NUM_COLUMNS) {
		tmp=*p;
		*p=old;
		old=tmp;
		p++;
	}
}

static void insert_line(void)
{
	int oldtop,oldbottom;

	oldtop = top;
	oldbottom = bottom;
	top=y;
	bottom = video_num_lines;
	screen_down();
	top=oldtop;
	bottom=oldbottom;
}

static void delete_char(void)
{
	int i;
	unsigned short * p = (unsigned short *) pos;

	if (x>=VIDEO_NUM_COLUMNS)
		return;
	i = x;
	while (++i < VIDEO_NUM_COLUMNS) {
		*p = *(p+1);
		p++;
	}
	*p = video_erase_char;
}

static void delete_line(void)
{
	int oldtop,oldbottom;

	oldtop=top;
	oldbottom=bottom;
	top=y;
	bottom = video_num_lines;
	screen_up(top, bottom);
	top=oldtop;
	bottom=oldbottom;
}

static void csi_K(int par)
{
	long count __asm__("cx");
	long start __asm__("di");

	switch (par) {
		case 0:	/* erase from cursor to end of line */
			if (x >= VIDEO_NUM_COLUMNS)
				return;
			count = VIDEO_NUM_COLUMNS-x;
			start = pos;
			break;
		case 1:	/* erase from start of line to cursor */
			start = pos - (x << 1);
			count = (x < VIDEO_NUM_COLUMNS) ? x : VIDEO_NUM_COLUMNS;
			break;
		case 2: /* erase whole line */
			start = pos - (x << 1);
			count = VIDEO_NUM_COLUMNS;
			break;
		default:
			return;
	}
	__asm__("cld\n\t"
		"rep\n\t"
		"stosw\n\t"
		::"c" (count),
		"D" (start),"a" (video_erase_char)
		);
}

void csi_m(void)
{
	int i;

	for (i=0;i<=npar;i++)
		switch (par[i]) {
			case 0:ATTR=0x07;break;
			case 1:ATTR=0x0f;break;
			case 4:ATTR=0x0f;break;
			case 7:ATTR=0x70;break;
			case 27:ATTR=0x07;break;
		}
}

static void csi_J(int par)
{
	long count __asm__("cx");
	long start __asm__("di");

	switch (par) {
		case 0:	/* erase from cursor to end of display */
			count = (screen_end-pos) >> 1;
			start = pos;
			break;
		case 1:	/* erase from start to cursor */
			count = (pos - origin) >> 1;
			start = origin;
			break;
		case 2: /* erase whole display */
			count = VIDEO_NUM_COLUMNS * video_num_lines;
			start = origin;
			break;
		default:
			return;
	}
	__asm__("cld\n\t"
		"rep\n\t"
		"stosw\n\t"
		::"c" (count),
		"D" (start),"a" (video_erase_char)
		);
}


static void csi_at(unsigned int nr)
{
	if (nr > VIDEO_NUM_COLUMNS)
		nr = VIDEO_NUM_COLUMNS;
	else if (!nr)
		nr = 1;
	while (nr--)
		insert_char();
}

static void csi_L(unsigned int nr)
{
	if (nr > video_num_lines)
		nr = video_num_lines;