/* * Wrap-around code for a console using the * DECstation PROM io-routines. * * Copyright (c) 1998 Harald Koerfgen */ #include #include #include #include #include #include #define NDS_CTRLBASE 0x04000000 /* Register IO base */ #define NDS_PALBASE 0x05000000 /* Pallete RAM base */ #define NDS_VIDBASE 0x06000000 /* Video RAM base */ #define NDS_DISPCNT (NDS_CTRLBASE + 0x00) /* NDS_BGnCNT */ #define NDS_BG_CNT(n) (NDS_CTRLBASE + 0x08 + 2*(n)) /* NDS_BGnHOFS */ #define NDS_BG_HOFS(n) (NDS_CTRLBASE + 0x10 + 4*(n)) /* NDS_BGnVOFS */ #define NDS_BG_VOFS(n) (NDS_CTRLBASE + 0x12 + 4*(n)) /* 16 16-colour palettes */ #define NDS_BG_COL16 (0<<7) /* 15-bit colour */ #define NDS_RGB(r,g,b) ((((b<<5)|g)<<5)|r) /* white */ #define NDS_COL_WHITE NDS_RGB(31,31,31) /* grey */ #define NDS_COL_GREY NDS_RGB(23,23,23) /* bright green */ #define NDS_COL_GREEN_L NDS_RGB( 0,31, 0) /* medium green */ #define NDS_COL_GREEN_M NDS_RGB( 0,23, 0) /* dark green */ #define NDS_COL_GREEN_D NDS_RGB( 0,15, 0) /* bright red */ #define NDS_COL_RED_L NDS_RGB(31, 0, 0) /* medium red */ #define NDS_COL_RED_M NDS_RGB(23, 0, 0) /* dark red */ #define NDS_COL_RED_D NDS_RGB(15, 0, 0) /* bright blue */ #define NDS_COL_BLUE_L NDS_RGB(0, 0, 31) /* medium blue */ #define NDS_COL_BLUE_M NDS_RGB(0, 0, 23) /* dark blue */ #define NDS_COL_BLUE_D NDS_RGB(0, 0, 15) /* black (very dark ;-) */ #define NDS_COL_BLACK NDS_RGB( 0, 0, 0) /* * Choose palette entry for character colour * Must be different from 0 (= backdrop colour) */ #define NDS_TXT_COL_IDX 1 #if NDS_TXT_COL_IDX == 0 #error NDS palette entry 0 is reserved for backdrop colour #endif #define NDS_TXT_COL0 NDS_COL_WHITE #define NDS_TXT_COL1 NDS_COL_GREEN_L #define NDS_TXT_COL2 NDS_COL_RED_L #define NDS_TXT_COL3 NDS_COL_BLUE_L #define NDS_TXT_COL4 NDS_COL_GREEN_M #define NDS_TXT_COL5 NDS_COL_RED_M #define NDS_TXT_COL6 NDS_COL_BLUE_M #define NDS_TXT_COL7 NDS_COL_GREEN_D #define NDS_TXT_COL8 NDS_COL_RED_D #define NDS_TXT_COL9 NDS_COL_BLUE_D #define NDS_TXT_COL10 NDS_COL_GREY #define NDS_TXT_COL11 NDS_COL_GREY #define NDS_TXT_COL12 NDS_COL_GREY #define NDS_TXT_COL13 NDS_COL_GREY #define NDS_TXT_COL14 NDS_COL_GREY #define NDS_TXT_COL15 NDS_COL_GREY #define NDS_TXT_COL(i) NDS_TXT_COL##i /* NDS text screen number */ #define NDS_TXT_BG 0 /* Text mode */ #define NDS_BG_MODE 0 #define NDS_BG_ACTIVE(n) (1<<(8+n)) /* Screen size 256x256 (BG0 only) */ #define NDS_SC_SIZE 0 #define NDS_TILE_OFF (0<<14) #define NDS_TILE (NDS_VIDBASE + NDS_TILE_OFF) /* 32 kB offset (configurable in units of 2 kB */ #define NDS_BGMAP_OFF (16<<11) /* add a 2 kB offset for each BG map */ #define NDS_BGMAP(n) (NDS_VIDBASE + NDS_BGMAP_OFF + (1<<11)*(n)) /* Priority = [0;3], 0=Highest */ #define NDS_BG_PRI(n) (n) /* Palette */ #define NDS_COL 16 #define NDS_BG_COL (NDS_BG_COL16) #if NDS_TXT_COL_IDX < 0 || NDS_TXT_COL_IDX > 15 #error NDS Text colour index must be in range [1;15] #endif /* Flags for DISPCNT register */ /* Activate NDS_TXT_BG */ #define NDS_DISPCNT_F (NDS_BG_MODE | NDS_BG_ACTIVE(NDS_TXT_BG)) /* Flags for NDS_BG_CNT(NDS_TXT_BG) register */ /* BG1-3 automatically use the correct offset from NDS_MAP(0) (2kB each) */ #define NDS_TXT_BG_CNT_F (NDS_BG_PRI(0) | NDS_BG_COL | ((NDS_BGMAP_OFF>>11)<<8) | NDS_SC_SIZE) /****************************************************************************/ /* * Screen dimensions. Need to allow for screen overshoot regions too. * Also keep track of current cursor postion (x,y). */ #define NDS_XORD 5 #define NDS_XMAX (1<bitmap[r]; for (b = 0; b < 8; b += 4) { *vp++ = ((bits & (0x80>>b)) ? (((unsigned short)NDS_TXT_COL_IDX)<< 0) : 0) | ((bits & (0x40>>b)) ? (((unsigned short)NDS_TXT_COL_IDX)<< 4) : 0) | ((bits & (0x20>>b)) ? (((unsigned short)NDS_TXT_COL_IDX)<< 8) : 0) | ((bits & (0x10>>b)) ? (((unsigned short)NDS_TXT_COL_IDX)<<12) : 0); } } } } } /****************************************************************************/ /* * Scroll one screen line. */ void nds_console_scroll(void) { unsigned short* vert_offset_reg = (unsigned short *) (NDS_BG_VOFS(NDS_TXT_BG)); /* scroll up 1 line, wrap around at 32 lines */ vert_offset = (vert_offset + 1) & (NDS_YMAX-1); /* 8 dots makes 1 character line */ *vert_offset_reg = vert_offset << 3; } /****************************************************************************/ void nds_console_console_putc(char c) { /* * Note that this works because the BG maps are * always aligned at a 2 kB boundary */ unsigned short *vp = (unsigned short*) (NDS_BGMAP(NDS_TXT_BG) | (((((nds_console_y + vert_offset) & (NDS_YMAX-1)) << NDS_XORD) | nds_console_x) << 1) ); unsigned int i; /* choose colour for the character */ unsigned short nds_palette = 0; /* white */ /* don't print special characters */ if (c != '\r' && c != '\n') *vp = (nds_palette << 12) | (((unsigned short)c) & 0x1ff); nds_console_x++; if ((nds_console_x >= NDS_XLEN) || (c == '\n')) { nds_console_x = 0; if (nds_console_y < NDS_YLEN - 1) { nds_console_y++; } else { /* blank out new line */ vp = (unsigned short*) (NDS_BGMAP(NDS_TXT_BG) | (((NDS_YLEN + vert_offset) & (NDS_YMAX-1)) << (NDS_XORD + 1)) ); for (i = NDS_XLEN; i; i--) *vp++ = ' '; nds_console_scroll(); } } else if (c == '\r') nds_console_x = 0; } /****************************************************************************/ extern void nds_console_write(struct console *co, const char *s, unsigned count) { unsigned i; /* * Now, do each character */ for (i = 0; i < count; i++) { nds_console_console_putc(*s++); } #ifdef CONFIG_NDS_TEXT_CONSOLE_STEP_BY_STEP /* Step-by-step mode (press A button for next line of output). * This is really ugly but really useful at times :) */ while ( (*(volatile u16*)0x04000130 & 1)); while (!(*(volatile u16*)0x04000130 & 1)); #endif } /* * Initialize the NDS screen into mode 0. That is a simple tiled * mode, nice and easy to do conventional text. */ static int __init nds_console_setup(struct console *co, char *options) { volatile unsigned short *pp; int i; /* VRAM setup */ writel(0x00010100, 0x04000000); writeb(0x81, 0x04000240); /* Enable mode 0 */ *((unsigned short *) NDS_DISPCNT) = NDS_DISPCNT_F; /*MODE0|BG0*/ /* BG0: 256 colour palette, 32kB BG Map Data */ *((unsigned short *) NDS_BG_CNT(NDS_TXT_BG)) = NDS_TXT_BG_CNT_F; /* Default palete, everything is white :-) */ pp = (volatile unsigned short *) NDS_PALBASE; for (i = 255; i; i--) pp[i] = NDS_COL_WHITE; /* text colours */ pp[16* 0 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 0); pp[16* 1 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 1); pp[16* 2 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 2); pp[16* 3 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 3); pp[16* 4 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 4); pp[16* 5 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 5); pp[16* 6 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 6); pp[16* 7 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 7); pp[16* 8 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 8); pp[16* 9 + NDS_TXT_COL_IDX] = NDS_TXT_COL( 9); pp[16*10 + NDS_TXT_COL_IDX] = NDS_TXT_COL(10); pp[16*11 + NDS_TXT_COL_IDX] = NDS_TXT_COL(11); pp[16*12 + NDS_TXT_COL_IDX] = NDS_TXT_COL(12); pp[16*13 + NDS_TXT_COL_IDX] = NDS_TXT_COL(13); pp[16*14 + NDS_TXT_COL_IDX] = NDS_TXT_COL(14); pp[16*15 + NDS_TXT_COL_IDX] = NDS_TXT_COL(15); /* backdrop colour */ pp[0] = NDS_COL_BLACK; nds_console_x = 0; nds_console_y = 0; nds_console_inittext(); return 0; } static struct console sercons = { .name = "ttyS", .write = nds_console_write, .setup = nds_console_setup, .flags = CON_PRINTBUFFER, .index = -1, }; /* * Register console. */ extern int __init nds_console_init(void) { // register_console(&sercons); nds_console_setup(NULL,NULL); return 0; } //console_initcall(nds_console_init);