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>
206 lines
3.7 KiB
C
206 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();
|
|
}
|