226 lines
5.4 KiB
C
226 lines
5.4 KiB
C
/*
|
|
* Copyright (c) 2000, 2001, 2002, 2003, 2004, 2005, 2008, 2009
|
|
* The President and Fellows of Harvard College.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. Neither the name of the University nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE UNIVERSITY AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE UNIVERSITY OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* Driver for full-screen console.
|
|
*
|
|
* As of this writing the full-screen console is not supported in
|
|
* System/161, so this driver is untested and probably broken.
|
|
*/
|
|
#include <types.h>
|
|
#include <lib.h>
|
|
#include <spinlock.h>
|
|
#include <platform/bus.h>
|
|
#include <lamebus/lscreen.h>
|
|
#include "autoconf.h"
|
|
|
|
/* Registers (offsets within slot) */
|
|
#define LSCR_REG_POSN 0 /* Cursor position */
|
|
#define LSCR_REG_SIZE 4 /* Display size */
|
|
#define LSCR_REG_CHAR 8 /* Character in */
|
|
#define LSCR_REG_RIRQ 12 /* Read interrupt status */
|
|
|
|
/* Bits in the IRQ registers */
|
|
#define LSCR_IRQ_ENABLE 1
|
|
#define LSCR_IRQ_ACTIVE 2
|
|
|
|
/* Offset within slot of screen buffer */
|
|
#define LSCR_SCREEN 32768
|
|
|
|
/* Convert a 32-bit X/Y pair to X and Y coordinates. */
|
|
static
|
|
inline
|
|
void
|
|
splitxy(uint32_t xy, unsigned *x, unsigned *y)
|
|
{
|
|
*x = xy >> 16;
|
|
*y = xy & 0xffff;
|
|
}
|
|
|
|
/* Convert X and Y coordinates to a single 32-bit value. */
|
|
static
|
|
inline
|
|
uint32_t
|
|
mergexy(unsigned x, unsigned y)
|
|
{
|
|
uint32_t val = x;
|
|
|
|
return (val << 16) | y;
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////
|
|
|
|
/*
|
|
* Interrupt handler.
|
|
*/
|
|
void
|
|
lscreen_irq(void *vsc)
|
|
{
|
|
struct lscreen_softc *sc = vsc;
|
|
uint32_t ch, x;
|
|
|
|
spinlock_acquire(&sc->ls_lock);
|
|
|
|
x = bus_read_register(sc->ls_busdata, sc->ls_buspos, LSCR_REG_RIRQ);
|
|
if (x & LSCR_IRQ_ACTIVE) {
|
|
ch = bus_read_register(sc->ls_busdata, sc->ls_buspos,
|
|
LSCR_REG_CHAR);
|
|
bus_write_register(sc->ls_busdata, sc->ls_buspos,
|
|
LSCR_REG_RIRQ, LSCR_IRQ_ENABLE);
|
|
|
|
spinlock_release(&sc->ls_lock);
|
|
if (sc->ls_input) {
|
|
sc->ls_input(sc->ls_devdata, ch);
|
|
}
|
|
}
|
|
else {
|
|
spinlock_release(&sc->ls_lock);
|
|
}
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////
|
|
|
|
/*
|
|
* Handle a newline on the screen.
|
|
*/
|
|
static
|
|
void
|
|
lscreen_newline(struct lscreen_softc *sc)
|
|
{
|
|
if (sc->ls_cy >= sc->ls_height-1) {
|
|
/*
|
|
* Scroll
|
|
*/
|
|
|
|
memmove(sc->ls_screen, sc->ls_screen + sc->ls_width,
|
|
sc->ls_width * (sc->ls_height-1));
|
|
bzero(sc->ls_screen + sc->ls_width * (sc->ls_height-1),
|
|
sc->ls_width);
|
|
}
|
|
else {
|
|
sc->ls_cy++;
|
|
}
|
|
sc->ls_cx=0;
|
|
}
|
|
|
|
/*
|
|
* Handle a printable character being written to the screen.
|
|
*/
|
|
static
|
|
void
|
|
lscreen_char(struct lscreen_softc *sc, int ch)
|
|
{
|
|
if (sc->ls_cx >= sc->ls_width) {
|
|
lscreen_newline(sc);
|
|
}
|
|
|
|
sc->ls_screen[sc->ls_cy*sc->ls_width + sc->ls_cx] = ch;
|
|
sc->ls_cx++;
|
|
}
|
|
|
|
/*
|
|
* Send a character to the screen.
|
|
* This should probably know about backspace and tab.
|
|
*/
|
|
void
|
|
lscreen_write(void *vsc, int ch)
|
|
{
|
|
struct lscreen_softc *sc = vsc;
|
|
int ccx, ccy;
|
|
|
|
spinlock_acquire(&sc->ls_lock);
|
|
|
|
switch (ch) {
|
|
case '\n': lscreen_newline(sc); break;
|
|
default: lscreen_char(sc, ch); break;
|
|
}
|
|
|
|
/*
|
|
* ccx/ccy = corrected cursor position
|
|
* (The cursor marks the next space text will appear in. But
|
|
* at the very end of the line, it should not move off the edge.)
|
|
*/
|
|
ccx = sc->ls_cx;
|
|
ccy = sc->ls_cy;
|
|
if (ccx==sc->ls_width) {
|
|
ccx--;
|
|
}
|
|
|
|
/* Set the cursor position */
|
|
bus_write_register(sc->ls_busdata, sc->ls_buspos,
|
|
LSCR_REG_POSN, mergexy(ccx, ccy));
|
|
|
|
spinlock_release(&sc->ls_lock);
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////
|
|
|
|
/*
|
|
* Setup routine called by autoconf.c when an lscreen is found.
|
|
*/
|
|
int
|
|
config_lscreen(struct lscreen_softc *sc, int lscreenno)
|
|
{
|
|
uint32_t val;
|
|
|
|
(void)lscreenno;
|
|
|
|
spinlock_init(&sc->ls_lock);
|
|
|
|
/*
|
|
* Enable interrupting.
|
|
*/
|
|
|
|
bus_write_register(sc->ls_busdata, sc->ls_buspos,
|
|
LSCR_REG_RIRQ, LSCR_IRQ_ENABLE);
|
|
|
|
/*
|
|
* Get screen size.
|
|
*/
|
|
val = bus_read_register(sc->ls_busdata, sc->ls_buspos,
|
|
LSCR_REG_SIZE);
|
|
splitxy(val, &sc->ls_width, &sc->ls_height);
|
|
|
|
/*
|
|
* Get cursor position.
|
|
*/
|
|
val = bus_read_register(sc->ls_busdata, sc->ls_buspos,
|
|
LSCR_REG_POSN);
|
|
splitxy(val, &sc->ls_cx, &sc->ls_cy);
|
|
|
|
/*
|
|
* Get a pointer to the memory-mapped screen area.
|
|
*/
|
|
sc->ls_screen = bus_map_area(sc->ls_busdata, sc->ls_buspos,
|
|
LSCR_SCREEN);
|
|
|
|
return 0;
|
|
}
|
|
|