169 lines
3.4 KiB
C
169 lines
3.4 KiB
C
// Copyright 2008-2009 Segher Boessenkool <segher@kernel.crashing.org>
|
|
// Copyright 2003-2004 Felix Domke <tmbinc@elitedvb.net>
|
|
// This code is licensed to you under the terms of the GNU GPL, version 2;
|
|
// see file COPYING or http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt
|
|
|
|
#include "loader.h"
|
|
|
|
extern u8 console_font_10x16x4[];
|
|
|
|
#define FONT_XSIZE 10
|
|
#define FONT_YSIZE 16
|
|
#define FONT_XGAP 0
|
|
#define FONT_YGAP 2
|
|
|
|
static struct {
|
|
u32 xres, yres, stride;
|
|
|
|
u32 cursor_x, cursor_y;
|
|
|
|
u32 border_left, border_right, border_top, border_bottom;
|
|
} fb;
|
|
|
|
static void fb_write(u32 offset, u32 x)
|
|
{
|
|
// write32(0x00f00000 + offset, x);
|
|
u32 *p = (u32 *)(0x80f00000 + offset);
|
|
*p = x;
|
|
sync_after_write(p, 4);
|
|
}
|
|
|
|
static u32 fb_read(u32 offset)
|
|
{
|
|
// return read32(0x00f00000 + offset);
|
|
u32 *p = (u32 *)(0x80f00000 + offset);
|
|
|
|
return *p;
|
|
}
|
|
|
|
static void fb_clear_lines(u32 top, u32 lines)
|
|
{
|
|
u32 x, y;
|
|
u32 offset;
|
|
|
|
offset = fb.stride * top;
|
|
|
|
for (y = 0; y < lines; y++) {
|
|
for (x = 0; x < fb.xres/2; x++)
|
|
fb_write(offset + 4*x, 0x00800080);
|
|
|
|
offset += fb.stride;
|
|
}
|
|
}
|
|
|
|
static void fb_scroll_line(void)
|
|
{
|
|
u32 x, y;
|
|
u32 offset, delta;
|
|
u32 lines = FONT_YSIZE + FONT_YGAP;
|
|
|
|
offset = fb.stride * fb.border_top;
|
|
delta = fb.stride * lines;
|
|
|
|
for (y = fb.border_top; y < fb.yres - lines; y++) {
|
|
for (x = 0; x < fb.xres/2; x++)
|
|
fb_write(offset + 4*x, fb_read(offset + 4*x + delta));
|
|
|
|
offset += fb.stride;
|
|
}
|
|
|
|
fb_clear_lines(fb.yres - lines, lines);
|
|
|
|
fb.cursor_y -= lines;
|
|
}
|
|
|
|
static void fb_drawc(u32 x, u32 y, u8 c)
|
|
{
|
|
if (c < 0x20 || c > 0x7f)
|
|
c = 0x7f;
|
|
c -= 0x20;
|
|
|
|
u32 offset = fb.stride*y + 2*x;
|
|
u8 *font = &console_font_10x16x4[c * FONT_XSIZE * FONT_YSIZE / 2];
|
|
|
|
u32 ax, ay;
|
|
for (ay = 0; ay < FONT_YSIZE; ay++) {
|
|
for (ax = 0; ax < FONT_XSIZE / 2; ax++) {
|
|
u8 bits = *font++;
|
|
u32 nybh = bits & 0xf0;
|
|
u32 nybl = bits & 0x0f;
|
|
u32 q = 0x00800080;
|
|
q |= (nybh << 24) | (nybh << 20);
|
|
q |= (nybl << 12) | (nybl << 8);
|
|
fb_write(offset + 4*ax, q);
|
|
}
|
|
offset += fb.stride;
|
|
}
|
|
}
|
|
|
|
void fb_putc(char c)
|
|
{
|
|
switch (c) {
|
|
case '\n':
|
|
fb.cursor_y += FONT_YSIZE + FONT_YGAP;
|
|
|
|
case '\r':
|
|
fb.cursor_x = fb.border_left;
|
|
break;
|
|
|
|
default:
|
|
fb_drawc(fb.cursor_x, fb.cursor_y, c);
|
|
fb.cursor_x += FONT_XSIZE + FONT_XGAP;
|
|
if ((fb.cursor_x + FONT_XSIZE) > fb.border_right) {
|
|
fb.cursor_y += FONT_YSIZE + FONT_YGAP;
|
|
fb.cursor_x = fb.border_left;
|
|
}
|
|
}
|
|
|
|
if (fb.cursor_y + FONT_YSIZE >= fb.border_bottom)
|
|
fb_scroll_line();
|
|
}
|
|
|
|
|
|
static void fb_init(u32 xres, u32 yres, u32 stride)
|
|
{
|
|
fb.xres = xres;
|
|
fb.yres = yres;
|
|
fb.stride = stride;
|
|
|
|
fb.border_left = 30;
|
|
fb.border_top = 30;
|
|
fb.border_right = fb.xres - 30;
|
|
fb.border_bottom = fb.yres - 30;
|
|
|
|
fb.cursor_x = fb.border_left;
|
|
fb.cursor_y = fb.border_top;
|
|
|
|
fb_clear_lines(0, fb.yres);
|
|
}
|
|
|
|
void video_init(void)
|
|
{
|
|
// read VTR register to determine linecount and mode
|
|
u32 vtr = read16(0x0c002000);
|
|
u32 lines = vtr >> 4;
|
|
|
|
if ((vtr & 0x0f) > 10) { // progressive
|
|
// set framebuffer position
|
|
write32(0x0c00201c, 0x00f00000);
|
|
write32(0x0c002024, 0x00f00000);
|
|
} else { //interlaced
|
|
lines *= 2;
|
|
|
|
u32 vto = read32(0x0c00200c);
|
|
u32 vte = read32(0x0c002010);
|
|
|
|
// set framebuffer position
|
|
// try to figure out the interlacing order
|
|
if ((vto & 0x03ff) < (vte & 0x03ff)) {
|
|
write32(0x0c00201c, 0x00f00000);
|
|
write32(0x0c002024, 0x00f00000 + 2*640);
|
|
} else {
|
|
write32(0x0c00201c, 0x00f00000 + 2*640);
|
|
write32(0x0c002024, 0x00f00000);
|
|
}
|
|
}
|
|
|
|
fb_init(640, lines, 2*640);
|
|
}
|