577 lines
13 KiB
C
577 lines
13 KiB
C
/* $NetBSD: tx3912video.c,v 1.7 2000/01/07 15:10:50 uch Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1999, 2000, by UCHIYAMA Yasushi
|
|
* All rights reserved.
|
|
*
|
|
* 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. The name of the developer may NOT be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
|
|
*
|
|
*/
|
|
#include "opt_tx39_debug.h"
|
|
#include "fb.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
#include <sys/extent.h>
|
|
|
|
#include <machine/bus.h>
|
|
#include <machine/bootinfo.h> /* bootinfo */
|
|
|
|
#include <hpcmips/tx/tx39var.h>
|
|
#include <hpcmips/tx/tx3912videovar.h>
|
|
#include <hpcmips/tx/tx3912videoreg.h>
|
|
|
|
#if NFB > 0
|
|
#include <dev/rcons/raster.h>
|
|
#include <dev/wscons/wsdisplayvar.h>
|
|
#include <arch/hpcmips/dev/fbvar.h>
|
|
#endif
|
|
|
|
#undef TX3912VIDEO_DEBUG
|
|
|
|
void tx3912video_framebuffer_init __P((tx_chipset_tag_t, u_int32_t,
|
|
u_int32_t));
|
|
int tx3912video_framebuffer_alloc __P((tx_chipset_tag_t, u_int32_t,
|
|
int, int, int, u_int32_t*,
|
|
u_int32_t*));
|
|
void tx3912video_reset __P((tx_chipset_tag_t));
|
|
void tx3912video_resolution_init __P((tx_chipset_tag_t, int, int));
|
|
int tx3912video_fbdepth __P((tx_chipset_tag_t, int));
|
|
|
|
int tx3912video_match __P((struct device*, struct cfdata*, void*));
|
|
void tx3912video_attach __P((struct device*, struct device*, void*));
|
|
int tx3912video_print __P((void*, const char*));
|
|
|
|
struct tx3912video_chip {
|
|
u_int32_t vc_fbaddr;
|
|
u_int32_t vc_fbsize;
|
|
int vc_fbdepth;
|
|
int vc_fbwidth;
|
|
int vc_fbheight;
|
|
|
|
void (*vc_drawline) __P((int, int, int, int));
|
|
void (*vc_drawdot) __P((int, int));
|
|
};
|
|
|
|
struct tx3912video_softc {
|
|
struct device sc_dev;
|
|
|
|
struct tx3912video_chip *sc_chip;
|
|
};
|
|
|
|
struct fb_attach_args {
|
|
const char *fba_name;
|
|
};
|
|
|
|
struct cfattach tx3912video_ca = {
|
|
sizeof(struct tx3912video_softc), tx3912video_match,
|
|
tx3912video_attach
|
|
};
|
|
|
|
/* console */
|
|
struct tx3912video_chip tx3912video_chip;
|
|
|
|
void tx3912video_attach_drawfunc __P((struct tx3912video_chip*));
|
|
|
|
int
|
|
tx3912video_match(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
return 1;
|
|
}
|
|
|
|
void
|
|
tx3912video_attach(parent, self, aux)
|
|
struct device *parent;
|
|
struct device *self;
|
|
void *aux;
|
|
{
|
|
struct txsim_attach_args *ta = aux;
|
|
struct tx3912video_softc *sc = (void*)self;
|
|
tx_chipset_tag_t tc = ta->ta_tc;
|
|
struct fb_attach_args fba;
|
|
txreg_t reg;
|
|
|
|
sc->sc_chip = &tx3912video_chip;
|
|
|
|
printf(": ");
|
|
tx3912video_fbdepth(tc, 1);
|
|
printf(", frame buffer 0x%08x-0x%08x", sc->sc_chip->vc_fbaddr,
|
|
sc->sc_chip->vc_fbaddr + sc->sc_chip->vc_fbsize);
|
|
|
|
printf("\n");
|
|
|
|
#ifndef TX3912VIDEO_DEBUG
|
|
if (bootinfo->bi_cnuse & BI_CNUSE_SERIAL) {
|
|
printf("%s: power off\n", sc->sc_dev.dv_xname);
|
|
reg = tx_conf_read(tc, TX3912_VIDEOCTRL1_REG);
|
|
reg &= ~(TX3912_VIDEOCTRL1_DISPON |
|
|
TX3912_VIDEOCTRL1_ENVID);
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL1_REG, reg);
|
|
}
|
|
#endif /* TX3912VIDEO_DEBUG */
|
|
|
|
/* attach debug draw routine */
|
|
tx3912video_attach_drawfunc(sc->sc_chip);
|
|
|
|
/* Attach frame buffer device */
|
|
#if NFB > 0
|
|
if (!(bootinfo->bi_cnuse & BI_CNUSE_SERIAL)) {
|
|
if (fb_cnattach(0, 0, 0, 0)) {
|
|
panic("tx3912video_attach: can't init fb console");
|
|
}
|
|
}
|
|
fba.fba_name = "fb";
|
|
config_found(self, &fba, tx3912video_print);
|
|
#endif
|
|
}
|
|
|
|
int
|
|
tx3912video_print(aux, pnp)
|
|
void *aux;
|
|
const char *pnp;
|
|
{
|
|
return pnp ? QUIET : UNCONF;
|
|
}
|
|
|
|
int
|
|
tx3912video_init(tc, fb_start, fb_width, fb_height, fb_addr, fb_size,
|
|
fb_line_bytes)
|
|
tx_chipset_tag_t tc;
|
|
u_int32_t fb_start; /* Physical address */
|
|
int fb_width, fb_height;
|
|
u_int32_t *fb_addr, *fb_size;
|
|
int *fb_line_bytes;
|
|
{
|
|
u_int32_t addr, size;
|
|
int fb_depth;
|
|
txreg_t reg;
|
|
|
|
/* Inquire bit depth */
|
|
fb_depth = tx3912video_fbdepth(tc, 0);
|
|
|
|
switch (fb_depth) {
|
|
case 2:
|
|
bootinfo->fb_type = BIFB_D2_M2L_0;
|
|
break;
|
|
case 4:
|
|
/* XXX should implement rasops4.c */
|
|
fb_depth = 2;
|
|
bootinfo->fb_type = BIFB_D2_M2L_0;
|
|
reg = tx_conf_read(tc, TX3912_VIDEOCTRL1_REG);
|
|
TX3912_VIDEOCTRL1_BITSEL_CLR(reg);
|
|
reg = TX3912_VIDEOCTRL1_BITSEL_SET(
|
|
reg, TX3912_VIDEOCTRL1_BITSEL_2BITGREYSCALE);
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL1_REG, reg);
|
|
break;
|
|
case 8:
|
|
bootinfo->fb_type = BIFB_D8_FF;
|
|
break;
|
|
}
|
|
|
|
tx3912video_chip.vc_fbdepth = fb_depth;
|
|
tx3912video_chip.vc_fbwidth = fb_width;
|
|
tx3912video_chip.vc_fbheight= fb_height;
|
|
|
|
|
|
/* Allocate framebuffer area */
|
|
if (tx3912video_framebuffer_alloc(tc, fb_start, fb_width, fb_height,
|
|
fb_depth, &addr, &size)) {
|
|
return 1;
|
|
}
|
|
#if notyet
|
|
tx3912video_resolution_init(tc, fb_width, fb_height);
|
|
#else
|
|
/* Use Windows CE setting. */
|
|
#endif
|
|
/* Set DMA transfer address to VID module */
|
|
tx3912video_framebuffer_init(tc, addr, size);
|
|
|
|
/* Syncronize framebuffer addr to frame signal */
|
|
tx3912video_reset(tc);
|
|
|
|
*fb_line_bytes = (fb_width * fb_depth) / 8;
|
|
*fb_addr = addr; /* Phsical address */
|
|
*fb_size = size;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
tx3912video_framebuffer_alloc(tc, start, h, v, depth, fb_addr, fb_size)
|
|
tx_chipset_tag_t tc;
|
|
u_int32_t start;
|
|
int h, v, depth;
|
|
u_int32_t *fb_addr, *fb_size;
|
|
{
|
|
struct extent_fixed ex_fixed[2];
|
|
struct extent *ex;
|
|
u_long addr, size;
|
|
int err;
|
|
|
|
/* Calcurate frame buffer size */
|
|
size = (h * v * depth) / 8;
|
|
|
|
/* Allocate V-RAM area */
|
|
if (!(ex = extent_create("Frame buffer address", start,
|
|
start + TX3912_FRAMEBUFFER_MAX,
|
|
0, (caddr_t)ex_fixed, sizeof ex_fixed,
|
|
EX_NOWAIT))) {
|
|
return 1;
|
|
}
|
|
if((err = extent_alloc_subregion(ex, start, start + size, size,
|
|
TX3912_FRAMEBUFFER_ALIGNMENT,
|
|
TX3912_FRAMEBUFFER_BOUNDARY,
|
|
EX_FAST|EX_NOWAIT, &addr))) {
|
|
return 1;
|
|
}
|
|
tx3912video_chip.vc_fbaddr = addr;
|
|
tx3912video_chip.vc_fbsize = size;
|
|
|
|
*fb_addr = addr;
|
|
*fb_size = size;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
tx3912video_framebuffer_init(tc, fb_addr, fb_size)
|
|
tx_chipset_tag_t tc;
|
|
u_int32_t fb_addr, fb_size;
|
|
{
|
|
u_int32_t reg, vaddr, bank, base;
|
|
|
|
/* XXX currently I don't set DFVAL, so force DF signal toggled on
|
|
* XXX each frame. */
|
|
reg = tx_conf_read(tc, TX3912_VIDEOCTRL1_REG);
|
|
reg &= ~TX3912_VIDEOCTRL1_DFMODE;
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL1_REG, reg);
|
|
|
|
/* Set DMA transfer start and end address */
|
|
|
|
bank = TX3912_VIDEOCTRL3_VIDBANK(fb_addr);
|
|
base = TX3912_VIDEOCTRL3_VIDBASEHI(fb_addr);
|
|
reg = TX3912_VIDEOCTRL3_VIDBANK_SET(0, bank);
|
|
/* Upper address counter */
|
|
reg = TX3912_VIDEOCTRL3_VIDBASEHI_SET(reg, base);
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL3_REG, reg);
|
|
|
|
/* Lower address counter */
|
|
base = TX3912_VIDEOCTRL4_VIDBASELO(fb_addr + fb_size);
|
|
reg = TX3912_VIDEOCTRL4_VIDBASELO_SET(0, base);
|
|
|
|
/* Set DF-signal rate */
|
|
reg = TX3912_VIDEOCTRL4_DFVAL_SET(reg, 0); /* XXX not yet*/
|
|
|
|
/* Set VIDDONE signal delay after FRAME signal */
|
|
/* XXX not yet*/
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL4_REG, reg);
|
|
|
|
/* Clear frame buffer */
|
|
vaddr = MIPS_PHYS_TO_KSEG1(fb_addr);
|
|
bzero((void*)vaddr, fb_size);
|
|
}
|
|
|
|
void
|
|
tx3912video_resolution_init(tc, h, v)
|
|
tx_chipset_tag_t tc;
|
|
int h;
|
|
int v;
|
|
{
|
|
u_int32_t reg, val;
|
|
int split, bit8, horzval, lineval;
|
|
|
|
reg = tx_conf_read(tc, TX3912_VIDEOCTRL1_REG);
|
|
split = reg & TX3912_VIDEOCTRL1_DISPSPLIT;
|
|
bit8 = (TX3912_VIDEOCTRL1_BITSEL(reg) ==
|
|
TX3912_VIDEOCTRL1_BITSEL_8BITCOLOR);
|
|
val = TX3912_VIDEOCTRL1_BITSEL(reg);
|
|
|
|
if ((val == TX3912_VIDEOCTRL1_BITSEL_8BITCOLOR) &&
|
|
!split) {
|
|
/* (LCD horizontal pixels / 8bit) * RGB - 1 */
|
|
horzval = (h / 8) * 3 - 1;
|
|
} else {
|
|
horzval = h / 4 - 1;
|
|
}
|
|
lineval = (split ? v / 2 : v) - 1;
|
|
|
|
/* Video rate */
|
|
/* XXX
|
|
* probably This value should be determined from DFINT and LCDINT
|
|
*/
|
|
reg = TX3912_VIDEOCTRL2_VIDRATE_SET(0, horzval + 1);
|
|
/* Horizontal size of LCD */
|
|
reg = TX3912_VIDEOCTRL2_HORZVAL_SET(reg, horzval);
|
|
/* # of lines for the LCD */
|
|
reg = TX3912_VIDEOCTRL2_LINEVAL_SET(reg, lineval);
|
|
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL2_REG, reg);
|
|
}
|
|
|
|
int
|
|
tx3912video_fbdepth(tc, verbose)
|
|
tx_chipset_tag_t tc;
|
|
int verbose;
|
|
{
|
|
u_int32_t reg, val;
|
|
|
|
reg = tx_conf_read(tc, TX3912_VIDEOCTRL1_REG);
|
|
val = TX3912_VIDEOCTRL1_BITSEL(reg);
|
|
switch (val) {
|
|
case TX3912_VIDEOCTRL1_BITSEL_8BITCOLOR:
|
|
if (verbose)
|
|
printf("8bit color");
|
|
return 8;
|
|
case TX3912_VIDEOCTRL1_BITSEL_4BITGREYSCALE:
|
|
if (verbose)
|
|
printf("4bit greyscale");
|
|
return 4;
|
|
case TX3912_VIDEOCTRL1_BITSEL_2BITGREYSCALE:
|
|
if (verbose)
|
|
printf("2bit greyscale");
|
|
return 2;
|
|
case TX3912_VIDEOCTRL1_BITSEL_MONOCHROME:
|
|
if (verbose)
|
|
printf("monochrome");
|
|
return 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
tx3912video_reset(tc)
|
|
tx_chipset_tag_t tc;
|
|
{
|
|
u_int32_t reg;
|
|
|
|
reg = tx_conf_read(tc, TX3912_VIDEOCTRL1_REG);
|
|
|
|
/* Disable video logic at end of this frame */
|
|
reg |= TX3912_VIDEOCTRL1_ENFREEZEFRAME;
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL1_REG, reg);
|
|
|
|
/* Wait for end of frame */
|
|
delay(300 * 1000);
|
|
|
|
/* Make sure to disable video logic */
|
|
reg &= ~TX3912_VIDEOCTRL1_ENVID;
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL1_REG, reg);
|
|
|
|
delay(1000);
|
|
|
|
/* Enable video logic again */
|
|
reg &= ~TX3912_VIDEOCTRL1_ENFREEZEFRAME;
|
|
reg |= TX3912_VIDEOCTRL1_ENVID;
|
|
tx_conf_write(tc, TX3912_VIDEOCTRL1_REG, reg);
|
|
|
|
delay(1000);
|
|
}
|
|
|
|
/*
|
|
* Debug routines.
|
|
*/
|
|
|
|
void
|
|
tx3912video_calibration_pattern()
|
|
{
|
|
struct tx3912video_chip *vc = &tx3912video_chip;
|
|
int x, y;
|
|
|
|
x = vc->vc_fbwidth - 40;
|
|
y = vc->vc_fbheight - 40;
|
|
tx3912video_line(40, 40, x , 40);
|
|
tx3912video_line(x , 40, x , y );
|
|
tx3912video_line(x , y , 40, y );
|
|
tx3912video_line(40, y , 40, 40);
|
|
tx3912video_line(40, 40, x , y );
|
|
tx3912video_line(x, 40, 40, y );
|
|
}
|
|
|
|
#define BPP2 ({ \
|
|
u_int8_t bitmap; \
|
|
bitmap = *(volatile u_int8_t*)MIPS_PHYS_TO_KSEG1(addr); \
|
|
*(volatile u_int8_t*)MIPS_PHYS_TO_KSEG1(addr) = \
|
|
(bitmap & ~(0x3 << ((3 - (x % 4)) * 2))); \
|
|
})
|
|
|
|
#define BPP4 ({ \
|
|
u_int8_t bitmap; \
|
|
bitmap = *(volatile u_int8_t*)MIPS_PHYS_TO_KSEG1(addr); \
|
|
*(volatile u_int8_t*)MIPS_PHYS_TO_KSEG1(addr) = \
|
|
(bitmap & ~(0xf << ((1 - (x % 2)) * 4))); \
|
|
})
|
|
|
|
#define BPP8 ({ \
|
|
*(volatile u_int8_t*)MIPS_PHYS_TO_KSEG1(addr) = 0xff; \
|
|
})
|
|
|
|
#define BRESENHAM(a, b, c, d, func) ({ \
|
|
u_int32_t fbaddr = vc->vc_fbaddr; \
|
|
u_int32_t fbwidth = vc->vc_fbwidth; \
|
|
u_int32_t fbdepth = vc->vc_fbdepth; \
|
|
len = a, step = b -1; \
|
|
if (step == 0) \
|
|
return; \
|
|
kstep = len == 0 ? 0 : 1; \
|
|
for (i = k = 0, j = step / 2; i <= step; i++) { \
|
|
x = xbase c; \
|
|
y = ybase d; \
|
|
addr = fbaddr + (((y * fbwidth + x) * fbdepth) >> 3); \
|
|
func; \
|
|
j -= len; \
|
|
while (j < 0) { \
|
|
j += step; \
|
|
k += kstep; \
|
|
} \
|
|
} \
|
|
})
|
|
|
|
#define DRAWLINE(func) ({ \
|
|
if (x < 0) { \
|
|
if (y < 0) { \
|
|
if (_y < _x) { \
|
|
BRESENHAM(_y, _x, -i, -k, func); \
|
|
} else { \
|
|
BRESENHAM(_x, _y, -k, -i, func); \
|
|
} \
|
|
} else { \
|
|
if (_y < _x) { \
|
|
BRESENHAM(_y, _x, -i, +k, func); \
|
|
} else { \
|
|
BRESENHAM(_x, _y, -k, +i, func); \
|
|
} \
|
|
} \
|
|
} else { \
|
|
if (y < 0) { \
|
|
if (_y < _x) { \
|
|
BRESENHAM(_y, _x, +i, -k, func); \
|
|
} else { \
|
|
BRESENHAM(_x, _y, +k, -i, func); \
|
|
} \
|
|
} else { \
|
|
if (_y < _x) { \
|
|
BRESENHAM(_y, _x, +i, +k, func); \
|
|
} else { \
|
|
BRESENHAM(_x, _y, +k, +i, func); \
|
|
} \
|
|
} \
|
|
} \
|
|
})
|
|
|
|
#define LINEFUNC(b) \
|
|
static void linebpp##b __P((int, int, int, int)); \
|
|
static void \
|
|
linebpp##b##(x0, y0, x1, y1) \
|
|
int x0, y0, x1, y1; \
|
|
{ \
|
|
struct tx3912video_chip *vc = &tx3912video_chip; \
|
|
u_int32_t addr; \
|
|
int i, j, k, len, step, kstep; \
|
|
int x, _x, y, _y; \
|
|
int xbase, ybase; \
|
|
x = x1 - x0; \
|
|
y = y1 - y0; \
|
|
_x = abs(x); \
|
|
_y = abs(y); \
|
|
xbase = x0; \
|
|
ybase = y0; \
|
|
DRAWLINE(BPP##b##); \
|
|
}
|
|
|
|
#define DOTFUNC(b) \
|
|
static void dotbpp##b __P((int, int)); \
|
|
static void \
|
|
dotbpp##b##(x, y) \
|
|
int x, y; \
|
|
{ \
|
|
struct tx3912video_chip *vc = &tx3912video_chip; \
|
|
u_int32_t addr; \
|
|
addr = vc->vc_fbaddr + (((y * vc->vc_fbwidth + x) * \
|
|
vc->vc_fbdepth) >> 3); \
|
|
BPP##b; \
|
|
}
|
|
|
|
static void linebpp_unimpl __P((int, int, int, int));
|
|
static void dotbpp_unimpl __P((int, int));
|
|
static
|
|
void linebpp_unimpl(x0, y0, x1, y1)
|
|
int x0, y0, x1, y1;
|
|
{
|
|
return;
|
|
}
|
|
static
|
|
void dotbpp_unimpl(x, y)
|
|
int x, y;
|
|
{
|
|
return;
|
|
}
|
|
|
|
LINEFUNC(2)
|
|
LINEFUNC(4)
|
|
LINEFUNC(8)
|
|
DOTFUNC(2)
|
|
DOTFUNC(4)
|
|
DOTFUNC(8)
|
|
|
|
void
|
|
tx3912video_attach_drawfunc(vc)
|
|
struct tx3912video_chip *vc;
|
|
{
|
|
switch (vc->vc_fbdepth) {
|
|
default:
|
|
vc->vc_drawline = linebpp_unimpl;
|
|
vc->vc_drawdot = dotbpp_unimpl;
|
|
break;
|
|
case 8:
|
|
vc->vc_drawline = linebpp8;
|
|
vc->vc_drawdot = dotbpp8;
|
|
break;
|
|
case 4:
|
|
vc->vc_drawline = linebpp4;
|
|
vc->vc_drawdot = dotbpp4;
|
|
break;
|
|
case 2:
|
|
vc->vc_drawline = linebpp2;
|
|
vc->vc_drawdot = dotbpp2;
|
|
break;
|
|
}
|
|
}
|
|
|
|
void
|
|
tx3912video_line(x0, y0, x1, y1)
|
|
int x0, y0, x1, y1;
|
|
{
|
|
struct tx3912video_chip *vc = &tx3912video_chip;
|
|
vc->vc_drawline(x0, y0, x1, y1);
|
|
}
|
|
|
|
void
|
|
tx3912video_dot(x, y)
|
|
int x, y;
|
|
{
|
|
struct tx3912video_chip *vc = &tx3912video_chip;
|
|
vc->vc_drawdot(x, y);
|
|
}
|