9480c51b04
Patch showed on tech-kern@ http://mail-index.netbsd.org/tech-kern/2009/11/04/msg006434.html No objections.
438 lines
10 KiB
C
438 lines
10 KiB
C
/* $NetBSD: ga.c,v 1.5 2009/11/07 07:27:43 cegger Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 2004, 2005 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by UCHIYAMA Yasushi.
|
|
*
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
|
|
*/
|
|
|
|
/* Graphic Adaptor (350, 360) */
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: ga.c,v 1.5 2009/11/07 07:27:43 cegger Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
|
|
#ifdef _STANDALONE
|
|
#include <lib/libsa/stand.h>
|
|
#include <lib/libkern/libkern.h>
|
|
#include "local.h"
|
|
#endif
|
|
#ifdef _KERNEL
|
|
#include <uvm/uvm_extern.h>
|
|
#include <machine/vmparam.h>
|
|
#endif
|
|
#include <machine/gareg.h>
|
|
#include <machine/gavar.h>
|
|
|
|
bool ga_map(struct ga *);
|
|
void ga_clut_init(struct ga *);
|
|
void ga_vblank_start(const struct ga *);
|
|
void ga_bt463_reg(const struct ga *, int);
|
|
void ga_bt463_data(const struct ga *, int);
|
|
void ga_bt463_reg_data(const struct ga *, int, int);
|
|
#ifdef _STANDALONE
|
|
void ga_dda_busy(const struct ga *);
|
|
void ga_ovl_init(const struct ga *);
|
|
void ga_id_init(const struct ga *);
|
|
void ga_block_clear(const struct ga *);
|
|
void ga_plane_mask_test(const struct ga *);
|
|
#endif
|
|
|
|
#define ga_reg_write(ga, ofs, val) \
|
|
(*(volatile uint32_t *)((ga)->reg_addr + (ofs)) = (val))
|
|
#define ga_reg_read(ga, ofs) \
|
|
(*(volatile uint32_t *)((ga)->reg_addr + (ofs)))
|
|
|
|
bool
|
|
ga_init(struct ga *ga)
|
|
{
|
|
int i;
|
|
|
|
/* Map GA register and buffers */
|
|
if (ga->reg_addr == 0 && ga_map(ga) != 0)
|
|
return false;
|
|
|
|
/* This is 350 GA-ROM initialization sequence. */
|
|
if (ga->flags == 0x0000) {
|
|
ga_bt463_reg_data(ga, 0x201, 0x40);
|
|
ga_bt463_reg_data(ga, 0x202, 0x40);
|
|
ga_bt463_reg_data(ga, 0x203,
|
|
((ga_reg_read(ga, 0xe00) & 2) << 6) | 0x40);
|
|
} else if (ga->flags == 0x0001) {
|
|
ga_bt463_reg_data(ga, 0x201, 0x40);
|
|
ga_bt463_reg_data(ga, 0x202, 0);
|
|
ga_bt463_reg_data(ga, 0x203,
|
|
((ga_reg_read(ga, 0xe00) & 2) << 6) | 0x40);
|
|
ga_bt463_reg_data(ga, 0x204, 0xff); /* Display ON/OFF ? */
|
|
ga_bt463_reg_data(ga, 0x206, 0);
|
|
ga_bt463_reg_data(ga, 0x20a, 0);
|
|
}
|
|
|
|
/* Window type table */
|
|
ga_bt463_reg(ga, 0x300);
|
|
for (i = 0; i < 16; i++) {
|
|
ga_bt463_data(ga, 0x00);
|
|
ga_bt463_data(ga, 0xe1);
|
|
ga_bt463_data(ga, 0x01);
|
|
}
|
|
|
|
ga_vblank_start(ga);
|
|
|
|
/* ??? */
|
|
ga_bt463_reg(ga, 0x302);
|
|
for (i = 0; i < 2; i++) {
|
|
ga_bt463_data(ga, 0x00);
|
|
ga_bt463_data(ga, 0xe3);
|
|
ga_bt463_data(ga, 0x21);
|
|
}
|
|
|
|
/* Read mask P0-P7 */
|
|
if (ga->flags != 0x0001) {
|
|
/* TR2A display blinks if this was done.. */
|
|
ga_bt463_reg(ga, 0x205);
|
|
for (i = 0; i < 4; i++)
|
|
ga_bt463_data(ga, 0xff);
|
|
}
|
|
|
|
/* Blink mask P0-P7 */
|
|
ga_bt463_reg(ga, 0x209);
|
|
for (i = 0; i < 4; i++)
|
|
ga_bt463_data(ga, 0x00);
|
|
|
|
ga_clut_init(ga);
|
|
|
|
/* ??? */
|
|
ga_bt463_reg(ga, 0x200);
|
|
for (i = 0; i < 0xff; i++) {
|
|
ga_reg_write(ga, 0xc8c, 0);
|
|
ga_reg_write(ga, 0xc8c, 0);
|
|
ga_reg_write(ga, 0xc8c, 0);
|
|
}
|
|
|
|
if (ga_reg_read(ga, 0xe00) & 2)
|
|
ga_reg_write(ga, 0xe08, 0x790); /* 71Hz */
|
|
else
|
|
ga_reg_write(ga, 0xe08, 0x670); /* 60Hz */
|
|
#ifdef _STANDALONE
|
|
ga_block_clear(ga);
|
|
ga_ovl_init(ga);
|
|
ga_id_init(ga);
|
|
#endif
|
|
/* Cursor RAM clear */
|
|
ga_reg_write(ga, 0xc90, 0);
|
|
ga_reg_write(ga, 0xc94, 0);
|
|
ga_reg_write(ga, 0xca0, 0);
|
|
ga_reg_write(ga, 0xca4, 0);
|
|
for (i = 0; i < 512; i++) {
|
|
ga_reg_write(ga, 0xc98, 0);
|
|
ga_reg_write(ga, 0xca8, 0);
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool
|
|
ga_map(struct ga *ga)
|
|
{
|
|
#ifdef _STANDALONE
|
|
/* IPL maps register region using 16Mpage */
|
|
ga->reg_addr = GA_REG_ADDR;
|
|
#endif
|
|
#ifdef _KERNEL
|
|
paddr_t pa, epa;
|
|
vaddr_t va, tva;
|
|
|
|
pa = (paddr_t)GA_REG_ADDR;
|
|
epa = pa + GA_REG_SIZE;
|
|
|
|
if (!(va = uvm_km_alloc(kernel_map, epa - pa, 0, UVM_KMF_VAONLY))) {
|
|
printf("can't map GA register.\n");
|
|
return false;
|
|
}
|
|
|
|
for (tva = va; pa < epa; pa += PAGE_SIZE, tva += PAGE_SIZE)
|
|
pmap_kenter_pa(tva, pa, VM_PROT_READ | VM_PROT_WRITE, 0);
|
|
|
|
pmap_update(pmap_kernel());
|
|
|
|
ga->reg_addr = (uint32_t)va;
|
|
#endif
|
|
|
|
return true;
|
|
}
|
|
|
|
void
|
|
ga_vblank_start(const struct ga *ga)
|
|
{
|
|
|
|
while ((ga_reg_read(ga, 0xe00) & 0x1) == 0) /* V-blank */
|
|
;
|
|
while ((ga_reg_read(ga, 0xe00) & 0x1) == 1)
|
|
;
|
|
/* V-blank start */
|
|
}
|
|
|
|
/* Bt463 utils */
|
|
void
|
|
ga_bt463_reg(const struct ga *ga, int r)
|
|
{
|
|
|
|
ga_reg_write(ga, 0xc80, r & 0xff);
|
|
ga_reg_write(ga, 0xc84, (r >> 8) & 0xff);
|
|
}
|
|
|
|
void
|
|
ga_bt463_data(const struct ga *ga, int v)
|
|
{
|
|
|
|
ga_reg_write(ga, 0xc88, v & 0xff);
|
|
}
|
|
|
|
void
|
|
ga_bt463_reg_data(const struct ga *ga, int r, int v)
|
|
{
|
|
|
|
ga_bt463_reg(ga, r);
|
|
ga_bt463_data(ga, v);
|
|
}
|
|
|
|
/* CLUT */
|
|
void
|
|
ga_clut_init(struct ga *ga)
|
|
{
|
|
const uint8_t compo6[6] = { 0, 51, 102, 153, 204, 255 };
|
|
const uint8_t ansi_color[16][3] = {
|
|
{ 0x00, 0x00, 0x00 },
|
|
{ 0xff, 0x00, 0x00 },
|
|
{ 0x00, 0xff, 0x00 },
|
|
{ 0xff, 0xff, 0x00 },
|
|
{ 0x00, 0x00, 0xff },
|
|
{ 0xff, 0x00, 0xff },
|
|
{ 0x00, 0xff, 0xff },
|
|
{ 0xff, 0xff, 0xff },
|
|
{ 0x00, 0x00, 0x00 },
|
|
{ 0x80, 0x00, 0x00 },
|
|
{ 0x00, 0x80, 0x00 },
|
|
{ 0x80, 0x80, 0x00 },
|
|
{ 0x00, 0x00, 0x80 },
|
|
{ 0x80, 0x00, 0x80 },
|
|
{ 0x00, 0x80, 0x80 },
|
|
{ 0x80, 0x80, 0x80 },
|
|
};
|
|
int i, j, r, g, b;
|
|
|
|
ga_bt463_reg(ga, 0);
|
|
/* ANSI escape sequence */
|
|
for (i = 0; i < 16; i++) {
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][0] = ansi_color[i][0]);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][1] = ansi_color[i][1]);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][2] = ansi_color[i][2]);
|
|
}
|
|
|
|
/* 16 - 31, gray scale */
|
|
for ( ; i < 32; i++) {
|
|
j = (i - 16) * 17;
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][0] = j);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][1] = j);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][2] = j);
|
|
}
|
|
|
|
/* 32 - 247, RGB color */
|
|
for (r = 0; r < 6; r++) {
|
|
for (g = 0; g < 6; g++) {
|
|
for (b = 0; b < 6; b++, i++) {
|
|
ga_reg_write(ga, 0xc8c,
|
|
ga->clut[i][0] = compo6[r]);
|
|
ga_reg_write(ga, 0xc8c,
|
|
ga->clut[i][1] = compo6[g]);
|
|
ga_reg_write(ga, 0xc8c,
|
|
ga->clut[i][2] = compo6[b]);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* 248 - 256, white */
|
|
for ( ; i < 256; i++) {
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][0] = 0xff);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][1] = 0xff);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][2] = 0xff);
|
|
}
|
|
|
|
/* 257 - 528, black */
|
|
for ( ; i < 528; i++) {
|
|
ga_reg_write(ga, 0xc8c, 0);
|
|
ga_reg_write(ga, 0xc8c, 0);
|
|
ga_reg_write(ga, 0xc8c, 0);
|
|
}
|
|
}
|
|
|
|
void
|
|
ga_clut_get(struct ga *ga)
|
|
{
|
|
int i;
|
|
|
|
ga_bt463_reg(ga, 0);
|
|
for (i = 0; i < 256; i++) {
|
|
ga->clut[i][0] = ga_reg_read(ga, 0xc8c);
|
|
ga->clut[i][1] = ga_reg_read(ga, 0xc8c);
|
|
ga->clut[i][2] = ga_reg_read(ga, 0xc8c);
|
|
}
|
|
}
|
|
|
|
void
|
|
ga_clut_set(const struct ga *ga)
|
|
{
|
|
int i;
|
|
|
|
ga_bt463_reg(ga, 0);
|
|
for (i = 0; i < 256; i++) {
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][0]);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][1]);
|
|
ga_reg_write(ga, 0xc8c, ga->clut[i][2]);
|
|
}
|
|
}
|
|
|
|
/* Not yet analyzed. */
|
|
#ifdef _STANDALONE
|
|
void
|
|
ga_dda_busy(const struct ga *ga)
|
|
{
|
|
|
|
while ((ga_reg_read(ga, 0xf00) & 0x8000) == 0)
|
|
;
|
|
}
|
|
|
|
void
|
|
ga_ovl_init(const struct ga *ga)
|
|
{
|
|
uint32_t *p0, *p1;
|
|
|
|
ga_reg_write(ga, 0x400, 0xffffffff);
|
|
p0 = (uint32_t *)0xf2000000;
|
|
p1 = (uint32_t *)0xf2200000;
|
|
while (p0 < p1)
|
|
*p0++ = 0;
|
|
}
|
|
|
|
void
|
|
ga_id_init(const struct ga *ga)
|
|
{
|
|
uint32_t *p0, *p1;
|
|
|
|
p0 = (uint32_t *)0xf3000000;
|
|
p1 = (uint32_t *)0xf3040000;
|
|
while (p0 < p1)
|
|
*p0++ = 0;
|
|
}
|
|
|
|
void
|
|
ga_block_clear(const struct ga *ga)
|
|
{
|
|
uint32_t *p0, *p1;
|
|
|
|
ga_reg_write(ga, 0xe80, 0);
|
|
ga_reg_write(ga, 0x400, 0xffffff);
|
|
|
|
p0 = (uint32_t *)0xf0c00000;
|
|
p1 = (uint32_t *)0xf0c80000;
|
|
while (p0 < p1)
|
|
*p0++ = 0xffffffff;
|
|
}
|
|
|
|
void
|
|
ga_plane_mask_test(const struct ga *ga)
|
|
{
|
|
int i;
|
|
|
|
ga_reg_write(ga, 0x400, 0xffffff);
|
|
*(volatile uint32_t *)0xf1000000 = 0;
|
|
|
|
ga_reg_write(ga, 0x400, 0xaaaaaa);
|
|
*(volatile uint32_t *)0xf1000000 = 0xffffff;
|
|
|
|
if ((*(volatile uint32_t *)0xf1000000 & 0xffffff) != 0xaaaaaa)
|
|
goto err;
|
|
ga_reg_write(ga, 0x400, 0xffffff);
|
|
*(volatile uint32_t *)0xf1000000 = 0;
|
|
|
|
|
|
*(volatile uint32_t *)0xf1080008 = 0;
|
|
ga_reg_write(ga, 0x400, 0x555555);
|
|
*(volatile uint32_t *)0xf1080008 = 0xffffff;
|
|
if ((*(volatile uint32_t *)0xf1080008 & 0xffffff) != 0x555555)
|
|
goto err;
|
|
ga_reg_write(ga, 0x400, 0xffffff);
|
|
*(volatile uint32_t *)0xf1080008 = 0;
|
|
|
|
*(volatile uint32_t *)0xf1100000 = 0;
|
|
*(volatile uint32_t *)0xf1100000 = 0xffffff;
|
|
if ((*(volatile uint32_t *)0xf1100000 & 0xffffff) != 0xffffff)
|
|
goto err;
|
|
|
|
ga_reg_write(ga, 0x400, 0xaaaaaa);
|
|
*(volatile uint32_t *)0xf1100000 = 0;
|
|
if ((*(volatile uint32_t *)0xf1100000 & 0xffffff) != 0x555555)
|
|
goto err;
|
|
|
|
ga_reg_write(ga, 0x400, 0);
|
|
*(volatile uint32_t *)0xf1100000 = 0xffffff;
|
|
if ((*(volatile uint32_t *)0xf1100000 & 0xffffff) != 0x555555)
|
|
goto err;
|
|
|
|
ga_reg_write(ga, 0x400, 0xffffff);
|
|
*(volatile uint32_t *)0xf1100000 = 0;
|
|
|
|
ga_reg_write(ga, 0xe80, 0xffffff);
|
|
ga_reg_write(ga, 0x400, 0xffffff);
|
|
*(volatile uint32_t *)0xf0c00000 = 0xffffffff;
|
|
for (i = 0; i < 32; i++)
|
|
if ((*(volatile uint32_t *)(0xf1000000 + i * 4) & 0xffffff) !=
|
|
0xffffff)
|
|
goto err;
|
|
|
|
ga_reg_write(ga, 0xe80, 0);
|
|
ga_reg_write(ga, 0x400, 0xaaaaaa);
|
|
*(volatile uint32_t *)0xf0c00000 = 0xffffffff;
|
|
for (i = 0; i < 32; i++)
|
|
if ((*(volatile uint32_t *)(0xf1000000 + i * 4) & 0xffffff) !=
|
|
0x555555)
|
|
goto err;
|
|
ga_reg_write(ga, 0x400, 0x555555);
|
|
*(volatile uint32_t *)0xf0c00000 = 0xffffffff;
|
|
for (i = 0; i < 32; i++)
|
|
if ((*(volatile uint32_t *)(0xf1000000 + i * 4) & 0xffffff) !=
|
|
0x0)
|
|
goto err;
|
|
|
|
printf("SUCCESS\n");
|
|
return;
|
|
err:
|
|
printf("ERROR\n");
|
|
}
|
|
#endif /* _STANDALONE */
|