1*63294167Skettenis /* $OpenBSD: rfx.c,v 1.15 2022/07/15 17:57:27 kettenis Exp $ */
20dec6497Smiod
30dec6497Smiod /*
40dec6497Smiod * Copyright (c) 2004, Miodrag Vallat.
50dec6497Smiod * All rights reserved.
60dec6497Smiod *
70dec6497Smiod * Redistribution and use in source and binary forms, with or without
80dec6497Smiod * modification, are permitted provided that the following conditions
90dec6497Smiod * are met:
100dec6497Smiod * 1. Redistributions of source code must retain the above copyright
110dec6497Smiod * notice, this list of conditions and the following disclaimer.
120dec6497Smiod * 2. Redistributions in binary form must reproduce the above copyright
130dec6497Smiod * notice, this list of conditions and the following disclaimer in the
140dec6497Smiod * documentation and/or other materials provided with the distribution.
150dec6497Smiod *
160dec6497Smiod * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
170dec6497Smiod * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
180dec6497Smiod * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
190dec6497Smiod * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
200dec6497Smiod * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
210dec6497Smiod * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
220dec6497Smiod * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
230dec6497Smiod * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
240dec6497Smiod * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
250dec6497Smiod * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
260dec6497Smiod * POSSIBILITY OF SUCH DAMAGE.
270dec6497Smiod *
280dec6497Smiod */
290dec6497Smiod
300dec6497Smiod /*
310dec6497Smiod * Driver for the Vitec RasterFlex family of frame buffers.
320dec6497Smiod * It should support RasterFlex-24, RasterFlex-32 and RasterFlex-HR.
330dec6497Smiod */
340dec6497Smiod
350dec6497Smiod #include <sys/param.h>
360dec6497Smiod #include <sys/systm.h>
370dec6497Smiod #include <sys/buf.h>
380dec6497Smiod #include <sys/device.h>
390dec6497Smiod #include <sys/ioctl.h>
400dec6497Smiod #include <sys/malloc.h>
410dec6497Smiod #include <sys/mman.h>
420dec6497Smiod #include <sys/tty.h>
430dec6497Smiod #include <sys/conf.h>
440dec6497Smiod
450dec6497Smiod #include <uvm/uvm_extern.h>
460dec6497Smiod
470dec6497Smiod #include <machine/autoconf.h>
480dec6497Smiod #include <machine/pmap.h>
490dec6497Smiod #include <machine/cpu.h>
500dec6497Smiod #include <machine/conf.h>
510dec6497Smiod #include <machine/openfirm.h>
520dec6497Smiod
530dec6497Smiod #include <dev/wscons/wsconsio.h>
540dec6497Smiod #include <dev/wscons/wsdisplayvar.h>
550dec6497Smiod #include <dev/rasops/rasops.h>
560dec6497Smiod #include <machine/fbvar.h>
570dec6497Smiod
580dec6497Smiod #include <dev/sbus/sbusvar.h>
590dec6497Smiod
600dec6497Smiod #include <dev/ic/bt463reg.h>
610dec6497Smiod
620dec6497Smiod /*
630dec6497Smiod * Configuration structure
640dec6497Smiod */
650dec6497Smiod struct rfx_config {
660dec6497Smiod u_int16_t unknown;
670dec6497Smiod u_int16_t version;
680dec6497Smiod u_int32_t scanline;
690dec6497Smiod u_int32_t maxwidth; /* unsure */
700dec6497Smiod u_int32_t maxheight; /* unsure */
710dec6497Smiod u_int32_t width;
720dec6497Smiod u_int32_t height;
730dec6497Smiod };
740dec6497Smiod
750dec6497Smiod /*
760dec6497Smiod * In-memory offsets
770dec6497Smiod */
780dec6497Smiod
790dec6497Smiod #define RFX_RAMDAC_ADDR 0x00020000
800dec6497Smiod #define RFX_RAMDAC_SIZE 0x00000004
810dec6497Smiod
820dec6497Smiod #define RFX_CONTROL_ADDR 0x00040000
830dec6497Smiod #define RFX_CONTROL_SIZE 0x000000e0
840dec6497Smiod
850dec6497Smiod #define RFX_INIT_ADDR 0x00018000
860dec6497Smiod #define RFX_INIT_OFFSET 0x0000001c
870dec6497Smiod #define RFX_INIT_SIZE 0x00008000
880dec6497Smiod
890dec6497Smiod #define RFX_VRAM_ADDR 0x00100000
900dec6497Smiod
910dec6497Smiod /*
920dec6497Smiod * Control registers
930dec6497Smiod */
940dec6497Smiod
950dec6497Smiod #define RFX_VIDCTRL_REG 0x10
960dec6497Smiod #define RFX_VSYNC_ENABLE 0x00000001
970dec6497Smiod #define RFX_VIDEO_DISABLE 0x00000002
980dec6497Smiod
990dec6497Smiod /*
1000dec6497Smiod * Shadow colormap
1010dec6497Smiod */
1020dec6497Smiod struct rfx_cmap {
1030dec6497Smiod u_int8_t red[256];
1040dec6497Smiod u_int8_t green[256];
1050dec6497Smiod u_int8_t blue[256];
1060dec6497Smiod };
1070dec6497Smiod
1080dec6497Smiod struct rfx_softc {
1090dec6497Smiod struct sunfb sc_sunfb;
1100dec6497Smiod
1110dec6497Smiod bus_space_tag_t sc_bustag;
1120dec6497Smiod bus_addr_t sc_paddr;
1130dec6497Smiod
1140dec6497Smiod struct intrhand sc_ih;
1150dec6497Smiod
1160dec6497Smiod struct rfx_cmap sc_cmap;
1170dec6497Smiod volatile u_int8_t *sc_ramdac;
1180dec6497Smiod volatile u_int32_t *sc_ctrl;
1190dec6497Smiod
1200dec6497Smiod int sc_nscreens;
1210dec6497Smiod };
1220dec6497Smiod
1230dec6497Smiod void rfx_burner(void *, u_int, u_int);
1240dec6497Smiod int rfx_ioctl(void *, u_long, caddr_t, int, struct proc *);
1250dec6497Smiod paddr_t rfx_mmap(void *, off_t, int);
1260dec6497Smiod
1270dec6497Smiod int rfx_getcmap(struct rfx_cmap *, struct wsdisplay_cmap *);
1280dec6497Smiod int rfx_initialize(struct rfx_softc *, struct sbus_attach_args *,
1290dec6497Smiod struct rfx_config *);
1300dec6497Smiod int rfx_intr(void *);
1310dec6497Smiod void rfx_loadcmap(struct rfx_softc *, int, int);
1320dec6497Smiod int rfx_putcmap(struct rfx_cmap *, struct wsdisplay_cmap *);
1330dec6497Smiod void rfx_setcolor(void *, u_int, u_int8_t, u_int8_t, u_int8_t);
1340dec6497Smiod
1350dec6497Smiod struct wsdisplay_accessops rfx_accessops = {
13687eec248Smiod .ioctl = rfx_ioctl,
13787eec248Smiod .mmap = rfx_mmap,
13887eec248Smiod .burn_screen = rfx_burner
1390dec6497Smiod };
1400dec6497Smiod
1410dec6497Smiod int rfxmatch(struct device *, void *, void *);
1420dec6497Smiod void rfxattach(struct device *, struct device *, void *);
1430dec6497Smiod
14422e452dfSmpi const struct cfattach rfx_ca = {
1450dec6497Smiod sizeof (struct rfx_softc), rfxmatch, rfxattach
1460dec6497Smiod };
1470dec6497Smiod
1480dec6497Smiod struct cfdriver rfx_cd = {
1490dec6497Smiod NULL, "rfx", DV_DULL
1500dec6497Smiod };
1510dec6497Smiod
1520dec6497Smiod /*
1530dec6497Smiod * Match a supported RasterFlex card.
1540dec6497Smiod */
1550dec6497Smiod int
rfxmatch(struct device * parent,void * vcf,void * aux)1560dec6497Smiod rfxmatch(struct device *parent, void *vcf, void *aux)
1570dec6497Smiod {
1580dec6497Smiod struct sbus_attach_args *sa = aux;
1590dec6497Smiod const char *device = sa->sa_name;
1600dec6497Smiod
1610dec6497Smiod /* skip vendor name (could be CWARE, VITec, ...) */
1620dec6497Smiod while (*device != ',' && *device != '\0')
1630dec6497Smiod device++;
1640dec6497Smiod if (*device == '\0')
1650dec6497Smiod device = sa->sa_name;
1660dec6497Smiod else
1670dec6497Smiod device++;
1680dec6497Smiod
1690dec6497Smiod if (strncmp(device, "RasterFLEX", strlen("RasterFLEX")) != 0)
1700dec6497Smiod return (0);
1710dec6497Smiod
1720dec6497Smiod /* RasterVideo and RasterFlex-TV are frame grabbers */
1730dec6497Smiod if (strcmp(device, "RasterFLEX-TV") == 0)
1740dec6497Smiod return (0);
1750dec6497Smiod
1760dec6497Smiod return (1);
1770dec6497Smiod }
1780dec6497Smiod
1790dec6497Smiod /*
1800dec6497Smiod * Attach and initialize a rfx display, as well as a child wsdisplay.
1810dec6497Smiod */
1820dec6497Smiod void
rfxattach(struct device * parent,struct device * self,void * args)1830dec6497Smiod rfxattach(struct device *parent, struct device *self, void *args)
1840dec6497Smiod {
1850dec6497Smiod struct rfx_softc *sc = (struct rfx_softc *)self;
1860dec6497Smiod struct sbus_attach_args *sa = args;
1870dec6497Smiod const char *device = sa->sa_name;
1880dec6497Smiod struct rfx_config cf;
1890dec6497Smiod bus_space_tag_t bt;
1900dec6497Smiod bus_space_handle_t bh;
1910dec6497Smiod int node, cflen, isconsole = 0;
1920dec6497Smiod
1930dec6497Smiod /* skip vendor name (could be CWARE, VITec, ...) */
1940dec6497Smiod while (*device != ',' && *device != '\0')
1950dec6497Smiod device++;
1960dec6497Smiod if (*device == '\0')
1970dec6497Smiod device = sa->sa_name;
1980dec6497Smiod else
1990dec6497Smiod device++;
2000dec6497Smiod
2010dec6497Smiod printf(": %s", device);
2020dec6497Smiod
2030dec6497Smiod if (sa->sa_nreg == 0) {
2040dec6497Smiod printf("\n%s: no SBus registers!\n", self->dv_xname);
2050dec6497Smiod return;
2060dec6497Smiod }
2070dec6497Smiod
2080dec6497Smiod bt = sa->sa_bustag;
2090dec6497Smiod node = sa->sa_node;
2100dec6497Smiod isconsole = node == fbnode;
2110dec6497Smiod
2120dec6497Smiod /*
2130dec6497Smiod * Parse configuration structure
2140dec6497Smiod */
2150dec6497Smiod cflen = getproplen(node, "configuration");
2160dec6497Smiod if (cflen != sizeof cf) {
2170dec6497Smiod printf(", unknown %d bytes conf. structure", cflen);
2180dec6497Smiod /* fill in default values */
2190dec6497Smiod cf.version = 0;
2200dec6497Smiod cf.scanline = 2048;
2210dec6497Smiod cf.width = 1152;
2220dec6497Smiod cf.height = 900;
2230dec6497Smiod } else {
2240dec6497Smiod OF_getprop(node, "configuration", &cf, cflen);
2250dec6497Smiod printf(", revision %d", cf.version);
2260dec6497Smiod }
2270dec6497Smiod
2280dec6497Smiod /*
2290dec6497Smiod * Map registers
2300dec6497Smiod */
2310dec6497Smiod
2320dec6497Smiod sc->sc_bustag = bt;
2330dec6497Smiod sc->sc_paddr = sbus_bus_addr(bt, sa->sa_slot, sa->sa_offset);
2340dec6497Smiod
2350dec6497Smiod if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + RFX_RAMDAC_ADDR,
2360dec6497Smiod RFX_RAMDAC_SIZE, BUS_SPACE_MAP_LINEAR, 0, &bh) != 0) {
2370dec6497Smiod printf("\n%s: couldn't map ramdac registers\n", self->dv_xname);
2380dec6497Smiod return;
2390dec6497Smiod }
2400dec6497Smiod sc->sc_ramdac = (u_int8_t *)bus_space_vaddr(bt, bh);
2410dec6497Smiod
2420dec6497Smiod if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + RFX_CONTROL_ADDR,
2430dec6497Smiod RFX_CONTROL_SIZE, BUS_SPACE_MAP_LINEAR, 0, &bh) != 0) {
2440dec6497Smiod printf("\n%s: couldn't map control registers\n", self->dv_xname);
2450dec6497Smiod return;
2460dec6497Smiod }
2470dec6497Smiod sc->sc_ctrl = (u_int32_t *)bus_space_vaddr(bt, bh);
2480dec6497Smiod
2490dec6497Smiod #if 0 /* not yet */
2500dec6497Smiod sc->sc_ih.ih_fun = rfx_intr;
2510dec6497Smiod sc->sc_ih.ih_arg = sc;
2520dec6497Smiod intr_establish(ca->ca_ra.ra_intr[0].int_pri, &sc->sc_ih, IPL_FB);
2530dec6497Smiod #endif
2540dec6497Smiod
2550dec6497Smiod /*
2560dec6497Smiod * The following is an equivalent for
2570dec6497Smiod * fb_setsize(&sc->sc_sunfb, 8, cf.width, cf.height,
2580dec6497Smiod * node, ca->ca_bustype);
2590dec6497Smiod * forcing the correct scan line value. Since the usual frame buffer
2600dec6497Smiod * properties are missing on this card, no need to go through
2610dec6497Smiod * fb_setsize()...
2620dec6497Smiod */
2630dec6497Smiod sc->sc_sunfb.sf_depth = 8;
2640dec6497Smiod sc->sc_sunfb.sf_width = cf.width;
2650dec6497Smiod sc->sc_sunfb.sf_height = cf.height;
2660dec6497Smiod sc->sc_sunfb.sf_linebytes = cf.scanline;
2670dec6497Smiod sc->sc_sunfb.sf_fbsize = cf.height * cf.scanline;
2680dec6497Smiod
2690dec6497Smiod printf(", %dx%d\n", sc->sc_sunfb.sf_width, sc->sc_sunfb.sf_height);
2700dec6497Smiod
2710dec6497Smiod if (sbus_bus_map(bt, sa->sa_slot, sa->sa_offset + RFX_VRAM_ADDR,
2720dec6497Smiod round_page(sc->sc_sunfb.sf_fbsize), BUS_SPACE_MAP_LINEAR,
2730dec6497Smiod 0, &bh) != 0) {
2740dec6497Smiod printf("\n%s: couldn't map video memory\n", self->dv_xname);
2750dec6497Smiod return;
2760dec6497Smiod }
2770dec6497Smiod sc->sc_sunfb.sf_ro.ri_bits = bus_space_vaddr(bt, bh);
2780dec6497Smiod sc->sc_sunfb.sf_ro.ri_hw = sc;
2790dec6497Smiod
2800dec6497Smiod /*
2810dec6497Smiod * If we are not the console, the frame buffer has not been
282af52927aSmartynas * initialized by the PROM - do this ourselves.
2830dec6497Smiod */
2840dec6497Smiod if (!isconsole) {
2850dec6497Smiod if (rfx_initialize(sc, sa, &cf) != 0)
2860dec6497Smiod return;
2870dec6497Smiod }
2880dec6497Smiod
289607827a8Smiod fbwscons_init(&sc->sc_sunfb, 0, isconsole);
2900dec6497Smiod
2910dec6497Smiod bzero(&sc->sc_cmap, sizeof(sc->sc_cmap));
2920dec6497Smiod fbwscons_setcolormap(&sc->sc_sunfb, rfx_setcolor);
2930dec6497Smiod
294607827a8Smiod if (isconsole)
295aca70fa6Smiod fbwscons_console_init(&sc->sc_sunfb, -1);
2960dec6497Smiod
2970dec6497Smiod /* enable video */
2980dec6497Smiod rfx_burner(sc, 1, 0);
2990dec6497Smiod
300de9ae89dSmiod fbwscons_attach(&sc->sc_sunfb, &rfx_accessops, isconsole);
3010dec6497Smiod }
3020dec6497Smiod
3030dec6497Smiod /*
3040dec6497Smiod * Common wsdisplay operations
3050dec6497Smiod */
3060dec6497Smiod
3070dec6497Smiod int
rfx_ioctl(void * v,u_long cmd,caddr_t data,int flags,struct proc * p)3080dec6497Smiod rfx_ioctl(void *v, u_long cmd, caddr_t data, int flags, struct proc *p)
3090dec6497Smiod {
3100dec6497Smiod struct rfx_softc *sc = v;
3110dec6497Smiod struct wsdisplay_cmap *cm;
3120dec6497Smiod struct wsdisplay_fbinfo *wdf;
3130dec6497Smiod int error;
3140dec6497Smiod
3150dec6497Smiod switch (cmd) {
3160dec6497Smiod case WSDISPLAYIO_GTYPE:
3170dec6497Smiod *(u_int *)data = WSDISPLAY_TYPE_RFLEX;
3180dec6497Smiod break;
3190dec6497Smiod case WSDISPLAYIO_GINFO:
3200dec6497Smiod wdf = (struct wsdisplay_fbinfo *)data;
3210dec6497Smiod wdf->height = sc->sc_sunfb.sf_height;
3220dec6497Smiod wdf->width = sc->sc_sunfb.sf_width;
3230dec6497Smiod wdf->depth = sc->sc_sunfb.sf_depth;
324*63294167Skettenis wdf->stride = sc->sc_sunfb.sf_linebytes;
325*63294167Skettenis wdf->offset = 0;
3260dec6497Smiod wdf->cmsize = 256;
3270dec6497Smiod break;
3280dec6497Smiod case WSDISPLAYIO_LINEBYTES:
3290dec6497Smiod *(u_int *)data = sc->sc_sunfb.sf_linebytes;
3300dec6497Smiod break;
3310dec6497Smiod
3320dec6497Smiod case WSDISPLAYIO_GETCMAP:
3330dec6497Smiod cm = (struct wsdisplay_cmap *)data;
3340dec6497Smiod error = rfx_getcmap(&sc->sc_cmap, cm);
3350dec6497Smiod if (error != 0)
3360dec6497Smiod return (error);
3370dec6497Smiod break;
3380dec6497Smiod case WSDISPLAYIO_PUTCMAP:
3390dec6497Smiod cm = (struct wsdisplay_cmap *)data;
3400dec6497Smiod error = rfx_putcmap(&sc->sc_cmap, cm);
3410dec6497Smiod if (error != 0)
3420dec6497Smiod return (error);
3430dec6497Smiod rfx_loadcmap(sc, cm->index, cm->count);
3440dec6497Smiod break;
3450dec6497Smiod
346be74c466Smiod case WSDISPLAYIO_SVIDEO:
347be74c466Smiod case WSDISPLAYIO_GVIDEO:
348be74c466Smiod break;
349be74c466Smiod
3500dec6497Smiod default:
3510dec6497Smiod return (-1);
3520dec6497Smiod }
3530dec6497Smiod
3540dec6497Smiod return (0);
3550dec6497Smiod }
3560dec6497Smiod
3570dec6497Smiod paddr_t
rfx_mmap(void * v,off_t offset,int prot)3580dec6497Smiod rfx_mmap(void *v, off_t offset, int prot)
3590dec6497Smiod {
3600dec6497Smiod struct rfx_softc *sc = v;
3610dec6497Smiod
3620dec6497Smiod if (offset & PGOFSET)
3630dec6497Smiod return (-1);
3640dec6497Smiod
3650dec6497Smiod if (offset >= 0 && offset < sc->sc_sunfb.sf_fbsize) {
3660dec6497Smiod return (bus_space_mmap(sc->sc_bustag, sc->sc_paddr,
3670dec6497Smiod RFX_VRAM_ADDR + offset, prot, BUS_SPACE_MAP_LINEAR));
3680dec6497Smiod }
3690dec6497Smiod
3700dec6497Smiod return (-1);
3710dec6497Smiod }
3720dec6497Smiod
3730dec6497Smiod void
rfx_burner(void * v,u_int on,u_int flags)3740dec6497Smiod rfx_burner(void *v, u_int on, u_int flags)
3750dec6497Smiod {
3760dec6497Smiod struct rfx_softc *sc = v;
3770dec6497Smiod
3780dec6497Smiod if (on) {
3790dec6497Smiod sc->sc_ctrl[RFX_VIDCTRL_REG] &= ~RFX_VIDEO_DISABLE;
3800dec6497Smiod sc->sc_ctrl[RFX_VIDCTRL_REG] |= RFX_VSYNC_ENABLE;
3810dec6497Smiod } else {
3820dec6497Smiod sc->sc_ctrl[RFX_VIDCTRL_REG] |= RFX_VIDEO_DISABLE;
3830dec6497Smiod if (flags & WSDISPLAY_BURN_VBLANK)
3840dec6497Smiod sc->sc_ctrl[RFX_VIDCTRL_REG] &= ~RFX_VSYNC_ENABLE;
3850dec6497Smiod }
3860dec6497Smiod }
3870dec6497Smiod
3880dec6497Smiod /*
3890dec6497Smiod * Colormap helper functions
3900dec6497Smiod */
3910dec6497Smiod
3920dec6497Smiod void
rfx_setcolor(void * v,u_int index,u_int8_t r,u_int8_t g,u_int8_t b)3930dec6497Smiod rfx_setcolor(void *v, u_int index, u_int8_t r, u_int8_t g, u_int8_t b)
3940dec6497Smiod {
3950dec6497Smiod struct rfx_softc *sc = v;
3960dec6497Smiod
3970dec6497Smiod sc->sc_cmap.red[index] = r;
3980dec6497Smiod sc->sc_cmap.green[index] = g;
3990dec6497Smiod sc->sc_cmap.blue[index] = b;
4000dec6497Smiod
4010dec6497Smiod rfx_loadcmap(sc, index, 1);
4020dec6497Smiod }
4030dec6497Smiod
4040dec6497Smiod int
rfx_getcmap(struct rfx_cmap * cm,struct wsdisplay_cmap * rcm)4050dec6497Smiod rfx_getcmap(struct rfx_cmap *cm, struct wsdisplay_cmap *rcm)
4060dec6497Smiod {
4070dec6497Smiod u_int index = rcm->index, count = rcm->count;
4080dec6497Smiod int error;
4090dec6497Smiod
4100dec6497Smiod if (index >= 256 || count > 256 - index)
4110dec6497Smiod return (EINVAL);
4120dec6497Smiod
4130dec6497Smiod if ((error = copyout(cm->red + index, rcm->red, count)) != 0)
4140dec6497Smiod return (error);
4150dec6497Smiod if ((error = copyout(cm->green + index, rcm->green, count)) != 0)
4160dec6497Smiod return (error);
4170dec6497Smiod if ((error = copyout(cm->blue + index, rcm->blue, count)) != 0)
4180dec6497Smiod return (error);
4190dec6497Smiod
4200dec6497Smiod return (0);
4210dec6497Smiod }
4220dec6497Smiod
4230dec6497Smiod int
rfx_putcmap(struct rfx_cmap * cm,struct wsdisplay_cmap * rcm)4240dec6497Smiod rfx_putcmap(struct rfx_cmap *cm, struct wsdisplay_cmap *rcm)
4250dec6497Smiod {
4260dec6497Smiod u_int index = rcm->index, count = rcm->count;
4270dec6497Smiod u_int8_t red[256], green[256], blue[256];
4280dec6497Smiod int error;
4290dec6497Smiod
4300dec6497Smiod if (index >= 256 || count > 256 - index)
4310dec6497Smiod return (EINVAL);
4320dec6497Smiod
4330dec6497Smiod if ((error = copyin(rcm->red, red, count)) != 0)
4340dec6497Smiod return (error);
4350dec6497Smiod if ((error = copyin(rcm->green, green, count)) != 0)
4360dec6497Smiod return (error);
4370dec6497Smiod if ((error = copyin(rcm->blue, blue, count)) != 0)
4380dec6497Smiod return (error);
4390dec6497Smiod
4400dec6497Smiod bcopy(red, cm->red + index, count);
4410dec6497Smiod bcopy(green, cm->green + index, count);
4420dec6497Smiod bcopy(blue, cm->blue + index, count);
4430dec6497Smiod
4440dec6497Smiod return (0);
4450dec6497Smiod }
4460dec6497Smiod
4470dec6497Smiod void
rfx_loadcmap(struct rfx_softc * sc,int start,int ncolors)4480dec6497Smiod rfx_loadcmap(struct rfx_softc *sc, int start, int ncolors)
4490dec6497Smiod {
4500dec6497Smiod u_int8_t *r, *g, *b;
4510dec6497Smiod
4520dec6497Smiod r = sc->sc_cmap.red + start;
4530dec6497Smiod g = sc->sc_cmap.green + start;
4540dec6497Smiod b = sc->sc_cmap.blue + start;
4550dec6497Smiod
4560dec6497Smiod start += BT463_IREG_CPALETTE_RAM;
4570dec6497Smiod sc->sc_ramdac[BT463_REG_ADDR_LOW] = start & 0xff;
4580dec6497Smiod sc->sc_ramdac[BT463_REG_ADDR_HIGH] = (start >> 8) & 0xff;
4590dec6497Smiod
4600dec6497Smiod while (ncolors-- != 0) {
4610dec6497Smiod sc->sc_ramdac[BT463_REG_CMAP_DATA] = *r++;
4620dec6497Smiod sc->sc_ramdac[BT463_REG_CMAP_DATA] = *g++;
4630dec6497Smiod sc->sc_ramdac[BT463_REG_CMAP_DATA] = *b++;
4640dec6497Smiod }
4650dec6497Smiod }
4660dec6497Smiod
4670dec6497Smiod /*
4680dec6497Smiod * Initialization code parser
4690dec6497Smiod */
4700dec6497Smiod
4710dec6497Smiod int
rfx_initialize(struct rfx_softc * sc,struct sbus_attach_args * sa,struct rfx_config * cf)4720dec6497Smiod rfx_initialize(struct rfx_softc *sc, struct sbus_attach_args *sa,
4730dec6497Smiod struct rfx_config *cf)
4740dec6497Smiod {
4750dec6497Smiod u_int32_t *data, offset, value;
4760dec6497Smiod size_t cnt;
4770dec6497Smiod bus_space_handle_t bh;
4780dec6497Smiod int error;
4790dec6497Smiod
4800dec6497Smiod /*
4810dec6497Smiod * Map the initialization data
4820dec6497Smiod */
4830dec6497Smiod if ((error = sbus_bus_map(sa->sa_bustag, sa->sa_slot, sa->sa_offset +
4840dec6497Smiod RFX_INIT_ADDR, RFX_INIT_SIZE, BUS_SPACE_MAP_LINEAR, 0, &bh)) != 0) {
4850dec6497Smiod printf("\n%s: couldn't map initialization data\n",
4860dec6497Smiod sc->sc_sunfb.sf_dev.dv_xname);
4870dec6497Smiod return error;
4880dec6497Smiod }
4890dec6497Smiod data = (u_int32_t *)bus_space_vaddr(sa->sa_bustag, bh);
4900dec6497Smiod
4910dec6497Smiod /*
4920dec6497Smiod * Skip copyright notice
4930dec6497Smiod */
4940dec6497Smiod data += RFX_INIT_OFFSET / sizeof(u_int32_t);
49585f6b51aSmiod cnt = (RFX_INIT_SIZE - RFX_INIT_OFFSET) / sizeof(u_int32_t);
4960dec6497Smiod cnt >>= 1;
4970dec6497Smiod
4980dec6497Smiod /*
4990dec6497Smiod * Parse and apply settings
5000dec6497Smiod */
5010dec6497Smiod while (cnt != 0) {
5020dec6497Smiod offset = *data++;
5030dec6497Smiod value = *data++;
5040dec6497Smiod
5050dec6497Smiod if (offset == (u_int32_t)-1 && value == (u_int32_t)-1)
5060dec6497Smiod break;
5070dec6497Smiod
5080dec6497Smiod /* Old PROM are little-endian */
5090dec6497Smiod if (cf->version <= 1) {
5100dec6497Smiod offset = letoh32(offset);
5110dec6497Smiod value = letoh32(offset);
5120dec6497Smiod }
5130dec6497Smiod
51461e87b28Sderaadt if (offset & (1U << 31)) {
51561e87b28Sderaadt offset = (offset & ~(1U << 31)) - RFX_RAMDAC_ADDR;
5160dec6497Smiod if (offset < RFX_RAMDAC_SIZE)
5170dec6497Smiod sc->sc_ramdac[offset] = value >> 24;
5180dec6497Smiod } else {
5190dec6497Smiod offset -= RFX_CONTROL_ADDR;
5200dec6497Smiod if (offset < RFX_CONTROL_SIZE)
5210dec6497Smiod sc->sc_ctrl[offset >> 2] = value;
5220dec6497Smiod }
5230dec6497Smiod
5240dec6497Smiod cnt--;
5250dec6497Smiod }
5260dec6497Smiod
5270dec6497Smiod #ifdef DEBUG
52885f6b51aSmiod if (cnt != 0)
52938b3dfb7Sjsg printf("%s: incoherent initialization data!\n",
53038b3dfb7Sjsg sc->sc_sunfb.sf_dev.dv_xname);
5310dec6497Smiod #endif
5320dec6497Smiod
5330dec6497Smiod bus_space_unmap(sa->sa_bustag, bh, RFX_INIT_SIZE);
5340dec6497Smiod
5350dec6497Smiod return 0;
5360dec6497Smiod }
537