agten.c revision 1.2 1 1.2 macallan /* $NetBSD: agten.c,v 1.2 2007/08/26 07:24:28 macallan Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.1 macallan * Copyright (c) 2007 Michael Lorenz
5 1.1 macallan * All rights reserved.
6 1.1 macallan *
7 1.1 macallan * Redistribution and use in source and binary forms, with or without
8 1.1 macallan * modification, are permitted provided that the following conditions
9 1.1 macallan * are met:
10 1.1 macallan * 1. Redistributions of source code must retain the above copyright
11 1.1 macallan * notice, this list of conditions and the following disclaimer.
12 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 macallan * notice, this list of conditions and the following disclaimer in the
14 1.1 macallan * documentation and/or other materials provided with the distribution.
15 1.1 macallan * 3. Neither the name of The NetBSD Foundation nor the names of its
16 1.1 macallan * contributors may be used to endorse or promote products derived
17 1.1 macallan * from this software without specific prior written permission.
18 1.1 macallan *
19 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 macallan * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 macallan * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 macallan * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 macallan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 macallan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 macallan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 macallan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 macallan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 macallan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 macallan * POSSIBILITY OF SUCH DAMAGE.
30 1.1 macallan */
31 1.1 macallan
32 1.1 macallan #include <sys/cdefs.h>
33 1.2 macallan __KERNEL_RCSID(0, "$NetBSD: agten.c,v 1.2 2007/08/26 07:24:28 macallan Exp $");
34 1.1 macallan
35 1.1 macallan /*
36 1.1 macallan * a driver for the Fujitsu AG-10e SBus framebuffer
37 1.1 macallan *
38 1.1 macallan * this thing is Frankenstein's Monster among graphics boards.
39 1.1 macallan * it contains three graphics chips:
40 1.1 macallan * a GLint - 24bit stuff, double-buffered
41 1.1 macallan * an Imagine 128 which provides an 8bit overlay
42 1.1 macallan * a Weitek P9100 which provides WIDs
43 1.1 macallan * so here we need to mess only with the P9100 and the I128 - for X we just
44 1.1 macallan * hide the overlay and let the Xserver mess with the GLint
45 1.1 macallan */
46 1.1 macallan
47 1.1 macallan #include <sys/param.h>
48 1.1 macallan #include <sys/systm.h>
49 1.1 macallan #include <sys/kernel.h>
50 1.1 macallan #include <sys/device.h>
51 1.1 macallan #include <sys/proc.h>
52 1.1 macallan #include <sys/mutex.h>
53 1.1 macallan #include <sys/ioctl.h>
54 1.1 macallan #include <sys/kernel.h>
55 1.1 macallan #include <sys/systm.h>
56 1.1 macallan #include <sys/malloc.h>
57 1.1 macallan
58 1.1 macallan #include <dev/sun/fbio.h>
59 1.1 macallan #include <dev/sun/fbvar.h>
60 1.1 macallan #include <dev/sun/btreg.h>
61 1.1 macallan #include <dev/sun/btvar.h>
62 1.1 macallan
63 1.1 macallan #include <machine/bus.h>
64 1.1 macallan #include <machine/autoconf.h>
65 1.1 macallan
66 1.1 macallan #include <dev/sbus/sbusvar.h>
67 1.1 macallan
68 1.1 macallan #include <dev/wscons/wsconsio.h>
69 1.1 macallan #include <dev/wscons/wsdisplayvar.h>
70 1.1 macallan #include <dev/rasops/rasops.h>
71 1.1 macallan #include <dev/wsfont/wsfont.h>
72 1.1 macallan
73 1.1 macallan #include <dev/wscons/wsdisplay_vconsvar.h>
74 1.1 macallan
75 1.1 macallan #include <dev/sbus/p9100reg.h>
76 1.1 macallan #include <dev/ic/ibm561reg.h>
77 1.1 macallan #include <dev/ic/i128reg.h>
78 1.1 macallan #include <dev/ic/i128var.h>
79 1.1 macallan
80 1.1 macallan #include "opt_agten.h"
81 1.1 macallan
82 1.1 macallan static int agten_match(struct device *, struct cfdata *, void *);
83 1.1 macallan static void agten_attach(struct device *, struct device *, void *);
84 1.1 macallan
85 1.1 macallan #if 0
86 1.1 macallan static void agten_unblank(struct device *);
87 1.1 macallan #endif
88 1.1 macallan
89 1.1 macallan static int agten_ioctl(void *, void *, u_long, void *, int, struct lwp *);
90 1.1 macallan static paddr_t agten_mmap(void *, void *, off_t, int);
91 1.1 macallan static void agten_init_screen(void *, struct vcons_screen *, int, long *);
92 1.1 macallan
93 1.1 macallan struct agten_softc {
94 1.1 macallan struct device sc_dev; /* base device */
95 1.1 macallan struct sbusdev sc_sd; /* sbus device */
96 1.1 macallan struct fbdevice sc_fb; /* frame buffer device */
97 1.1 macallan
98 1.1 macallan struct vcons_screen sc_console_screen;
99 1.1 macallan struct wsscreen_descr sc_defaultscreen_descr;
100 1.1 macallan const struct wsscreen_descr *sc_screens[1];
101 1.1 macallan struct wsscreen_list sc_screenlist;
102 1.1 macallan
103 1.1 macallan bus_space_tag_t sc_bustag;
104 1.1 macallan
105 1.1 macallan bus_space_handle_t sc_i128_fbh;
106 1.1 macallan bus_size_t sc_i128_fbsz;
107 1.1 macallan bus_space_handle_t sc_i128_regh;
108 1.1 macallan bus_space_handle_t sc_p9100_regh;
109 1.1 macallan
110 1.1 macallan uint32_t sc_width;
111 1.1 macallan uint32_t sc_height; /* panel width / height */
112 1.1 macallan uint32_t sc_stride;
113 1.1 macallan uint32_t sc_depth;
114 1.1 macallan
115 1.1 macallan union bt_cmap sc_cmap; /* Brooktree color map */
116 1.1 macallan
117 1.1 macallan int sc_mode;
118 1.1 macallan int sc_video, sc_powerstate;
119 1.1 macallan uint32_t sc_bg;
120 1.1 macallan struct vcons_data vd;
121 1.1 macallan };
122 1.1 macallan
123 1.1 macallan CFATTACH_DECL(agten, sizeof(struct agten_softc),
124 1.1 macallan agten_match, agten_attach, NULL, NULL);
125 1.1 macallan
126 1.1 macallan
127 1.1 macallan static int agten_putcmap(struct agten_softc *, struct wsdisplay_cmap *);
128 1.1 macallan static int agten_getcmap(struct agten_softc *, struct wsdisplay_cmap *);
129 1.1 macallan static int agten_putpalreg(struct agten_softc *, uint8_t, uint8_t,
130 1.1 macallan uint8_t, uint8_t);
131 1.1 macallan static void agten_init(struct agten_softc *);
132 1.1 macallan
133 1.1 macallan static void agten_copycols(void *, int, int, int, int);
134 1.1 macallan static void agten_erasecols(void *, int, int, int, long);
135 1.1 macallan static void agten_copyrows(void *, int, int, int);
136 1.1 macallan static void agten_eraserows(void *, int, int, long);
137 1.1 macallan
138 1.1 macallan extern const u_char rasops_cmap[768];
139 1.1 macallan
140 1.1 macallan struct wsdisplay_accessops agten_accessops = {
141 1.1 macallan agten_ioctl,
142 1.1 macallan agten_mmap,
143 1.1 macallan NULL, /* alloc_screen */
144 1.1 macallan NULL, /* free_screen */
145 1.1 macallan NULL, /* show_screen */
146 1.1 macallan NULL, /* load_font */
147 1.1 macallan NULL, /* pollc */
148 1.1 macallan NULL /* scroll */
149 1.1 macallan };
150 1.1 macallan
151 1.1 macallan static inline void
152 1.1 macallan agten_write_dac(struct agten_softc *sc, int reg, uint8_t val)
153 1.1 macallan {
154 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
155 1.1 macallan 0x200 + (reg << 2), (uint32_t)val << 16);
156 1.1 macallan }
157 1.1 macallan
158 1.1 macallan static inline void
159 1.1 macallan agten_write_idx(struct agten_softc *sc, int offset)
160 1.1 macallan {
161 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
162 1.1 macallan 0x200 + (IBM561_ADDR_LOW << 2), (offset & 0xff) << 16);
163 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh,
164 1.1 macallan 0x200 + (IBM561_ADDR_HIGH << 2), ((offset >> 8) & 0xff) << 16);
165 1.1 macallan }
166 1.1 macallan
167 1.1 macallan static inline void
168 1.1 macallan agten_write_dac_10(struct agten_softc *sc, int reg, uint16_t val)
169 1.1 macallan {
170 1.1 macallan agten_write_dac(sc, reg, (val >> 2) & 0xff);
171 1.1 macallan agten_write_dac(sc, reg, (val & 0x3) << 6);
172 1.1 macallan }
173 1.1 macallan
174 1.1 macallan static int
175 1.1 macallan agten_match(struct device *dev, struct cfdata *cf, void *aux)
176 1.1 macallan {
177 1.1 macallan struct sbus_attach_args *sa = aux;
178 1.1 macallan
179 1.1 macallan if (strcmp("PFU,aga", sa->sa_name) == 0)
180 1.1 macallan return 100;
181 1.1 macallan return 0;
182 1.1 macallan }
183 1.1 macallan
184 1.1 macallan static void
185 1.1 macallan agten_attach(struct device *parent, struct device *dev, void *aux)
186 1.1 macallan {
187 1.1 macallan struct agten_softc *sc = (struct agten_softc *)dev;
188 1.1 macallan struct sbus_attach_args *sa = aux;
189 1.1 macallan struct fbdevice *fb = &sc->sc_fb;
190 1.1 macallan struct wsemuldisplaydev_attach_args aa;
191 1.1 macallan struct rasops_info *ri;
192 1.1 macallan long defattr;
193 1.1 macallan uint32_t reg;
194 1.1 macallan int node = sa->sa_node;
195 1.1 macallan int console;
196 1.1 macallan
197 1.1 macallan sc->sc_defaultscreen_descr = (struct wsscreen_descr){
198 1.1 macallan "default",
199 1.1 macallan 0, 0,
200 1.1 macallan NULL,
201 1.1 macallan 8, 16,
202 1.1 macallan WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
203 1.1 macallan NULL
204 1.1 macallan };
205 1.1 macallan sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
206 1.1 macallan sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
207 1.1 macallan sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
208 1.1 macallan sc->sc_bustag = sa->sa_bustag;
209 1.1 macallan #if 0
210 1.1 macallan sc->sc_shadowfb = malloc(sc->sc_fbsize, M_DEVBUF, M_WAITOK);
211 1.1 macallan
212 1.1 macallan dict = device_properties(&sc->sc_dev);
213 1.1 macallan
214 1.1 macallan prop_dictionary_get_bool(dict, "is_console", &console);
215 1.1 macallan #endif
216 1.1 macallan
217 1.1 macallan reg = prom_getpropint(node, "i128_fb_physaddr", -1);
218 1.1 macallan sc->sc_i128_fbsz = prom_getpropint(node, "i128_fb_size", -1);
219 1.1 macallan if (sbus_bus_map(sc->sc_bustag,
220 1.1 macallan sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
221 1.1 macallan sc->sc_i128_fbsz, BUS_SPACE_MAP_LINEAR, &sc->sc_i128_fbh) != 0) {
222 1.1 macallan
223 1.1 macallan aprint_error("%s: unable to map the framebuffer\n",
224 1.1 macallan dev->dv_xname);
225 1.1 macallan return;
226 1.1 macallan }
227 1.1 macallan fb->fb_pixels = bus_space_vaddr(sc->sc_bustag, sc->sc_i128_fbh);
228 1.1 macallan
229 1.1 macallan reg = prom_getpropint(node, "p9100_reg_physaddr", -1);
230 1.1 macallan if (sbus_bus_map(sc->sc_bustag,
231 1.1 macallan sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
232 1.1 macallan 0x8000, 0, &sc->sc_p9100_regh) != 0) {
233 1.1 macallan
234 1.1 macallan aprint_error("%s: unable to map P9100 registers\n",
235 1.1 macallan dev->dv_xname);
236 1.1 macallan return;
237 1.1 macallan }
238 1.1 macallan
239 1.1 macallan reg = prom_getpropint(node, "i128_reg_physaddr", -1);
240 1.1 macallan if (sbus_bus_map(sc->sc_bustag,
241 1.1 macallan sa->sa_reg[0].oa_space, sa->sa_reg[0].oa_base + reg,
242 1.1 macallan 0x10000, 0, &sc->sc_i128_regh) != 0) {
243 1.1 macallan
244 1.1 macallan aprint_error("%s: unable to map I128 registers\n",
245 1.1 macallan dev->dv_xname);
246 1.1 macallan return;
247 1.1 macallan }
248 1.2 macallan
249 1.1 macallan sbus_establish(&sc->sc_sd, &sc->sc_dev);
250 1.1 macallan #if 0
251 1.1 macallan bus_intr_establish(sc->sc_bustag, sa->sa_pri, IPL_BIO,
252 1.1 macallan agten_intr, sc);
253 1.1 macallan #endif
254 1.1 macallan
255 1.1 macallan sc->sc_width = prom_getpropint(node, "ffb_width", 800);
256 1.1 macallan sc->sc_height = prom_getpropint(node, "ffb_height", 600);
257 1.1 macallan sc->sc_depth = prom_getpropint(node, "ffb_depth", 8);
258 1.1 macallan sc->sc_stride = sc->sc_width * (sc->sc_depth >> 3);
259 1.1 macallan
260 1.1 macallan agten_init(sc);
261 1.1 macallan
262 1.1 macallan console = fb_is_console(node);
263 1.1 macallan
264 1.1 macallan vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
265 1.1 macallan &agten_accessops);
266 1.1 macallan sc->vd.init_screen = agten_init_screen;
267 1.1 macallan
268 1.1 macallan ri = &sc->sc_console_screen.scr_ri;
269 1.1 macallan
270 1.1 macallan if (console) {
271 1.1 macallan vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
272 1.1 macallan &defattr);
273 1.1 macallan sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
274 1.1 macallan
275 1.1 macallan sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
276 1.1 macallan sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
277 1.1 macallan sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
278 1.1 macallan sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
279 1.1 macallan wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
280 1.1 macallan defattr);
281 1.2 macallan i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, 0, 0,
282 1.2 macallan sc->sc_width, sc->sc_height,
283 1.2 macallan ri->ri_devcmap[(defattr >> 16) & 0xff]);
284 1.1 macallan } else {
285 1.1 macallan /*
286 1.1 macallan * since we're not the console we can postpone the rest
287 1.1 macallan * until someone actually allocates a screen for us
288 1.1 macallan */
289 1.1 macallan }
290 1.1 macallan
291 1.1 macallan /* Initialize the default color map. */
292 1.1 macallan
293 1.1 macallan aa.console = console;
294 1.1 macallan aa.scrdata = &sc->sc_screenlist;
295 1.1 macallan aa.accessops = &agten_accessops;
296 1.1 macallan aa.accesscookie = &sc->vd;
297 1.1 macallan
298 1.1 macallan config_found(&sc->sc_dev, &aa, wsemuldisplaydevprint);
299 1.1 macallan }
300 1.1 macallan
301 1.1 macallan static int
302 1.1 macallan agten_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
303 1.1 macallan struct lwp *l)
304 1.1 macallan {
305 1.1 macallan struct vcons_data *vd = v;
306 1.1 macallan struct agten_softc *sc = vd->cookie;
307 1.1 macallan struct wsdisplay_fbinfo *wdf;
308 1.1 macallan struct vcons_screen *ms = vd->active;
309 1.1 macallan
310 1.1 macallan switch (cmd) {
311 1.1 macallan
312 1.1 macallan case WSDISPLAYIO_GINFO:
313 1.1 macallan if (ms == NULL)
314 1.1 macallan return ENODEV;
315 1.1 macallan wdf = (void *)data;
316 1.1 macallan wdf->height = ms->scr_ri.ri_height;
317 1.1 macallan wdf->width = ms->scr_ri.ri_width;
318 1.1 macallan wdf->depth = ms->scr_ri.ri_depth;
319 1.1 macallan wdf->cmsize = 256;
320 1.1 macallan return 0;
321 1.1 macallan
322 1.1 macallan case WSDISPLAYIO_GETCMAP:
323 1.1 macallan return agten_getcmap(sc,
324 1.1 macallan (struct wsdisplay_cmap *)data);
325 1.1 macallan
326 1.1 macallan case WSDISPLAYIO_PUTCMAP:
327 1.1 macallan return agten_putcmap(sc,
328 1.1 macallan (struct wsdisplay_cmap *)data);
329 1.1 macallan
330 1.1 macallan case WSDISPLAYIO_LINEBYTES:
331 1.1 macallan *(u_int *)data = sc->sc_stride;
332 1.1 macallan return 0;
333 1.1 macallan
334 1.1 macallan case WSDISPLAYIO_SMODE:
335 1.1 macallan {
336 1.1 macallan int new_mode = *(int*)data;
337 1.1 macallan if (new_mode != sc->sc_mode) {
338 1.1 macallan sc->sc_mode = new_mode;
339 1.1 macallan if(new_mode == WSDISPLAYIO_MODE_EMUL) {
340 1.2 macallan agten_init(sc);
341 1.1 macallan vcons_redraw_screen(ms);
342 1.1 macallan }
343 1.1 macallan }
344 1.1 macallan }
345 1.1 macallan return 0;
346 1.1 macallan }
347 1.1 macallan return EPASSTHROUGH;
348 1.1 macallan }
349 1.1 macallan
350 1.1 macallan static paddr_t
351 1.1 macallan agten_mmap(void *v, void *vs, off_t offset, int prot)
352 1.1 macallan {
353 1.1 macallan struct vcons_data *vd = v;
354 1.1 macallan struct agten_softc *sc = vd->cookie;
355 1.1 macallan
356 1.1 macallan if (offset < sc->sc_i128_fbsz)
357 1.1 macallan return bus_space_mmap(sc->sc_bustag, sc->sc_i128_fbh, offset,
358 1.1 macallan prot, BUS_SPACE_MAP_LINEAR);
359 1.1 macallan return -1;
360 1.1 macallan }
361 1.1 macallan
362 1.1 macallan static void
363 1.1 macallan agten_init_screen(void *cookie, struct vcons_screen *scr,
364 1.1 macallan int existing, long *defattr)
365 1.1 macallan {
366 1.1 macallan struct agten_softc *sc = cookie;
367 1.1 macallan struct rasops_info *ri = &scr->scr_ri;
368 1.1 macallan
369 1.1 macallan ri->ri_depth = sc->sc_depth;
370 1.1 macallan ri->ri_width = sc->sc_width;
371 1.1 macallan ri->ri_height = sc->sc_height;
372 1.1 macallan ri->ri_stride = sc->sc_stride;
373 1.1 macallan ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
374 1.1 macallan
375 1.1 macallan ri->ri_bits = (char *)sc->sc_fb.fb_pixels;
376 1.1 macallan
377 1.1 macallan if (existing) {
378 1.1 macallan ri->ri_flg |= RI_CLEAR;
379 1.1 macallan }
380 1.1 macallan
381 1.1 macallan rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
382 1.1 macallan ri->ri_caps = WSSCREEN_WSCOLORS;
383 1.1 macallan
384 1.1 macallan rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
385 1.1 macallan sc->sc_width / ri->ri_font->fontwidth);
386 1.1 macallan
387 1.1 macallan ri->ri_hw = scr;
388 1.1 macallan ri->ri_ops.copyrows = agten_copyrows;
389 1.1 macallan ri->ri_ops.eraserows = agten_eraserows;
390 1.1 macallan ri->ri_ops.copycols = agten_copycols;
391 1.1 macallan ri->ri_ops.erasecols = agten_erasecols;
392 1.1 macallan
393 1.1 macallan }
394 1.1 macallan
395 1.1 macallan static int
396 1.1 macallan agten_putcmap(struct agten_softc *sc, struct wsdisplay_cmap *cm)
397 1.1 macallan {
398 1.1 macallan u_int index = cm->index;
399 1.1 macallan u_int count = cm->count;
400 1.1 macallan int i, error;
401 1.1 macallan u_char rbuf[256], gbuf[256], bbuf[256];
402 1.1 macallan u_char *r, *g, *b;
403 1.1 macallan
404 1.1 macallan if (cm->index >= 256 || cm->count > 256 ||
405 1.1 macallan (cm->index + cm->count) > 256)
406 1.1 macallan return EINVAL;
407 1.1 macallan error = copyin(cm->red, &rbuf[index], count);
408 1.1 macallan if (error)
409 1.1 macallan return error;
410 1.1 macallan error = copyin(cm->green, &gbuf[index], count);
411 1.1 macallan if (error)
412 1.1 macallan return error;
413 1.1 macallan error = copyin(cm->blue, &bbuf[index], count);
414 1.1 macallan if (error)
415 1.1 macallan return error;
416 1.1 macallan
417 1.1 macallan r = &rbuf[index];
418 1.1 macallan g = &gbuf[index];
419 1.1 macallan b = &bbuf[index];
420 1.1 macallan
421 1.1 macallan for (i = 0; i < count; i++) {
422 1.1 macallan agten_putpalreg(sc, index, *r, *g, *b);
423 1.1 macallan index++;
424 1.1 macallan r++, g++, b++;
425 1.1 macallan }
426 1.1 macallan return 0;
427 1.1 macallan }
428 1.1 macallan
429 1.1 macallan static int
430 1.1 macallan agten_getcmap(struct agten_softc *sc, struct wsdisplay_cmap *cm)
431 1.1 macallan {
432 1.1 macallan u_int index = cm->index;
433 1.1 macallan u_int count = cm->count;
434 1.1 macallan int error, i;
435 1.1 macallan uint8_t red[256], green[256], blue[256];
436 1.1 macallan
437 1.1 macallan if (index >= 255 || count > 256 || index + count > 256)
438 1.1 macallan return EINVAL;
439 1.1 macallan
440 1.1 macallan i = index;
441 1.1 macallan while (i < (index + count)) {
442 1.1 macallan red[i] = sc->sc_cmap.cm_map[i][0];
443 1.1 macallan green[i] = sc->sc_cmap.cm_map[i][1];
444 1.1 macallan blue[i] = sc->sc_cmap.cm_map[i][2];
445 1.1 macallan i++;
446 1.1 macallan }
447 1.1 macallan error = copyout(&red[index], cm->red, count);
448 1.1 macallan if (error)
449 1.1 macallan return error;
450 1.1 macallan error = copyout(&green[index], cm->green, count);
451 1.1 macallan if (error)
452 1.1 macallan return error;
453 1.1 macallan error = copyout(&blue[index], cm->blue, count);
454 1.1 macallan if (error)
455 1.1 macallan return error;
456 1.1 macallan
457 1.1 macallan return 0;
458 1.1 macallan }
459 1.1 macallan
460 1.1 macallan static int
461 1.1 macallan agten_putpalreg(struct agten_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
462 1.1 macallan uint8_t b)
463 1.1 macallan {
464 1.1 macallan
465 1.1 macallan sc->sc_cmap.cm_map[idx][0] = r;
466 1.1 macallan sc->sc_cmap.cm_map[idx][1] = g;
467 1.1 macallan sc->sc_cmap.cm_map[idx][2] = b;
468 1.1 macallan agten_write_idx(sc, IBM561_CMAP_TABLE + idx);
469 1.1 macallan agten_write_dac(sc, IBM561_CMD_CMAP, r);
470 1.1 macallan agten_write_dac(sc, IBM561_CMD_CMAP, g);
471 1.1 macallan agten_write_dac(sc, IBM561_CMD_CMAP, b);
472 1.1 macallan return 0;
473 1.1 macallan }
474 1.1 macallan
475 1.1 macallan static void
476 1.1 macallan agten_init(struct agten_softc *sc)
477 1.1 macallan {
478 1.1 macallan int i, j;
479 1.1 macallan uint32_t src, srcw;
480 1.1 macallan volatile uint32_t junk;
481 1.1 macallan
482 1.1 macallan /* first we set up the colour map */
483 1.1 macallan j = 0;
484 1.1 macallan for (i = 0; i < 256; i++) {
485 1.1 macallan
486 1.1 macallan agten_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1],
487 1.1 macallan rasops_cmap[j + 2]);
488 1.1 macallan j += 3;
489 1.1 macallan }
490 1.1 macallan
491 1.1 macallan /* now set up some window attributes */
492 1.2 macallan agten_write_idx(sc, IBM561_OL_WINTYPE);
493 1.1 macallan agten_write_dac_10(sc, IBM561_CMD_FB_WAT, 0x00);
494 1.1 macallan for (i = 1; i < 256; i++)
495 1.1 macallan agten_write_dac_10(sc, IBM561_CMD_FB_WAT, 0x01);
496 1.1 macallan
497 1.1 macallan src = 0;
498 1.1 macallan srcw = sc->sc_width << 16 | sc->sc_height;
499 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, FOREGROUND_COLOR,
500 1.1 macallan 0x0);
501 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, BACKGROUND_COLOR,
502 1.1 macallan 0x0);
503 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RASTER_OP, ROP_PAT);
504 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, COORD_INDEX, 0);
505 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RECT_RTW_XY, src);
506 1.1 macallan bus_space_write_4(sc->sc_bustag, sc->sc_p9100_regh, RECT_RTW_XY, srcw);
507 1.1 macallan junk = bus_space_read_4(sc->sc_bustag, sc->sc_p9100_regh, COMMAND_QUAD);
508 1.1 macallan
509 1.2 macallan i128_init(sc->sc_bustag, sc->sc_i128_regh, sc->sc_stride, 8);
510 1.1 macallan }
511 1.1 macallan
512 1.1 macallan static void
513 1.1 macallan agten_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
514 1.1 macallan {
515 1.1 macallan struct rasops_info *ri = cookie;
516 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
517 1.1 macallan struct agten_softc *sc = scr->scr_cookie;
518 1.1 macallan int32_t xs, xd, y, width, height;
519 1.1 macallan
520 1.1 macallan xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
521 1.1 macallan xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
522 1.1 macallan y = ri->ri_yorigin + ri->ri_font->fontheight * row;
523 1.1 macallan width = ri->ri_font->fontwidth * ncols;
524 1.1 macallan height = ri->ri_font->fontheight;
525 1.1 macallan i128_bitblt(sc->sc_bustag, sc->sc_i128_regh, xs, y, xd, y, width,
526 1.2 macallan height, CR_COPY);
527 1.1 macallan }
528 1.1 macallan
529 1.1 macallan static void
530 1.1 macallan agten_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
531 1.1 macallan {
532 1.1 macallan struct rasops_info *ri = cookie;
533 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
534 1.1 macallan struct agten_softc *sc = scr->scr_cookie;
535 1.1 macallan int32_t x, y, width, height, bg;
536 1.1 macallan
537 1.1 macallan x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
538 1.1 macallan y = ri->ri_yorigin + ri->ri_font->fontheight * row;
539 1.1 macallan width = ri->ri_font->fontwidth * ncols;
540 1.1 macallan height = ri->ri_font->fontheight;
541 1.1 macallan bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
542 1.1 macallan i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, x, y, width, height, bg);
543 1.1 macallan }
544 1.1 macallan
545 1.1 macallan static void
546 1.1 macallan agten_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
547 1.1 macallan {
548 1.1 macallan struct rasops_info *ri = cookie;
549 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
550 1.1 macallan struct agten_softc *sc = scr->scr_cookie;
551 1.1 macallan int32_t x, ys, yd, width, height;
552 1.1 macallan
553 1.1 macallan x = ri->ri_xorigin;
554 1.1 macallan ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
555 1.1 macallan yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
556 1.1 macallan width = ri->ri_emuwidth;
557 1.1 macallan height = ri->ri_font->fontheight * nrows;
558 1.1 macallan i128_bitblt(sc->sc_bustag, sc->sc_i128_regh, x, ys, x, yd, width,
559 1.2 macallan height, CR_COPY);
560 1.1 macallan }
561 1.1 macallan
562 1.1 macallan static void
563 1.1 macallan agten_eraserows(void *cookie, int row, int nrows, long fillattr)
564 1.1 macallan {
565 1.1 macallan struct rasops_info *ri = cookie;
566 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
567 1.1 macallan struct agten_softc *sc = scr->scr_cookie;
568 1.1 macallan int32_t x, y, width, height, bg;
569 1.1 macallan
570 1.1 macallan if ((row == 0) && (nrows == ri->ri_rows)) {
571 1.1 macallan x = y = 0;
572 1.1 macallan width = ri->ri_width;
573 1.1 macallan height = ri->ri_height;
574 1.1 macallan } else {
575 1.1 macallan x = ri->ri_xorigin;
576 1.1 macallan y = ri->ri_yorigin + ri->ri_font->fontheight * row;
577 1.1 macallan width = ri->ri_emuwidth;
578 1.1 macallan height = ri->ri_font->fontheight * nrows;
579 1.1 macallan }
580 1.1 macallan bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
581 1.1 macallan i128_rectfill(sc->sc_bustag, sc->sc_i128_regh, x, y, width, height, bg);
582 1.1 macallan }
583