u-boot/arch/x86/lib/video.c
Simon Glass 709ea543b9 stdio: Pass device pointer to stdio methods
At present stdio device functions do not get any clue as to which stdio
device is being acted on. Some implementations go to great lengths to work
around this, such as defining a whole separate set of functions for each
possible device.

For driver model we need to associate a stdio_dev with a device. It doesn't
seem possible to continue with this work-around approach.

Instead, add a stdio_dev pointer to each of the stdio member functions.

Note: The serial drivers have the same problem, but it is not strictly
necessary to fix that to get driver model running. Also, if we convert
serial over to driver model the problem will go away.

Code size increases by 244 bytes for Thumb2 and 428 for PowerPC.

22: stdio: Pass device pointer to stdio methods
       arm: (for 2/2 boards)  all +244.0  bss -4.0  text +248.0
   powerpc: (for 1/1 boards)  all +428.0  text +428.0

Signed-off-by: Simon Glass <sjg@chromium.org>
Acked-by: Marek Vasut <marex@denx.de>
Reviewed-by: Marek Vasut <marex@denx.de>
2014-07-23 14:07:23 +01:00

205 lines
3.7 KiB
C

/*
* (C) Copyright 2002
* Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
*
* SPDX-License-Identifier: GPL-2.0+
*/
#include <common.h>
#include <pci.h>
#include <stdio_dev.h>
#include <i8042.h>
#include <asm/ptrace.h>
#include <asm/io.h>
#include <asm/pci.h>
/* basic textmode I/O from linux kernel */
static char *vidmem = (char *)0xb8000;
static int vidport;
static int lines, cols;
static int orig_x, orig_y;
static void beep(int dur)
{
int i;
outb_p(3, 0x61);
for (i = 0; i < 10*dur; i++)
udelay(1000);
outb_p(0, 0x61);
}
static void scroll(void)
{
int i;
memcpy(vidmem, vidmem + cols * 2, (lines - 1) * cols * 2);
for (i = (lines - 1) * cols * 2; i < lines * cols * 2; i += 2)
vidmem[i] = ' ';
}
static void __video_putc(const char c, int *x, int *y)
{
if (c == '\n') {
(*x) = 0;
if (++(*y) >= lines) {
scroll();
(*y)--;
}
} else if (c == '\b') {
if ((*x) != 0) {
--(*x);
vidmem[((*x) + cols * (*y)) * 2] = ' ';
}
} else if (c == '\r') {
(*x) = 0;
} else if (c == '\a') {
beep(3);
} else if (c == '\t') {
__video_putc(' ', x, y);
__video_putc(' ', x, y);
__video_putc(' ', x, y);
__video_putc(' ', x, y);
__video_putc(' ', x, y);
__video_putc(' ', x, y);
__video_putc(' ', x, y);
__video_putc(' ', x, y);
} else if (c == '\v') {
switch ((*x) % 8) {
case 0:
__video_putc(' ', x, y);
case 7:
__video_putc(' ', x, y);
case 6:
__video_putc(' ', x, y);
case 5:
__video_putc(' ', x, y);
case 4:
__video_putc(' ', x, y);
case 3:
__video_putc(' ', x, y);
case 2:
__video_putc(' ', x, y);
case 1:
__video_putc(' ', x, y);
}
} else if (c == '\f') {
int i;
for (i = 0; i < lines * cols * 2; i += 2)
vidmem[i] = 0;
(*x) = 0;
(*y) = 0;
} else {
vidmem[((*x) + cols * (*y)) * 2] = c;
if (++(*x) >= cols) {
(*x) = 0;
if (++(*y) >= lines) {
scroll();
(*y)--;
}
}
}
}
static void video_putc(struct stdio_dev *dev, const char c)
{
int x, y, pos;
x = orig_x;
y = orig_y;
__video_putc(c, &x, &y);
orig_x = x;
orig_y = y;
pos = (x + cols * y) * 2; /* Update cursor position */
outb_p(14, vidport);
outb_p(0xff & (pos >> 9), vidport+1);
outb_p(15, vidport);
outb_p(0xff & (pos >> 1), vidport+1);
}
static void video_puts(struct stdio_dev *dev, const char *s)
{
int x, y, pos;
char c;
x = orig_x;
y = orig_y;
while ((c = *s++) != '\0')
__video_putc(c, &x, &y);
orig_x = x;
orig_y = y;
pos = (x + cols * y) * 2; /* Update cursor position */
outb_p(14, vidport);
outb_p(0xff & (pos >> 9), vidport+1);
outb_p(15, vidport);
outb_p(0xff & (pos >> 1), vidport+1);
}
int video_init(void)
{
u16 pos;
static struct stdio_dev vga_dev;
static struct stdio_dev kbd_dev;
vidmem = (char *) 0xb8000;
vidport = 0x3d4;
lines = 25;
cols = 80;
outb_p(14, vidport);
pos = inb_p(vidport+1);
pos <<= 8;
outb_p(15, vidport);
pos |= inb_p(vidport+1);
orig_x = pos%cols;
orig_y = pos/cols;
#if 0
printf("pos %x %d %d\n", pos, orig_x, orig_y);
#endif
if (orig_y > lines)
orig_x = orig_y = 0;
memset(&vga_dev, 0, sizeof(vga_dev));
strcpy(vga_dev.name, "vga");
vga_dev.ext = 0;
vga_dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_SYSTEM;
vga_dev.putc = video_putc; /* 'putc' function */
vga_dev.puts = video_puts; /* 'puts' function */
if (stdio_register(&vga_dev) == 0)
return 1;
if (i8042_kbd_init())
return 1;
memset(&kbd_dev, 0, sizeof(kbd_dev));
strcpy(kbd_dev.name, "kbd");
kbd_dev.ext = 0;
kbd_dev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
kbd_dev.tstc = i8042_tstc; /* 'tstc' function */
kbd_dev.getc = i8042_getc; /* 'getc' function */
if (stdio_register(&kbd_dev) == 0)
return 1;
return 0;
}
int drv_video_init(void)
{
return video_init();
}