grf_ul.c revision 1.21 1 1.21 christos /* $NetBSD: grf_ul.c,v 1.21 1996/10/10 23:55:53 christos Exp $ */
2 1.1 chopps #define UL_DEBUG
3 1.1 chopps
4 1.1 chopps /*
5 1.1 chopps * Copyright (c) 1995 Ignatios Souvatzis
6 1.1 chopps * All rights reserved.
7 1.1 chopps *
8 1.1 chopps * Redistribution and use in source and binary forms, with or without
9 1.1 chopps * modification, are permitted provided that the following conditions
10 1.1 chopps * are met:
11 1.1 chopps * 1. Redistributions of source code must retain the above copyright
12 1.1 chopps * notice, this list of conditions and the following disclaimer.
13 1.1 chopps * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 chopps * notice, this list of conditions and the following disclaimer in the
15 1.1 chopps * documentation and/or other materials provided with the distribution.
16 1.1 chopps * 3. All advertising materials mentioning features or use of this software
17 1.1 chopps * must display the following acknowledgement:
18 1.19 is * This product includes software developed by Ignatios Souvatzis for
19 1.19 is * the NetBSD project.
20 1.19 is * 4. The name of the authors may not be used to endorse or promote products
21 1.1 chopps * derived from this software without specific prior written permission
22 1.1 chopps *
23 1.1 chopps * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
24 1.1 chopps * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
25 1.1 chopps * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
26 1.1 chopps * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
27 1.1 chopps * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
28 1.1 chopps * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
29 1.1 chopps * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
30 1.1 chopps * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
31 1.1 chopps * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
32 1.1 chopps * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 1.1 chopps */
34 1.1 chopps #include "grful.h"
35 1.1 chopps #if NGRFUL > 0
36 1.1 chopps
37 1.1 chopps /* Graphics routines for the University of Lowell A2410 board,
38 1.1 chopps using the TMS34010 processor. */
39 1.1 chopps
40 1.1 chopps #include <sys/param.h>
41 1.3 chopps #include <sys/systm.h>
42 1.1 chopps #include <sys/errno.h>
43 1.1 chopps #include <sys/ioctl.h>
44 1.1 chopps #include <sys/device.h>
45 1.1 chopps #include <sys/malloc.h>
46 1.1 chopps #include <sys/syslog.h>
47 1.1 chopps
48 1.1 chopps #include <machine/cpu.h>
49 1.1 chopps
50 1.1 chopps #include <amiga/amiga/device.h>
51 1.1 chopps #include <amiga/amiga/isr.h>
52 1.1 chopps #include <amiga/dev/zbusvar.h>
53 1.1 chopps #include <amiga/dev/grfioctl.h>
54 1.1 chopps #include <amiga/dev/grfvar.h>
55 1.1 chopps #include <amiga/dev/grf_ulreg.h>
56 1.6 chopps
57 1.8 jtc extern u_int16_t tmscode[];
58 1.1 chopps
59 1.5 chopps int ul_ioctl __P((struct grf_softc *, u_long, void *, dev_t));
60 1.5 chopps int ul_getcmap __P((struct grf_softc *, struct grf_colormap *, dev_t));
61 1.5 chopps int ul_putcmap __P((struct grf_softc *, struct grf_colormap *, dev_t));
62 1.5 chopps int ul_bitblt __P((struct grf_softc *, struct grf_bitblt *, dev_t));
63 1.10 chopps int ul_blank __P((struct grf_softc *, int *, dev_t));
64 1.1 chopps
65 1.15 veego static int ulisr __P((void *));
66 1.15 veego int ulowell_alive __P((struct grfvideo_mode *));
67 1.15 veego static void ul_load_code __P((struct grf_softc *));
68 1.15 veego static int ul_load_mon __P((struct grf_softc *, struct grfvideo_mode *));
69 1.15 veego static int ul_getvmode __P((struct grf_softc *, struct grfvideo_mode *));
70 1.15 veego static int ul_setvmode __P((struct grf_softc *, unsigned));
71 1.15 veego static __inline void ul_setfb __P((struct grf_softc *, u_long));
72 1.15 veego
73 1.1 chopps /*
74 1.1 chopps * marked true early so that ulowell_cnprobe() can tell if we are alive.
75 1.1 chopps */
76 1.1 chopps int ulowell_inited;
77 1.1 chopps
78 1.1 chopps /* standard-palette definition */
79 1.1 chopps u_int8_t ul_std_palette[] = {
80 1.1 chopps 0,128, 0,128, 0,128, 0,128, 0,255, 0,255, 0,255, 0,255,
81 1.1 chopps 0, 0,128,128, 0, 0,128,128, 0, 0,255,255, 0, 0,255,255,
82 1.1 chopps 0, 0, 0, 0, 128,128,128,128, 0, 0, 0, 0, 255,255,255,255};
83 1.1 chopps
84 1.1 chopps u_int8_t ul_ovl_palette[] = {
85 1.1 chopps 128, 0, 0, 0,
86 1.1 chopps 128, 0, 0, 0,
87 1.1 chopps 128, 0, 0, 0};
88 1.1 chopps
89 1.2 chopps struct grfvideo_mode ul_monitor_defs[] = {
90 1.1 chopps
91 1.1 chopps /*
92 1.1 chopps * Horizontal values are given in TMS units, that is, for the
93 1.1 chopps * A2410 board, units of 16 pixels. The ioctl multiplies (when
94 1.8 jtc * exporting) or divides (when importing) them by 16 to conform to.
95 1.1 chopps *
96 1.8 jtc * XXX This used to be in units of 8 pixel times. We
97 1.8 jtc * must also change amiga/stand/grfconfig/grfconfig.c,
98 1.8 jtc * grf_{rt,rh,cl,cv}.c and egsgrfconfig (the latter to generate the
99 1.1 chopps * horizontal timings in units of pixels instead of 8 pixels.
100 1.1 chopps * You will also have to write warnings in BIG BOLD RED BLINKING
101 1.1 chopps * LETTERS all over the docs, and still people will fry their monitors.
102 1.1 chopps *
103 1.1 chopps * btw, the _totals are always sync_start+1, to compute the frequencies
104 1.1 chopps * correctly. (see TMS34010 manual)
105 1.1 chopps */
106 1.1 chopps
107 1.1 chopps /* 1024x768, 60Hz */
108 1.1 chopps {1, "1024x768", 66667000, 1024, 768, 8,
109 1.1 chopps 82, 18, 86, 12, 87, 794, 26, 797, 2, 798},
110 1.1 chopps
111 1.1 chopps /* 864x648, 70Hz */
112 1.1 chopps {2, "864x648", 50000000, 864, 648, 8,
113 1.1 chopps 61, 7, 65, 3, 66, 667, 19, 677, 4, 678},
114 1.1 chopps
115 1.1 chopps /* 800x600, 60Hz */
116 1.1 chopps {3, "800x600", 36000000, 800, 600, 8,
117 1.1 chopps 57, 7, 61, 3, 62, 619, 19, 629, 4, 630},
118 1.1 chopps
119 1.1 chopps /* 640x400, 60 Hz, interlaced */
120 1.1 chopps {4, "640x400I", 14318000, 640, 400, 8,
121 1.1 chopps 48, 8, 56, 3, 57, 239, 39, 262, 2, 240},
122 1.1 chopps
123 1.1 chopps /* 1024x768, 65Hz interlaced, s.th. is strange */
124 1.1 chopps {5, "1024x768?I", 44980000, 1024, 768, 8,
125 1.1 chopps 76, 12, 79, 3, 80, 512, 24, 533, 2, 534},
126 1.1 chopps
127 1.1 chopps /* 1024x1024, 60Hz */
128 1.1 chopps {6, "1024x1024", 80000000, 1024,1024, 8,
129 1.1 chopps 77, 13, 78, 5, 78,1051, 27,1054, 2,1055},
130 1.1 chopps
131 1.1 chopps /* 736x480, 60 Hz */
132 1.1 chopps {7, "736x480", 28636300, 736, 480, 8,
133 1.1 chopps 54, 8, 57, 3, 58, 503, 23, 514, 3, 515},
134 1.1 chopps };
135 1.1 chopps
136 1.2 chopps int ulowell_mon_max = sizeof (ul_monitor_defs)/sizeof (ul_monitor_defs[0]);
137 1.1 chopps
138 1.1 chopps /* option settable */
139 1.1 chopps #ifndef ULOWELL_OSC1
140 1.1 chopps #define ULOWELL_OSC1 36000000
141 1.1 chopps #endif
142 1.1 chopps
143 1.1 chopps #ifndef ULOWELL_OSC2
144 1.1 chopps #define ULOWELL_OSC2 66667000
145 1.1 chopps #endif
146 1.1 chopps
147 1.1 chopps #ifndef ULOWELL_DEFAULT_MON
148 1.1 chopps #define ULOWELL_DEFAULT_MON 1
149 1.1 chopps #endif
150 1.1 chopps
151 1.1 chopps /* patchable */
152 1.1 chopps int ulowell_default_mon = ULOWELL_DEFAULT_MON;
153 1.1 chopps int ulowell_default_gfx = ULOWELL_DEFAULT_MON;
154 1.1 chopps
155 1.1 chopps /*
156 1.1 chopps * yes, this should be per board. We don't pay service to multiple boards,
157 1.1 chopps * anyway.
158 1.1 chopps */
159 1.1 chopps
160 1.4 chopps u_long ulowell_clock[2] = { ULOWELL_OSC2, ULOWELL_OSC1 };
161 1.1 chopps
162 1.1 chopps static struct grfvideo_mode *current_mon;
163 1.1 chopps
164 1.1 chopps /*
165 1.1 chopps * We dont use ints at the moment, but will need this later to avoid
166 1.1 chopps * busy_waiting in gsp_write, and we use it for spurious int warnings.
167 1.1 chopps */
168 1.1 chopps
169 1.1 chopps static int
170 1.15 veego ulisr(arg)
171 1.15 veego void *arg;
172 1.1 chopps {
173 1.15 veego struct grf_softc *gp = arg;
174 1.1 chopps struct gspregs *ba;
175 1.1 chopps u_int16_t thebits;
176 1.1 chopps
177 1.1 chopps if (gp == NULL)
178 1.1 chopps return 0;
179 1.1 chopps
180 1.1 chopps ba = (struct gspregs *)gp->g_regkva;
181 1.1 chopps
182 1.1 chopps if (ba == NULL)
183 1.1 chopps return 0;
184 1.1 chopps
185 1.1 chopps thebits = ba->ctrl;
186 1.1 chopps if (thebits & INTOUT) {
187 1.1 chopps log(LOG_INFO, "grf4: got interrupt, ctrl=0x%4x\n", thebits);
188 1.1 chopps /* clear int */
189 1.1 chopps ba->ctrl = thebits & ~INTOUT;
190 1.1 chopps return 1;
191 1.1 chopps }
192 1.1 chopps return 0;
193 1.1 chopps }
194 1.1 chopps
195 1.1 chopps /*
196 1.1 chopps * used to query the ulowell board to see if its alive.
197 1.1 chopps * for the moment, a NOP.
198 1.1 chopps */
199 1.1 chopps int
200 1.1 chopps ulowell_alive(mdp)
201 1.1 chopps struct grfvideo_mode *mdp;
202 1.1 chopps {
203 1.1 chopps return 1;
204 1.1 chopps }
205 1.1 chopps
206 1.1 chopps /*
207 1.1 chopps * Load the (mostly) ite support code and the default colormaps.
208 1.1 chopps */
209 1.1 chopps static void
210 1.1 chopps ul_load_code(gp)
211 1.1 chopps struct grf_softc *gp;
212 1.1 chopps {
213 1.1 chopps struct grf_ul_softc *gup;
214 1.1 chopps struct gspregs *ba;
215 1.1 chopps struct grfinfo *gi;
216 1.15 veego int i,j;
217 1.15 veego #if 0
218 1.1 chopps struct grf_colormap gcm;
219 1.15 veego #endif
220 1.1 chopps
221 1.1 chopps gup = (struct grf_ul_softc *)gp;
222 1.1 chopps ba = (struct gspregs *)gp->g_regkva;
223 1.1 chopps gi = &gp->g_display;
224 1.1 chopps
225 1.1 chopps gi->gd_regaddr = ztwopa((caddr_t)ba);
226 1.1 chopps gi->gd_regsize = sizeof(struct gspregs);
227 1.1 chopps gi->gd_fbaddr = NULL;
228 1.1 chopps gi->gd_fbsize = 0;
229 1.1 chopps gi->gd_fbwidth = 1024;
230 1.1 chopps gi->gd_fbheight = 1024;
231 1.1 chopps gi->gd_colors = 256;
232 1.1 chopps
233 1.15 veego ba->ctrl = (ba->ctrl & ~INCR) | (LBL | INCW);
234 1.1 chopps ba->hstadrh = 0xC000;
235 1.1 chopps ba->hstadrl = 0x0080;
236 1.1 chopps ba->data = 0x0; /* disable screen refresh and video output */
237 1.1 chopps ba->data = 0xFFFC; /* screen refresh base address */
238 1.1 chopps ba->data = 0xFFFF; /* no display int possible */
239 1.1 chopps ba->data = 0x000C; /* CAS before RAS refresh each 64 local clks */
240 1.1 chopps
241 1.5 chopps ba->ctrl = (ba->ctrl & ~INCW) | LBL;
242 1.1 chopps ba->hstadrh = 0xfe80;
243 1.1 chopps ba->hstadrl = 0;
244 1.1 chopps ba->data = 4;
245 1.1 chopps ba->hstadrl = 0x20;
246 1.1 chopps ba->data = 0xFF; /* all color planes visible */
247 1.1 chopps
248 1.1 chopps ba->hstadrl = 0;
249 1.1 chopps ba->data = 5;
250 1.1 chopps ba->hstadrl = 0x20;
251 1.1 chopps ba->data = 0; /* no color planes blinking */
252 1.1 chopps
253 1.1 chopps ba->hstadrl = 0;
254 1.1 chopps ba->data = 6;
255 1.1 chopps ba->hstadrl = 0x20;
256 1.1 chopps ba->data = gup->gus_ovslct = 0x43;
257 1.1 chopps /* overlay visible, no overlay blinking, overlay color 0 transparent */
258 1.1 chopps
259 1.1 chopps ba->hstadrl = 0;
260 1.1 chopps ba->data = 7;
261 1.1 chopps ba->hstadrl = 0x20;
262 1.1 chopps ba->data = 0; /* voodoo */
263 1.1 chopps
264 1.1 chopps /* clear overlay planes */
265 1.1 chopps ba->ctrl |= INCW;
266 1.1 chopps ba->hstadrh = 0xff80;
267 1.1 chopps ba->hstadrl = 0x0000;
268 1.1 chopps for (i=0xff80000; i< 0xffa0000; ++i) {
269 1.1 chopps ba->data = 0;
270 1.1 chopps }
271 1.1 chopps
272 1.1 chopps /* download tms code */
273 1.1 chopps
274 1.1 chopps ba->ctrl = LBL | INCW | NMI | NMIM | HLT | CF;
275 1.1 chopps
276 1.21 christos kprintf("\ndownloading TMS code");
277 1.5 chopps i=0;
278 1.5 chopps while ((j = tmscode[i++])) {
279 1.21 christos kprintf(".");
280 1.5 chopps ba->hstadrh = tmscode[i++];
281 1.5 chopps ba->hstadrl = tmscode[i++];
282 1.5 chopps while (j-- > 0) {
283 1.5 chopps ba->data = tmscode[i++];
284 1.1 chopps }
285 1.1 chopps }
286 1.1 chopps
287 1.1 chopps /* font info was uploaded in ite_ul.c(ite_ulinit). */
288 1.1 chopps
289 1.9 chopps #if 1
290 1.1 chopps /* XXX load image palette with some initial values, slightly hacky */
291 1.1 chopps
292 1.1 chopps ba->hstadrh = 0xfe80;
293 1.1 chopps ba->hstadrl = 0x0000;
294 1.1 chopps ba->ctrl |= INCW;
295 1.1 chopps ba->data = 0;
296 1.1 chopps ba->ctrl &= ~INCW;
297 1.1 chopps
298 1.1 chopps for (i=0; i<16; ++i) {
299 1.1 chopps ba->data = gup->gus_imcmap[i+ 0] = ul_std_palette[i+ 0];
300 1.1 chopps ba->data = gup->gus_imcmap[i+256] = ul_std_palette[i+16];
301 1.1 chopps ba->data = gup->gus_imcmap[i+512] = ul_std_palette[i+32];
302 1.1 chopps }
303 1.1 chopps
304 1.1 chopps /*
305 1.1 chopps * XXX load shadow overlay palette with what the TMS code will load
306 1.9 chopps * into the real one some time after the TMS code is started below.
307 1.9 chopps * This might be considered a rude hack.
308 1.1 chopps */
309 1.1 chopps bcopy(ul_ovl_palette, gup->gus_ovcmap, 3*4);
310 1.9 chopps
311 1.9 chopps /*
312 1.9 chopps * Unflush cache, unhalt cpu -> nmi starts to run. This MUST NOT BE
313 1.9 chopps * DONE before the image color map initialization above, to guarantee
314 1.12 is * the index register in the BT458 is not used by more than one CPU
315 1.9 chopps * at once.
316 1.9 chopps *
317 1.9 chopps * XXX For the same reason, we'll have to rething ul_putcmap(). For
318 1.9 chopps * details, look at comment there.
319 1.9 chopps */
320 1.9 chopps ba->ctrl &= ~(HLT|CF);
321 1.9 chopps
322 1.1 chopps #else
323 1.9 chopps /*
324 1.9 chopps * XXX I wonder why this partially ever worked.
325 1.9 chopps *
326 1.9 chopps * This can't possibly work this way, as we are copyin()ing data in
327 1.9 chopps * ul_putcmap.
328 1.9 chopps *
329 1.9 chopps * I guess this partially worked because SFC happened to point to
330 1.9 chopps * to supervisor data space on 68030 machines coming from the old
331 1.9 chopps * boot loader.
332 1.9 chopps *
333 1.9 chopps * While this looks more correct than the hack in the other part of the
334 1.9 chopps * loop, we would have to do our own version of the loop through
335 1.9 chopps * colormap entries, set up command buffer, and call gsp_write(), or
336 1.9 chopps * factor out some code.
337 1.9 chopps */
338 1.9 chopps
339 1.9 chopps /*
340 1.9 chopps * XXX This version will work for the overlay, if our queue codes
341 1.1 chopps * initial conditions are set at load time (not start time).
342 1.1 chopps * It further assumes that ul_putcmap only uses the
343 1.1 chopps * GRFIMDEV/GRFOVDEV bits of the dev parameter.
344 1.1 chopps */
345 1.1 chopps
346 1.9 chopps
347 1.9 chopps /* unflush cache, unhalt cpu first -> nmi starts to run */
348 1.9 chopps ba->ctrl &= ~(HLT|CF);
349 1.9 chopps
350 1.1 chopps gcm.index = 0;
351 1.1 chopps gcm.count = 16;
352 1.1 chopps gcm.red = ul_std_palette + 0;
353 1.1 chopps gcm.green = ul_std_palette + 16;
354 1.1 chopps gcm.blue = ul_std_palette + 32;
355 1.1 chopps ul_putcmap(gp, &gcm, GRFIMDEV);
356 1.1 chopps
357 1.1 chopps gcm.index = 0;
358 1.1 chopps gcm.count = 4;
359 1.1 chopps gcm.red = ul_ovl_palette + 0;
360 1.1 chopps gcm.green = ul_ovl_palette + 4;
361 1.1 chopps gcm.blue = ul_ovl_palette + 8;
362 1.1 chopps ul_putcmap(gp, &gcm, GRFOVDEV);
363 1.1 chopps #endif
364 1.1 chopps
365 1.1 chopps }
366 1.1 chopps
367 1.1 chopps static int
368 1.1 chopps ul_load_mon(gp, md)
369 1.1 chopps struct grf_softc *gp;
370 1.1 chopps struct grfvideo_mode *md;
371 1.1 chopps {
372 1.1 chopps struct grf_ul_softc *gup;
373 1.1 chopps struct grfinfo *gi;
374 1.1 chopps struct gspregs *ba;
375 1.1 chopps u_int16_t buf[8];
376 1.1 chopps
377 1.1 chopps gup = (struct grf_ul_softc *)gp;
378 1.1 chopps gi = &gp->g_display;
379 1.1 chopps ba = (struct gspregs *)gp->g_regkva;
380 1.1 chopps
381 1.1 chopps gi->gd_dyn.gdi_fbx = 0;
382 1.1 chopps gi->gd_dyn.gdi_fby = 0;
383 1.1 chopps gi->gd_dyn.gdi_dwidth = md->disp_width;
384 1.1 chopps gi->gd_dyn.gdi_dheight = md->disp_height;
385 1.1 chopps gi->gd_dyn.gdi_dx = 0;
386 1.1 chopps gi->gd_dyn.gdi_dy = 0;
387 1.1 chopps
388 1.15 veego ba->ctrl = (ba->ctrl & ~INCR) | (LBL | INCW); /* XXX */
389 1.1 chopps
390 1.1 chopps ba->hstadrh = 0xC000;
391 1.1 chopps ba->hstadrl = 0x0000;
392 1.1 chopps ba->data = md->hsync_stop;
393 1.1 chopps ba->data = md->hblank_stop;
394 1.1 chopps ba->data = md->hblank_start;
395 1.1 chopps ba->data = md->hsync_start;
396 1.1 chopps ba->data = md->vsync_stop;
397 1.1 chopps ba->data = md->vblank_stop;
398 1.1 chopps ba->data = md->vblank_start;
399 1.1 chopps ba->data = md->vsync_start;
400 1.1 chopps
401 1.1 chopps ba->ctrl &= ~INCW;
402 1.1 chopps ba->hstadrh = 0xFE90;
403 1.1 chopps ba->hstadrl = 0x0000;
404 1.1 chopps
405 1.1 chopps if (abs(md->pixel_clock - ulowell_clock[0]) >
406 1.1 chopps abs(md->pixel_clock - ulowell_clock[1])) {
407 1.1 chopps
408 1.5 chopps ba->data = (ba->data & 0xFC) | 2 | 1;
409 1.1 chopps md->pixel_clock = ulowell_clock[1];
410 1.1 chopps
411 1.1 chopps } else {
412 1.5 chopps ba->data = (ba->data & 0xFC) | 2 | 0;
413 1.1 chopps md->pixel_clock = ulowell_clock[0];
414 1.1 chopps }
415 1.1 chopps
416 1.15 veego ba->ctrl |= LBL | INCW;
417 1.1 chopps ba->hstadrh = 0xC000;
418 1.1 chopps ba->hstadrl = 0x0080;
419 1.1 chopps ba->data = (md->vblank_start - md->vblank_stop == md->disp_height ?
420 1.1 chopps 0xf020 : 0xb020);
421 1.1 chopps
422 1.1 chopps /* I guess this should be in the yet unimplemented mode select ioctl */
423 1.1 chopps /* Hm.. maybe not. We always put the console on overlay plane no 0. */
424 1.1 chopps /* Anyway, this _IS_ called in the mode select ioctl. */
425 1.1 chopps
426 1.1 chopps /* ite support code parameters: */
427 1.1 chopps buf[0] = GCMD_MCHG;
428 1.1 chopps buf[1] = md->disp_width; /* display width */
429 1.1 chopps buf[2] = md->disp_height; /* display height */
430 1.1 chopps buf[3] = 0; /* LSW of frame buffer origin */
431 1.1 chopps buf[4] = 0xFF80; /* MSW of frame buffer origin */
432 1.1 chopps buf[5] = gi->gd_fbwidth * 1; /* frame buffer pitch */
433 1.1 chopps buf[6] = 1; /* frame buffer depth */
434 1.1 chopps gsp_write(ba, buf, 7);
435 1.1 chopps
436 1.1 chopps return(1);
437 1.1 chopps }
438 1.1 chopps
439 1.15 veego int ul_mode __P((struct grf_softc *, u_long, void *, u_long, int));
440 1.1 chopps
441 1.1 chopps void grfulattach __P((struct device *, struct device *, void *));
442 1.20 cgd int grfulprint __P((void *, const char *));
443 1.13 thorpej int grfulmatch __P((struct device *, void *, void *));
444 1.1 chopps
445 1.13 thorpej struct cfattach grful_ca = {
446 1.13 thorpej sizeof(struct grf_ul_softc), grfulmatch, grfulattach
447 1.13 thorpej };
448 1.13 thorpej
449 1.14 mhitch struct cfdriver grful_cd = {
450 1.13 thorpej NULL, "grful", DV_DULL, NULL, 0
451 1.13 thorpej };
452 1.1 chopps
453 1.1 chopps /*
454 1.1 chopps * only used in console init
455 1.1 chopps */
456 1.1 chopps static struct cfdata *cfdata;
457 1.1 chopps
458 1.1 chopps /*
459 1.1 chopps * we make sure to only init things once. this is somewhat
460 1.1 chopps * tricky regarding the console.
461 1.1 chopps */
462 1.1 chopps int
463 1.13 thorpej grfulmatch(pdp, match, auxp)
464 1.1 chopps struct device *pdp;
465 1.13 thorpej void *match, *auxp;
466 1.1 chopps {
467 1.16 veego #ifdef ULOWELLCONSOLE
468 1.13 thorpej struct cfdata *cfp = match;
469 1.1 chopps static int ulconunit = -1;
470 1.1 chopps #endif
471 1.1 chopps struct zbus_args *zap;
472 1.1 chopps
473 1.1 chopps zap = auxp;
474 1.1 chopps
475 1.1 chopps /*
476 1.1 chopps * allow only one ulowell console
477 1.1 chopps */
478 1.1 chopps if (amiga_realconfig == 0)
479 1.1 chopps #ifdef ULOWELLCONSOLE
480 1.1 chopps if (ulconunit != -1)
481 1.1 chopps #endif
482 1.1 chopps return(0);
483 1.1 chopps
484 1.1 chopps if (zap->manid != 1030 || zap->prodid != 0)
485 1.1 chopps return(0);
486 1.1 chopps
487 1.1 chopps #ifdef ULOWELLCONSOLE
488 1.1 chopps if (amiga_realconfig == 0 || ulconunit != cfp->cf_unit) {
489 1.1 chopps #endif
490 1.11 chopps if ((unsigned)ulowell_default_mon > ulowell_mon_max)
491 1.1 chopps ulowell_default_mon = 1;
492 1.1 chopps
493 1.2 chopps current_mon = ul_monitor_defs + ulowell_default_mon - 1;
494 1.1 chopps if (ulowell_alive(current_mon) == 0)
495 1.1 chopps return(0);
496 1.1 chopps #ifdef ULOWELLCONSOLE
497 1.1 chopps if (amiga_realconfig == 0) {
498 1.1 chopps ulconunit = cfp->cf_unit;
499 1.1 chopps cfdata = cfp;
500 1.1 chopps }
501 1.1 chopps }
502 1.1 chopps #endif
503 1.1 chopps return(1);
504 1.1 chopps }
505 1.1 chopps
506 1.1 chopps /*
507 1.1 chopps * attach to the grfbus (zbus)
508 1.1 chopps */
509 1.1 chopps void
510 1.1 chopps grfulattach(pdp, dp, auxp)
511 1.1 chopps struct device *pdp, *dp;
512 1.1 chopps void *auxp;
513 1.1 chopps {
514 1.1 chopps static struct grf_ul_softc congrf;
515 1.1 chopps struct zbus_args *zap;
516 1.1 chopps struct grf_softc *gp;
517 1.1 chopps struct grf_ul_softc *gup;
518 1.1 chopps
519 1.1 chopps zap = auxp;
520 1.1 chopps
521 1.1 chopps if (dp == NULL)
522 1.1 chopps gup = &congrf;
523 1.1 chopps else
524 1.1 chopps gup = (struct grf_ul_softc *)dp;
525 1.1 chopps
526 1.1 chopps gp = &gup->gus_sc;
527 1.1 chopps
528 1.1 chopps if (dp != NULL && congrf.gus_sc.g_regkva != 0) {
529 1.1 chopps /*
530 1.1 chopps * inited earlier, just copy (not device struct)
531 1.1 chopps */
532 1.1 chopps bcopy(&congrf.gus_sc.g_display, &gp->g_display,
533 1.1 chopps (char *)&gup->gus_isr - (char *)&gp->g_display);
534 1.1 chopps
535 1.1 chopps /* ...and transfer the isr */
536 1.1 chopps gup->gus_isr.isr_ipl = 2;
537 1.1 chopps gup->gus_isr.isr_intr = ulisr;
538 1.1 chopps gup->gus_isr.isr_arg = (void *)gp;
539 1.1 chopps /*
540 1.1 chopps * To make sure ints are always catched, first add new isr
541 1.1 chopps * then remove old:
542 1.1 chopps */
543 1.1 chopps add_isr(&gup->gus_isr);
544 1.1 chopps remove_isr(&congrf.gus_isr);
545 1.1 chopps } else {
546 1.1 chopps gp->g_regkva = (caddr_t)zap->va;
547 1.1 chopps gp->g_fbkva = NULL;
548 1.1 chopps gp->g_unit = GRF_ULOWELL_UNIT;
549 1.1 chopps gp->g_flags = GF_ALIVE;
550 1.1 chopps gp->g_mode = ul_mode;
551 1.1 chopps gp->g_conpri = grful_cnprobe();
552 1.1 chopps gp->g_data = NULL;
553 1.1 chopps
554 1.1 chopps gup->gus_isr.isr_ipl = 2;
555 1.1 chopps gup->gus_isr.isr_intr = ulisr;
556 1.1 chopps gup->gus_isr.isr_arg = (void *)gp;
557 1.1 chopps add_isr(&gup->gus_isr);
558 1.1 chopps
559 1.1 chopps (void)ul_load_code(gp);
560 1.1 chopps (void)ul_load_mon(gp, current_mon);
561 1.1 chopps grful_iteinit(gp);
562 1.1 chopps }
563 1.1 chopps if (dp != NULL)
564 1.21 christos kprintf("\n");
565 1.1 chopps /*
566 1.1 chopps * attach grf
567 1.1 chopps */
568 1.1 chopps amiga_config_found(cfdata, &gp->g_device, gp, grfulprint);
569 1.1 chopps }
570 1.1 chopps
571 1.1 chopps int
572 1.1 chopps grfulprint(auxp, pnp)
573 1.1 chopps void *auxp;
574 1.20 cgd const char *pnp;
575 1.1 chopps {
576 1.1 chopps if (pnp)
577 1.21 christos kprintf("grf%d at %s", ((struct grf_softc *)auxp)->g_unit,
578 1.1 chopps pnp);
579 1.1 chopps return(UNCONF);
580 1.1 chopps }
581 1.1 chopps
582 1.1 chopps static int
583 1.1 chopps ul_getvmode (gp, vm)
584 1.1 chopps struct grf_softc *gp;
585 1.1 chopps struct grfvideo_mode *vm;
586 1.1 chopps {
587 1.1 chopps struct grfvideo_mode *md;
588 1.1 chopps
589 1.1 chopps if (vm->mode_num && vm->mode_num > ulowell_mon_max)
590 1.1 chopps return EINVAL;
591 1.1 chopps
592 1.1 chopps if (! vm->mode_num)
593 1.2 chopps vm->mode_num = current_mon - ul_monitor_defs + 1;
594 1.1 chopps
595 1.2 chopps md = ul_monitor_defs + vm->mode_num - 1;
596 1.3 chopps strncpy (vm->mode_descr, md->mode_descr,
597 1.1 chopps sizeof (vm->mode_descr));
598 1.1 chopps
599 1.1 chopps /* XXX should tell TMS to measure it */
600 1.1 chopps vm->pixel_clock = md->pixel_clock;
601 1.1 chopps vm->disp_width = md->disp_width;
602 1.1 chopps vm->disp_height = md->disp_height;
603 1.1 chopps vm->depth = md->depth;
604 1.1 chopps
605 1.8 jtc vm->hblank_start = (md->hblank_start - md->hblank_stop) * 16;
606 1.8 jtc vm->hblank_stop = (md->htotal - 1) * 16;
607 1.8 jtc vm->hsync_start = (md->hsync_start - md->hblank_stop) * 16;
608 1.8 jtc vm->hsync_stop = (md->hsync_stop + md->htotal - md->hblank_stop) * 16;
609 1.8 jtc vm->htotal = md->htotal * 16;
610 1.1 chopps
611 1.7 chopps vm->vblank_start = md->vblank_start - md->vblank_stop;
612 1.7 chopps vm->vblank_stop = md->vtotal - 1;
613 1.7 chopps vm->vsync_start = md->vsync_start - md->vblank_stop;
614 1.7 chopps vm->vsync_stop = md->vsync_stop + md->vtotal - md->vblank_stop;
615 1.1 chopps vm->vtotal = md->vtotal;
616 1.1 chopps
617 1.1 chopps return 0;
618 1.1 chopps }
619 1.1 chopps
620 1.1 chopps
621 1.1 chopps static int
622 1.1 chopps ul_setvmode (gp, mode)
623 1.1 chopps struct grf_softc *gp;
624 1.1 chopps unsigned mode;
625 1.1 chopps {
626 1.1 chopps struct grf_ul_softc *gup;
627 1.1 chopps struct gspregs *ba;
628 1.1 chopps int error;
629 1.1 chopps
630 1.1 chopps if (!mode || mode > ulowell_mon_max)
631 1.1 chopps return EINVAL;
632 1.1 chopps
633 1.1 chopps ba = (struct gspregs *)gp->g_regkva;
634 1.1 chopps gup = (struct grf_ul_softc *)gp;
635 1.2 chopps current_mon = ul_monitor_defs + mode - 1;
636 1.1 chopps
637 1.1 chopps error = ul_load_mon (gp, current_mon) ? 0 : EINVAL;
638 1.1 chopps
639 1.1 chopps return error;
640 1.1 chopps }
641 1.1 chopps
642 1.1 chopps /*
643 1.1 chopps * Set the frame buffer or overlay planes on or off.
644 1.1 chopps * Always succeeds.
645 1.1 chopps */
646 1.1 chopps
647 1.1 chopps static __inline void
648 1.1 chopps ul_setfb(gp, cmd)
649 1.1 chopps struct grf_softc *gp;
650 1.15 veego u_long cmd;
651 1.1 chopps {
652 1.1 chopps struct grf_ul_softc *gup;
653 1.1 chopps struct gspregs *ba;
654 1.1 chopps
655 1.1 chopps gup = (struct grf_ul_softc *)gp;
656 1.1 chopps
657 1.1 chopps ba = (struct gspregs *)gp->g_regkva;
658 1.1 chopps ba->ctrl = LBL;
659 1.1 chopps ba->hstadrh = 0xfe80;
660 1.1 chopps ba->hstadrl = 0x0000;
661 1.1 chopps ba->data = 6;
662 1.1 chopps ba->hstadrl = 0x0020;
663 1.1 chopps
664 1.1 chopps switch (cmd) {
665 1.1 chopps case GM_GRFON:
666 1.1 chopps gup->gus_ovslct |= 0x40;
667 1.1 chopps break;
668 1.1 chopps case GM_GRFOFF:
669 1.1 chopps gup->gus_ovslct &= ~0x40;
670 1.1 chopps break;
671 1.1 chopps case GM_GRFOVON:
672 1.1 chopps gup->gus_ovslct |= 3;
673 1.1 chopps break;
674 1.1 chopps case GM_GRFOVOFF:
675 1.1 chopps gup->gus_ovslct &= ~3;
676 1.1 chopps break;
677 1.1 chopps }
678 1.1 chopps ba->data = gup->gus_ovslct;
679 1.1 chopps }
680 1.1 chopps
681 1.1 chopps /*
682 1.1 chopps * Change the mode of the display.
683 1.1 chopps * Return a UNIX error number or 0 for success.
684 1.1 chopps */
685 1.1 chopps int
686 1.1 chopps ul_mode(gp, cmd, arg, a2, a3)
687 1.1 chopps struct grf_softc *gp;
688 1.15 veego u_long cmd;
689 1.1 chopps void *arg;
690 1.15 veego u_long a2;
691 1.15 veego int a3;
692 1.1 chopps {
693 1.1 chopps int i;
694 1.1 chopps struct grfdyninfo *gd;
695 1.1 chopps
696 1.1 chopps switch (cmd) {
697 1.1 chopps case GM_GRFON:
698 1.1 chopps case GM_GRFOFF:
699 1.1 chopps case GM_GRFOVON:
700 1.1 chopps case GM_GRFOVOFF:
701 1.1 chopps ul_setfb (gp, cmd);
702 1.1 chopps return 0;
703 1.1 chopps
704 1.1 chopps case GM_GRFCONFIG:
705 1.1 chopps gd = (struct grfdyninfo *)arg;
706 1.1 chopps for (i=0; i<ulowell_mon_max; ++i) {
707 1.2 chopps if (ul_monitor_defs[i].disp_width == gd->gdi_dwidth &&
708 1.2 chopps ul_monitor_defs[i].disp_height == gd->gdi_dheight)
709 1.1 chopps return ul_setvmode(gp, i+1);
710 1.1 chopps }
711 1.1 chopps return EINVAL;
712 1.1 chopps
713 1.1 chopps case GM_GRFGETVMODE:
714 1.1 chopps return ul_getvmode (gp, (struct grfvideo_mode *) arg);
715 1.1 chopps
716 1.1 chopps case GM_GRFSETVMODE:
717 1.1 chopps return ul_setvmode (gp, *(unsigned *) arg);
718 1.1 chopps
719 1.1 chopps case GM_GRFGETNUMVM:
720 1.1 chopps *(int *)arg = ulowell_mon_max;
721 1.1 chopps return 0;
722 1.1 chopps
723 1.1 chopps case GM_GRFIOCTL:
724 1.15 veego return ul_ioctl (gp, a2, arg, (dev_t)a3);
725 1.1 chopps
726 1.1 chopps default:
727 1.1 chopps break;
728 1.1 chopps }
729 1.1 chopps
730 1.1 chopps return EINVAL;
731 1.1 chopps }
732 1.1 chopps
733 1.1 chopps int
734 1.1 chopps ul_ioctl (gp, cmd, data, dev)
735 1.1 chopps register struct grf_softc *gp;
736 1.1 chopps u_long cmd;
737 1.1 chopps void *data;
738 1.1 chopps dev_t dev;
739 1.1 chopps {
740 1.1 chopps switch (cmd) {
741 1.1 chopps #if 0
742 1.1 chopps /*
743 1.1 chopps * XXX we have no hardware sprites, but might implement them
744 1.1 chopps * later in TMS code.
745 1.1 chopps */
746 1.1 chopps
747 1.1 chopps case GRFIOCGSPRITEPOS:
748 1.1 chopps return ul_getspritepos (gp, (struct grf_position *) data);
749 1.1 chopps
750 1.1 chopps case GRFIOCSSPRITEPOS:
751 1.1 chopps return ul_setspritepos (gp, (struct grf_position *) data);
752 1.1 chopps
753 1.1 chopps case GRFIOCSSPRITEINF:
754 1.1 chopps return ul_setspriteinfo (gp, (struct grf_spriteinfo *) data);
755 1.1 chopps
756 1.1 chopps case GRFIOCGSPRITEINF:
757 1.1 chopps return ul_getspriteinfo (gp, (struct grf_spriteinfo *) data);
758 1.1 chopps
759 1.1 chopps case GRFIOCGSPRITEMAX:
760 1.1 chopps return ul_getspritemax (gp, (struct grf_position *) data);
761 1.1 chopps
762 1.1 chopps #endif
763 1.1 chopps
764 1.1 chopps case GRFIOCGETCMAP:
765 1.1 chopps return ul_getcmap (gp, (struct grf_colormap *) data, dev);
766 1.1 chopps
767 1.1 chopps case GRFIOCPUTCMAP:
768 1.1 chopps return ul_putcmap (gp, (struct grf_colormap *) data, dev);
769 1.1 chopps
770 1.1 chopps case GRFIOCBITBLT:
771 1.1 chopps return ul_bitblt (gp, (struct grf_bitblt *) data, dev);
772 1.10 chopps
773 1.10 chopps case GRFIOCBLANK:
774 1.10 chopps return ul_blank (gp, (int *) data, dev);
775 1.1 chopps }
776 1.1 chopps
777 1.1 chopps return EINVAL;
778 1.1 chopps }
779 1.1 chopps
780 1.1 chopps int
781 1.1 chopps ul_getcmap (gp, cmap, dev)
782 1.1 chopps struct grf_softc *gp;
783 1.1 chopps struct grf_colormap *cmap;
784 1.1 chopps dev_t dev;
785 1.1 chopps {
786 1.1 chopps struct grf_ul_softc *gup;
787 1.1 chopps u_int8_t *mymap;
788 1.5 chopps int mxidx, error;
789 1.1 chopps
790 1.1 chopps gup = (struct grf_ul_softc *)gp;
791 1.1 chopps
792 1.1 chopps if (minor(dev) & GRFIMDEV) {
793 1.1 chopps mxidx = 256;
794 1.1 chopps mymap = gup->gus_imcmap;
795 1.1 chopps } else {
796 1.1 chopps mxidx = 4;
797 1.1 chopps mymap = gup->gus_ovcmap;
798 1.1 chopps }
799 1.1 chopps
800 1.1 chopps if (cmap->count == 0 || cmap->index >= mxidx)
801 1.1 chopps return 0;
802 1.1 chopps
803 1.1 chopps if (cmap->index + cmap->count > mxidx)
804 1.1 chopps cmap->count = mxidx - cmap->index;
805 1.1 chopps
806 1.1 chopps /* just copyout from the shadow color map */
807 1.1 chopps
808 1.1 chopps if ((error = copyout(mymap + cmap->index, cmap->red, cmap->count))
809 1.1 chopps
810 1.1 chopps || (error = copyout(mymap + mxidx + cmap->index, cmap->green,
811 1.1 chopps cmap->count))
812 1.1 chopps
813 1.1 chopps || (error = copyout(mymap + mxidx * 2 + cmap->index, cmap->blue,
814 1.1 chopps cmap->count)))
815 1.1 chopps
816 1.1 chopps return(error);
817 1.1 chopps
818 1.1 chopps return(0);
819 1.1 chopps }
820 1.1 chopps
821 1.1 chopps int
822 1.1 chopps ul_putcmap (gp, cmap, dev)
823 1.1 chopps struct grf_softc *gp;
824 1.1 chopps struct grf_colormap *cmap;
825 1.1 chopps dev_t dev;
826 1.1 chopps {
827 1.1 chopps struct grf_ul_softc *gup;
828 1.1 chopps struct gspregs *ba;
829 1.1 chopps u_int16_t cmd[8];
830 1.1 chopps int x, mxidx, error;
831 1.1 chopps u_int8_t *mymap;
832 1.1 chopps
833 1.1 chopps gup = (struct grf_ul_softc *)gp;
834 1.1 chopps
835 1.1 chopps if (minor(dev) & GRFIMDEV) {
836 1.1 chopps mxidx = 256;
837 1.1 chopps mymap = gup->gus_imcmap;
838 1.1 chopps } else {
839 1.1 chopps mxidx = 4;
840 1.1 chopps mymap = gup->gus_ovcmap;
841 1.1 chopps }
842 1.1 chopps
843 1.1 chopps if (cmap->count == 0 || cmap->index >= mxidx)
844 1.1 chopps return 0;
845 1.1 chopps
846 1.1 chopps if (cmap->index + cmap->count > mxidx)
847 1.1 chopps cmap->count = mxidx - cmap->index;
848 1.1 chopps
849 1.1 chopps /* first copyin to our shadow color map */
850 1.1 chopps
851 1.1 chopps if ((error = copyin(cmap->red, mymap + cmap->index, cmap->count))
852 1.1 chopps
853 1.1 chopps || (error = copyin(cmap->green, mymap + cmap->index + mxidx,
854 1.1 chopps cmap->count))
855 1.1 chopps
856 1.1 chopps || (error = copyin(cmap->blue, mymap + cmap->index + mxidx*2,
857 1.1 chopps cmap->count)))
858 1.1 chopps
859 1.1 chopps return error;
860 1.1 chopps
861 1.1 chopps
862 1.1 chopps /* then write from there to the hardware */
863 1.1 chopps ba = (struct gspregs *)gp->g_regkva;
864 1.9 chopps /*
865 1.9 chopps * XXX This is a bad thing to do.
866 1.9 chopps * We should always use the gsp call, or have a means to arbitrate
867 1.12 is * the usage of the BT458 index register. Else there might be a
868 1.9 chopps * race condition (when writing both colormaps at nearly the same
869 1.9 chopps * time), where one CPU changes the index register when the other
870 1.9 chopps * one has not finished using it.
871 1.9 chopps */
872 1.1 chopps if (mxidx > 4) {
873 1.1 chopps /* image color map: we can write, with a hack, directly */
874 1.1 chopps ba->ctrl = LBL;
875 1.1 chopps ba->hstadrh = 0xfe80;
876 1.1 chopps ba->hstadrl = 0x0000;
877 1.1 chopps ba->ctrl |= INCW;
878 1.1 chopps ba->data = cmap->index;
879 1.1 chopps ba->ctrl &= ~INCW;
880 1.1 chopps
881 1.1 chopps for (x=cmap->index; x < cmap->index + cmap->count; ++x) {
882 1.1 chopps ba->data = (u_int16_t) mymap[x];
883 1.1 chopps ba->data = (u_int16_t) mymap[x + mxidx];
884 1.1 chopps ba->data = (u_int16_t) mymap[x + mxidx * 2];
885 1.1 chopps }
886 1.1 chopps } else {
887 1.1 chopps
888 1.1 chopps /* overlay planes color map: have to call tms to do it */
889 1.1 chopps cmd[0] = GCMD_CMAP;
890 1.1 chopps cmd[1] = 1;
891 1.1 chopps for (x=cmap->index; x < cmap->index + cmap->count; ++x) {
892 1.1 chopps cmd[2] = x;
893 1.1 chopps cmd[3] = mymap[x];
894 1.1 chopps cmd[4] = mymap[x + mxidx];
895 1.1 chopps cmd[5] = mymap[x + mxidx * 2];
896 1.1 chopps gsp_write(ba, cmd, 6);
897 1.1 chopps }
898 1.1 chopps }
899 1.1 chopps return 0;
900 1.1 chopps }
901 1.1 chopps
902 1.10 chopps int
903 1.10 chopps ul_blank(gp, onoff, dev)
904 1.10 chopps struct grf_softc *gp;
905 1.10 chopps int *onoff;
906 1.10 chopps dev_t dev;
907 1.10 chopps {
908 1.10 chopps struct gspregs *gsp;
909 1.17 is
910 1.10 chopps gsp = (struct gspregs *)gp->g_regkva;
911 1.15 veego gsp->ctrl = (gsp->ctrl & ~(INCR | INCW)) | LBL;
912 1.10 chopps gsp->hstadrh = 0xC000;
913 1.10 chopps gsp->hstadrl = 0x0080;
914 1.18 is if (*onoff > 0)
915 1.10 chopps gsp->data |= 0x9000;
916 1.10 chopps else
917 1.10 chopps gsp->data &= ~0x9000;
918 1.10 chopps
919 1.10 chopps return 0;
920 1.10 chopps }
921 1.1 chopps /*
922 1.1 chopps * !!! THIS AREA UNDER CONSTRUCTION !!!
923 1.1 chopps */
924 1.1 chopps int ul_BltOpMap[16] = {
925 1.1 chopps 3, 1, 2, 0, 11, 9, 10, 8,
926 1.1 chopps 7, 5, 6, 4, 15, 13, 14, 12
927 1.1 chopps };
928 1.1 chopps
929 1.1 chopps int
930 1.1 chopps ul_bitblt (gp, bb, dev)
931 1.1 chopps struct grf_softc *gp;
932 1.1 chopps struct grf_bitblt *bb;
933 1.1 chopps dev_t dev;
934 1.1 chopps {
935 1.1 chopps /* XXX not yet implemented, but pretty trivial */
936 1.1 chopps return EINVAL;
937 1.1 chopps }
938 1.1 chopps
939 1.1 chopps void
940 1.1 chopps gsp_write(gsp, ptr, size)
941 1.1 chopps struct gspregs *gsp;
942 1.1 chopps u_short *ptr;
943 1.1 chopps size_t size;
944 1.1 chopps {
945 1.1 chopps u_short put, new_put, next, oc;
946 1.1 chopps u_long put_hi, oa;
947 1.1 chopps size_t n;
948 1.1 chopps
949 1.1 chopps if (size == 0 || size > 8)
950 1.1 chopps return;
951 1.1 chopps
952 1.1 chopps n = size;
953 1.1 chopps
954 1.1 chopps oc = gsp->ctrl;
955 1.1 chopps oa = GSPGETHADRS(gsp);
956 1.1 chopps
957 1.5 chopps gsp->ctrl = (oc & ~INCR) | LBL | INCW;
958 1.5 chopps GSPSETHADRS(gsp, GSP_MODE_ADRS);
959 1.1 chopps gsp->data &= ~GMODE_FLUSH;
960 1.1 chopps
961 1.5 chopps GSPSETHADRS(gsp, PUT_HI_PTR_ADRS);
962 1.1 chopps put_hi = gsp->data << 16;
963 1.1 chopps
964 1.5 chopps GSPSETHADRS(gsp, PUT_PTR_ADRS);
965 1.1 chopps put = gsp->data;
966 1.1 chopps new_put = put + (8<<4);
967 1.1 chopps
968 1.5 chopps GSPSETHADRS(gsp, GET_PTR_ADRS);
969 1.1 chopps next = gsp->data;
970 1.1 chopps
971 1.1 chopps while (next == new_put) {
972 1.1 chopps /*
973 1.1 chopps * we should use an intr. here. unfortunately, we already
974 1.1 chopps * are called from an interupt and can't use tsleep.
975 1.1 chopps * so we do busy waiting, at least for the moment.
976 1.1 chopps */
977 1.1 chopps
978 1.1 chopps GSPSETHADRS(gsp,GET_PTR_ADRS);
979 1.1 chopps next = gsp->data;
980 1.1 chopps }
981 1.1 chopps
982 1.1 chopps GSPSETHADRS(gsp,put|put_hi);
983 1.1 chopps gsp->data = *ptr++ | 8<<4;
984 1.1 chopps while ( --n > 0) {
985 1.1 chopps gsp->data = *ptr++;
986 1.1 chopps }
987 1.1 chopps
988 1.1 chopps GSPSETHADRS(gsp,PUT_PTR_ADRS);
989 1.1 chopps gsp->data = new_put;
990 1.1 chopps GSPSETHADRS(gsp,oa);
991 1.1 chopps gsp->ctrl = oc;
992 1.1 chopps
993 1.1 chopps return;
994 1.1 chopps }
995 1.1 chopps
996 1.1 chopps #endif /* NGRF */
997