First cut at cgtwo driver. Not quite right yet.
This commit is contained in:
gwr
parent
63052ecc6e
commit
1feb639a38
|
|
@ -0,0 +1,397 @@
|
|||
/* $NetBSD: cg2.c,v 1.1 1995/04/07 02:31:45 gwr Exp $ */
|
||||
|
||||
/*
|
||||
* Copyright (c) 1992, 1993
|
||||
* The Regents of the University of California. All rights reserved.
|
||||
*
|
||||
* This software was developed by the Computer Systems Engineering group
|
||||
* at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
|
||||
* contributed to Berkeley.
|
||||
*
|
||||
* All advertising materials mentioning features or use of this software
|
||||
* must display the following acknowledgement:
|
||||
* This product includes software developed by the University of
|
||||
* California, Lawrence Berkeley Laboratory.
|
||||
*
|
||||
* 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. All advertising materials mentioning features or use of this software
|
||||
* must display the following acknowledgement:
|
||||
* This product includes software developed by the University of
|
||||
* California, Berkeley and its contributors.
|
||||
* 4. 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 REGENTS 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 REGENTS 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.
|
||||
*
|
||||
* from: @(#)cgthree.c 8.2 (Berkeley) 10/30/93
|
||||
*/
|
||||
|
||||
/*
|
||||
* color display (cg2) driver.
|
||||
*
|
||||
* Does not handle interrupts, even though they can occur.
|
||||
*
|
||||
* XXX should defer colormap updates to vertical retrace interrupts
|
||||
*/
|
||||
|
||||
#include <sys/param.h>
|
||||
#include <sys/device.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/mman.h>
|
||||
#include <sys/tty.h>
|
||||
|
||||
#include <vm/vm.h>
|
||||
|
||||
#include <machine/fbio.h>
|
||||
#include <machine/autoconf.h>
|
||||
#include <machine/pmap.h>
|
||||
#include <machine/eeprom.h>
|
||||
#include <machine/cg2reg.h>
|
||||
|
||||
#include "fbvar.h"
|
||||
|
||||
#define CMSIZE 256
|
||||
|
||||
/* offset to and size of mapped part of frame buffer */
|
||||
#define PLANEMAP_SIZE 0x100000
|
||||
#define PIXELMAP_SIZE 0x100000
|
||||
#define ROWOPMAP_SIZE 0x100000
|
||||
|
||||
#define CTLREGS_OFF 0x300000
|
||||
#define CTLREGS_SIZE 0x10600
|
||||
|
||||
#define CG2_MAPPED_OFFSET (PLANEMAP_SIZE + PIXELMAP_SIZE)
|
||||
#define CG2_MAPPED_SIZE (ROWOPMAP_SIZE /* XXX + CTLREGS_SIZE */)
|
||||
#define CG2_MAPPED_LIMIT (CTLREGS_OFF + CTLREGS_SIZE)
|
||||
|
||||
/* per-display variables */
|
||||
struct cg2_softc {
|
||||
struct device sc_dev; /* base device */
|
||||
struct fbdevice sc_fb; /* frame buffer device */
|
||||
int sc_phys; /* display RAM (phys addr) */
|
||||
int sc_pmtype; /* pmap type bits */
|
||||
struct cg2fb *sc_ctlreg; /* control registers */
|
||||
};
|
||||
|
||||
/* autoconfiguration driver */
|
||||
static void cg2attach __P((struct device *, struct device *, void *));
|
||||
static int cg2match __P((struct device *, void *, void *));
|
||||
|
||||
struct cfdriver cgtwocd = {
|
||||
NULL, "cgtwo", cg2match, cg2attach,
|
||||
DV_DULL, sizeof(struct cg2_softc) };
|
||||
|
||||
/* frame buffer generic driver */
|
||||
int cg2open(), cg2close(), cg2map();
|
||||
|
||||
static int cg2gattr __P((struct fbdevice *, struct fbgattr *));
|
||||
static int cg2gvideo __P((struct fbdevice *, int *));
|
||||
static int cg2svideo __P((struct fbdevice *, int *));
|
||||
static int cg2getcmap __P((struct fbdevice *, struct fbcmap *));
|
||||
static int cg2putcmap __P((struct fbdevice *, struct fbcmap *));
|
||||
|
||||
static struct fbdriver cg2fbdriver = {
|
||||
cg2open, cg2close, cg2map, cg2gattr,
|
||||
cg2gvideo, cg2svideo,
|
||||
cg2getcmap, cg2putcmap };
|
||||
|
||||
static void cg2loadcmap __P((struct cg2_softc *, int, int));
|
||||
static int cg2intr __P((void*));
|
||||
|
||||
/*
|
||||
* Match a cg2.
|
||||
*/
|
||||
static int
|
||||
cg2match(parent, vcf, args)
|
||||
struct device *parent;
|
||||
void *vcf, *args;
|
||||
{
|
||||
struct confargs *ca = args;
|
||||
struct cg2fb *crp;
|
||||
int x;
|
||||
|
||||
if (ca->ca_paddr == -1)
|
||||
return (0);
|
||||
|
||||
if (ca->ca_bustype != BUS_VME16)
|
||||
return (0);
|
||||
|
||||
/* Look at the value in the ID register. */
|
||||
crp = (struct cg2fb *) (ca->ca_paddr + CTLREGS_OFF);
|
||||
|
||||
/* The peek returns -1 on bus error. */
|
||||
x = bus_peek(ca->ca_bustype, &crp->id.reg, 2);
|
||||
if (x == -1)
|
||||
return (0);
|
||||
|
||||
/* XXX */
|
||||
printf("cg2: id=0x%x\n", x);
|
||||
|
||||
return (1);
|
||||
}
|
||||
|
||||
/*
|
||||
* Attach a display. We need to notice if it is the console, too.
|
||||
*/
|
||||
static void
|
||||
cg2attach(parent, self, args)
|
||||
struct device *parent, *self;
|
||||
void *args;
|
||||
{
|
||||
struct cg2_softc *sc = (struct cg2_softc *)self;
|
||||
struct fbdevice *fb = &sc->sc_fb;
|
||||
struct confargs *ca = args;
|
||||
struct fbtype *fbt;
|
||||
int i, ramsize, pa;
|
||||
|
||||
sc->sc_phys = ca->ca_paddr;
|
||||
sc->sc_pmtype = PMAP_NC | PMAP_VME16;
|
||||
|
||||
sc->sc_ctlreg = (struct cg2fb *) bus_mapin(ca->ca_bustype,
|
||||
ca->ca_paddr + CTLREGS_OFF, CTLREGS_SIZE);
|
||||
|
||||
isr_add_vectored(cg2intr, (void*)sc,
|
||||
ca->ca_intpri, ca->ca_intvec);
|
||||
|
||||
/*
|
||||
* XXX - Initialize? Determine type?
|
||||
*/
|
||||
sc->sc_ctlreg->intrptvec.reg = ca->ca_intvec;
|
||||
sc->sc_ctlreg->status.word = 1;
|
||||
|
||||
fb->fb_driver = &cg2fbdriver;
|
||||
fb->fb_private = sc;
|
||||
fb->fb_name = sc->sc_dev.dv_xname;
|
||||
|
||||
fbt = &fb->fb_fbtype;
|
||||
fbt->fb_type = FBTYPE_SUN2COLOR;
|
||||
fbt->fb_depth = 8;
|
||||
fbt->fb_cmsize = CMSIZE;
|
||||
|
||||
fbt->fb_width = 1152;
|
||||
fbt->fb_height = 900;
|
||||
fbt->fb_size = CG2_MAPPED_SIZE;
|
||||
|
||||
printf(" (%dx%d)\n", fbt->fb_width, fbt->fb_height);
|
||||
fb_attach(fb, 2);
|
||||
}
|
||||
|
||||
int
|
||||
cg2open(dev, flags, mode, p)
|
||||
dev_t dev;
|
||||
int flags, mode;
|
||||
struct proc *p;
|
||||
{
|
||||
int unit = minor(dev);
|
||||
|
||||
if (unit >= cgtwocd.cd_ndevs || cgtwocd.cd_devs[unit] == NULL)
|
||||
return (ENXIO);
|
||||
return (0);
|
||||
}
|
||||
|
||||
int
|
||||
cg2close(dev, flags, mode, p)
|
||||
dev_t dev;
|
||||
int flags, mode;
|
||||
struct proc *p;
|
||||
{
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
int
|
||||
cg2ioctl(dev, cmd, data, flags, p)
|
||||
dev_t dev;
|
||||
u_long cmd;
|
||||
caddr_t data;
|
||||
int flags;
|
||||
struct proc *p;
|
||||
{
|
||||
struct cg2_softc *sc = cgtwocd.cd_devs[minor(dev)];
|
||||
|
||||
return (fbioctlfb(&sc->sc_fb, cmd, data));
|
||||
}
|
||||
|
||||
/*
|
||||
* Return the address that would map the given device at the given
|
||||
* offset, allowing for the given protection, or return -1 for error.
|
||||
*/
|
||||
int
|
||||
cg2map(dev, off, prot)
|
||||
dev_t dev;
|
||||
int off, prot;
|
||||
{
|
||||
struct cg2_softc *sc = cgtwocd.cd_devs[minor(dev)];
|
||||
int realoff;
|
||||
|
||||
if (off & PGOFSET)
|
||||
panic("cg2map");
|
||||
|
||||
if ((unsigned)off >= CG2_MAPPED_LIMIT)
|
||||
return (-1);
|
||||
|
||||
/*
|
||||
* I turned on PMAP_NC here to disable the cache as I was
|
||||
* getting horribly broken behaviour with it on.
|
||||
*/
|
||||
return ((sc->sc_phys + off) | sc->sc_pmtype);
|
||||
}
|
||||
|
||||
/*
|
||||
* Internal ioctl functions.
|
||||
*/
|
||||
|
||||
/* FBIOGATTR: */
|
||||
static int cg2gattr(fb, fba)
|
||||
struct fbdevice *fb;
|
||||
struct fbgattr *fba;
|
||||
{
|
||||
|
||||
fba->real_type = fb->fb_fbtype.fb_type;
|
||||
fba->owner = 0; /* XXX - TIOCCONS stuff? */
|
||||
fba->fbtype = fb->fb_fbtype;
|
||||
fba->sattr.flags = 0;
|
||||
fba->sattr.emu_type = fb->fb_fbtype.fb_type;
|
||||
fba->sattr.dev_specific[0] = -1;
|
||||
fba->emu_types[0] = fb->fb_fbtype.fb_type;
|
||||
fba->emu_types[1] = -1;
|
||||
return (0);
|
||||
}
|
||||
|
||||
/* FBIOGVIDEO: */
|
||||
static int cg2gvideo(fb, on)
|
||||
struct fbdevice *fb;
|
||||
int *on;
|
||||
{
|
||||
struct cg2_softc *sc = fb->fb_private;
|
||||
|
||||
*on = sc->sc_ctlreg->status.reg.video_enab;
|
||||
return (0);
|
||||
}
|
||||
|
||||
/* FBIOSVIDEO: */
|
||||
static int cg2svideo(fb, on)
|
||||
struct fbdevice *fb;
|
||||
int *on;
|
||||
{
|
||||
struct cg2_softc *sc = fb->fb_private;
|
||||
|
||||
sc->sc_ctlreg->status.reg.video_enab = (*on) & 1;
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
/* FBIOGETCMAP: */
|
||||
static int cg2getcmap(fb, cmap)
|
||||
struct fbdevice *fb;
|
||||
struct fbcmap *cmap;
|
||||
{
|
||||
struct cg2_softc *sc = fb->fb_private;
|
||||
u_char red[CMSIZE], green[CMSIZE], blue[CMSIZE];
|
||||
int error, start, count, ecount;
|
||||
register u_int i;
|
||||
register u_short *p;
|
||||
|
||||
start = cmap->index;
|
||||
count = cmap->count;
|
||||
ecount = start + count;
|
||||
if (start >= CMSIZE || ecount > CMSIZE)
|
||||
return (EINVAL);
|
||||
|
||||
/* XXX - Wait for retrace? */
|
||||
|
||||
/* Copy hardware to local arrays. */
|
||||
p = &sc->sc_ctlreg->redmap[start];
|
||||
for (i = start; i < ecount; i++)
|
||||
red[i] = *p++;
|
||||
p = &sc->sc_ctlreg->greenmap[start];
|
||||
for (i = start; i < ecount; i++)
|
||||
green[i] = *p++;
|
||||
p = &sc->sc_ctlreg->bluemap[start];
|
||||
for (i = start; i < ecount; i++)
|
||||
blue[i] = *p++;
|
||||
|
||||
/* Copy local arrays to user space. */
|
||||
if ((error = copyout(red + start, cmap->red, count)) != 0)
|
||||
return (error);
|
||||
if ((error = copyout(green + start, cmap->green, count)) != 0)
|
||||
return (error);
|
||||
if ((error = copyout(blue + start, cmap->blue, count)) != 0)
|
||||
return (error);
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
/* FBIOPUTCMAP: */
|
||||
static int cg2putcmap(fb, cmap)
|
||||
struct fbdevice *fb;
|
||||
struct fbcmap *cmap;
|
||||
{
|
||||
struct cg2_softc *sc = fb->fb_private;
|
||||
u_char red[CMSIZE], green[CMSIZE], blue[CMSIZE];
|
||||
int error, start, count, ecount;
|
||||
register u_int i;
|
||||
register u_short *p;
|
||||
|
||||
start = cmap->index;
|
||||
count = cmap->count;
|
||||
ecount = start + count;
|
||||
if (start >= CMSIZE || ecount > CMSIZE)
|
||||
return (EINVAL);
|
||||
|
||||
/* Copy from user space to local arrays. */
|
||||
if ((error = copyin(cmap->red, red + start, count)) != 0)
|
||||
return (error);
|
||||
if ((error = copyin(cmap->green, green + start, count)) != 0)
|
||||
return (error);
|
||||
if ((error = copyin(cmap->blue, blue + start, count)) != 0)
|
||||
return (error);
|
||||
|
||||
/* XXX - Wait for retrace? */
|
||||
|
||||
/* Copy from local arrays to hardware. */
|
||||
p = &sc->sc_ctlreg->redmap[start];
|
||||
for (i = start; i < ecount; i++)
|
||||
*p++ = red[i];
|
||||
p = &sc->sc_ctlreg->greenmap[start];
|
||||
for (i = start; i < ecount; i++)
|
||||
*p++ = green[i];
|
||||
p = &sc->sc_ctlreg->bluemap[start];
|
||||
for (i = start; i < ecount; i++)
|
||||
*p++ = blue[i];
|
||||
|
||||
return (0);
|
||||
|
||||
}
|
||||
|
||||
static int
|
||||
cg2intr(vsc)
|
||||
void *vsc;
|
||||
{
|
||||
struct cg2_softc *sc = vsc;
|
||||
|
||||
/* XXX - Just disable interrupts for now. */
|
||||
sc->sc_ctlreg->status.reg.inten = 0;
|
||||
|
||||
printf("cg2intr\n");
|
||||
return (1);
|
||||
}
|
||||
Loading…
Reference in New Issue