grfabs_fal.c revision 1.5 1 1.5 leo /* $NetBSD: grfabs_fal.c,v 1.5 1996/08/23 11:14:59 leo Exp $ */
2 1.1 leo
3 1.1 leo /*
4 1.2 leo * Copyright (c) 1995 Thomas Gerner.
5 1.1 leo * Copyright (c) 1995 Leo Weppelman.
6 1.1 leo * All rights reserved.
7 1.1 leo *
8 1.1 leo * Redistribution and use in source and binary forms, with or without
9 1.1 leo * modification, are permitted provided that the following conditions
10 1.1 leo * are met:
11 1.1 leo * 1. Redistributions of source code must retain the above copyright
12 1.1 leo * notice, this list of conditions and the following disclaimer.
13 1.1 leo * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 leo * notice, this list of conditions and the following disclaimer in the
15 1.1 leo * documentation and/or other materials provided with the distribution.
16 1.1 leo * 3. All advertising materials mentioning features or use of this software
17 1.1 leo * must display the following acknowledgement:
18 1.1 leo * This product includes software developed by Leo Weppelman.
19 1.1 leo * 4. The name of the author may not be used to endorse or promote products
20 1.1 leo * derived from this software without specific prior written permission
21 1.1 leo *
22 1.1 leo * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 1.1 leo * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 1.1 leo * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 1.1 leo * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
26 1.1 leo * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
27 1.1 leo * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 1.1 leo * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 1.1 leo * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 1.1 leo * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
31 1.1 leo * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32 1.1 leo */
33 1.1 leo
34 1.1 leo #ifdef FALCON_VIDEO
35 1.1 leo /*
36 1.1 leo * atari abstract graphics driver: Falcon-interface
37 1.1 leo */
38 1.1 leo #include <sys/param.h>
39 1.1 leo #include <sys/queue.h>
40 1.1 leo #include <sys/malloc.h>
41 1.1 leo #include <sys/device.h>
42 1.4 leo #include <sys/systm.h>
43 1.1 leo
44 1.1 leo #include <machine/iomap.h>
45 1.1 leo #include <machine/video.h>
46 1.1 leo #include <machine/mfp.h>
47 1.1 leo #include <atari/atari/device.h>
48 1.4 leo #include <atari/atari/stalloc.h>
49 1.1 leo #include <atari/dev/grfabs_reg.h>
50 1.1 leo
51 1.1 leo /*
52 1.1 leo * Function decls
53 1.1 leo */
54 1.1 leo static void init_view __P((view_t *, bmap_t *, dmode_t *, box_t *));
55 1.1 leo static bmap_t *alloc_bitmap __P((u_long, u_long, u_char));
56 1.1 leo static colormap_t *alloc_colormap __P((dmode_t *));
57 1.1 leo static void free_bitmap __P((bmap_t *));
58 1.1 leo static void falcon_display_view __P((view_t *));
59 1.1 leo static view_t *falcon_alloc_view __P((dmode_t *, dimen_t *, u_char));
60 1.1 leo static void falcon_free_view __P((view_t *));
61 1.1 leo static void falcon_remove_view __P((view_t *));
62 1.1 leo static int falcon_use_colormap __P((view_t *, colormap_t *));
63 1.2 leo static void falcon_detect __P((dmode_t *));
64 1.3 leo static struct videl *falcon_getreg __P((u_short));
65 1.1 leo
66 1.1 leo /*
67 1.1 leo * Our function switch table
68 1.1 leo */
69 1.1 leo struct grfabs_sw fal_vid_sw = {
70 1.1 leo falcon_display_view,
71 1.1 leo falcon_alloc_view,
72 1.1 leo falcon_free_view,
73 1.1 leo falcon_remove_view,
74 1.1 leo falcon_use_colormap
75 1.1 leo };
76 1.1 leo
77 1.1 leo static dmode_t vid_modes[] = {
78 1.4 leo { {NULL,NULL}, "falauto", { 0, 0 }, 0, {RES_FALAUTO }, &fal_vid_sw},
79 1.4 leo { {NULL,NULL}, "sthigh", { 640,400 }, 1, {RES_FAL_STHIGH}, &fal_vid_sw},
80 1.4 leo { {NULL,NULL}, "stmid", { 640,200 }, 2, {RES_FAL_STMID }, &fal_vid_sw},
81 1.4 leo { {NULL,NULL}, "stlow", { 320,200 }, 4, {RES_FAL_STLOW }, &fal_vid_sw},
82 1.4 leo { {NULL,NULL}, "ttlow", { 320,480 }, 8, {RES_FAL_TTLOW }, &fal_vid_sw},
83 1.4 leo { {NULL,NULL}, "vga2", { 640,480 }, 1, {RES_VGA2 }, &fal_vid_sw},
84 1.4 leo { {NULL,NULL}, "vga4", { 640,480 }, 2, {RES_VGA4 }, &fal_vid_sw},
85 1.4 leo { {NULL,NULL}, "vga16", { 640,480 }, 4, {RES_VGA16 }, &fal_vid_sw},
86 1.4 leo { {NULL,NULL}, "vga256", { 640,480 }, 8, {RES_VGA256 }, &fal_vid_sw},
87 1.4 leo { {NULL,NULL}, "highcol", { 320,200 }, 16, {RES_DIRECT }, &fal_vid_sw},
88 1.3 leo { {NULL,NULL}, NULL, }
89 1.1 leo };
90 1.1 leo
91 1.1 leo /*
92 1.2 leo * The following table contains timing values for the various video modes.
93 1.3 leo * I have only a multisync display, therefore I can not say if this values
94 1.3 leo * are useful at other displays.
95 1.2 leo * Use other video modes at YOUR OWN RISK.
96 1.2 leo * THERE IS NO WARRENTY ABOUT THIS VALUES TO WORK WITH A PARTICULAR
97 1.3 leo * DISPLAY. -- Thomas
98 1.2 leo */
99 1.2 leo static struct videl videlinit[] = {
100 1.3 leo { RES_FALAUTO, /* autodedect */
101 1.2 leo 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
102 1.2 leo 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0 },
103 1.2 leo
104 1.3 leo { FAL_VGA | RES_FAL_STHIGH, /* sthigh, 640x400, 2 colors */
105 1.2 leo 0x2, 0x0, 0x28, 0x0, 0x400, 0xc6, 0x8d, 0x15, 0x273, 0x50, 0x96, 0x0,
106 1.2 leo 0x0, 0x419, 0x3af, 0x8f, 0x8f, 0x3af, 0x415, 0x186, 0x8 },
107 1.2 leo
108 1.3 leo #if 0 /* not yet */
109 1.3 leo { FAL_SM | RES_FAL_STHIGH, /* sthigh, 640x400, 2 colors */
110 1.3 leo 0x0, 0x0, 0x28, 0x2, 0x0, 0x1a, 0x0, 0x0, 0x20f, 0xc, 0x14, 0x0,
111 1.3 leo 0x0, 0x3e9, 0x0, 0x0, 0x43, 0x363, 0x3e7, 0x80, 0x8 },
112 1.3 leo #endif
113 1.3 leo
114 1.3 leo { FAL_VGA | RES_FAL_STMID, /* stmid, 640x200, 4 colors */
115 1.2 leo 0x2, 0x0, 0x50, 0x1, 0x0, 0x17, 0x12, 0x1, 0x20e, 0xd, 0x11, 0x0,
116 1.2 leo 0x0, 0x419, 0x3af, 0x8f, 0x8f, 0x3af, 0x415, 0x186, 0x9 },
117 1.2 leo
118 1.3 leo { FAL_VGA | RES_FAL_STLOW, /* stlow, 320x200, 16 colors */
119 1.2 leo 0x2, 0x0, 0x50, 0x0, 0x0, 0x17, 0x12, 0x1, 0x20e, 0xd, 0x11, 0x0,
120 1.2 leo 0x0, 0x419, 0x3af, 0x8f, 0x8f, 0x3af, 0x415, 0x186, 0x5 },
121 1.2 leo
122 1.3 leo { FAL_VGA | RES_FAL_TTLOW, /* ttlow, 320x480, 256 colors */
123 1.2 leo 0x2, 0x0, 0xa0, 0x0, 0x10, 0xc6, 0x8d, 0x15, 0x29a, 0x7b, 0x96, 0x0,
124 1.2 leo 0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x4 },
125 1.2 leo
126 1.3 leo { FAL_VGA | RES_VGA2, /* vga, 640x480, 2 colors */
127 1.2 leo 0x2, 0x0, 0x28, 0x0, 0x400, 0xc6, 0x8d, 0x15, 0x273, 0x50, 0x96, 0x0,
128 1.2 leo 0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
129 1.2 leo
130 1.3 leo { FAL_VGA | RES_VGA4, /* vga, 640x480, 4 colors */
131 1.2 leo 0x2, 0x0, 0x50, 0x1, 0x0, 0x17, 0x12, 0x1, 0x20e, 0xd, 0x11, 0x0,
132 1.2 leo 0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
133 1.2 leo
134 1.3 leo { FAL_VGA | RES_VGA16, /* vga, 640x480, 16 colors */
135 1.2 leo 0x2, 0x0, 0xa0, 0x1, 0x0, 0xc6, 0x8d, 0x15, 0x2a3, 0x7c, 0x96, 0x0,
136 1.2 leo 0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
137 1.2 leo
138 1.3 leo { FAL_VGA | RES_VGA256, /* vga, 640x480, 256 colors */
139 1.2 leo 0x2, 0x0, 0x140, 0x1, 0x10, 0xc6, 0x8d, 0x15, 0x2ab, 0x84, 0x96, 0x0,
140 1.2 leo 0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x8 },
141 1.2 leo
142 1.3 leo { FAL_VGA | RES_DIRECT, /* direct video, 320x200, 65536 colors */
143 1.2 leo 0x2, 0x0, 0x140, 0x0, 0x100, 0xc6, 0x8d, 0x15, 0x2ac, 0x91, 0x96, 0x0,
144 1.2 leo 0x0, 0x419, 0x3ff, 0x3f, 0x3f, 0x3ff, 0x415, 0x186, 0x4 },
145 1.2 leo
146 1.3 leo { 0xffff } /* end of list */
147 1.2 leo };
148 1.2 leo
149 1.3 leo static u_short mon_type;
150 1.2 leo /*
151 1.1 leo * XXX: called from ite console init routine.
152 1.1 leo * Initialize list of posible video modes.
153 1.1 leo */
154 1.1 leo void
155 1.1 leo falcon_probe_video(modelp)
156 1.1 leo MODES *modelp;
157 1.1 leo {
158 1.1 leo dmode_t *dm;
159 1.3 leo struct videl *vregs;
160 1.1 leo int i;
161 1.1 leo
162 1.5 leo mon_type = *(volatile unsigned char *)(AD_FAL_MON_TYPE);
163 1.3 leo mon_type = (mon_type & 0xc0) << 2;
164 1.3 leo
165 1.3 leo /*
166 1.3 leo * get all posible modes
167 1.1 leo */
168 1.1 leo
169 1.1 leo for (i = 0; (dm = &vid_modes[i])->name != NULL; i++) {
170 1.3 leo if (dm->vm_mode == RES_FALAUTO) {
171 1.3 leo dm->vm_regs = falcon_getreg(RES_FALAUTO);
172 1.2 leo falcon_detect(dm);
173 1.2 leo LIST_INSERT_HEAD(modelp, dm, link);
174 1.3 leo } else {
175 1.3 leo vregs = falcon_getreg(dm->vm_mode | mon_type);
176 1.3 leo if (vregs) {
177 1.3 leo dm->vm_regs = vregs;
178 1.3 leo LIST_INSERT_HEAD(modelp, dm, link);
179 1.3 leo }
180 1.3 leo }
181 1.1 leo }
182 1.1 leo
183 1.1 leo /*
184 1.1 leo * This seems to prevent bordered screens.
185 1.1 leo */
186 1.1 leo for (i=0; i < 16; i++)
187 1.1 leo VIDEO->vd_fal_rgb[i] = CM_L2FAL(gra_def_color16[i]);
188 1.1 leo }
189 1.1 leo
190 1.2 leo static struct videl *
191 1.3 leo falcon_getreg(mode)
192 1.3 leo u_short mode;
193 1.2 leo {
194 1.2 leo int i;
195 1.2 leo struct videl *vregs;
196 1.2 leo
197 1.3 leo for (i = 0; (vregs = &videlinit[i])->video_mode != 0xffff; i++)
198 1.3 leo if ((vregs->video_mode) == mode)
199 1.2 leo return vregs;
200 1.2 leo
201 1.3 leo return NULL; /* mode not found */
202 1.2 leo }
203 1.2 leo
204 1.1 leo static void
205 1.2 leo falcon_detect(dm)
206 1.1 leo dmode_t *dm;
207 1.1 leo {
208 1.1 leo u_short falshift, stshift;
209 1.3 leo struct videl *vregs = dm->vm_regs;
210 1.1 leo
211 1.2 leo /*
212 1.2 leo * First get the the videl register values
213 1.2 leo */
214 1.2 leo
215 1.2 leo vregs->vd_syncmode = VIDEO->vd_sync;
216 1.2 leo vregs->vd_line_wide = VIDEO->vd_line_wide;
217 1.2 leo vregs->vd_vert_wrap = VIDEO->vd_vert_wrap;
218 1.2 leo vregs->vd_st_res = VIDEO->vd_st_res;
219 1.2 leo vregs->vd_fal_res = VIDEO->vd_fal_res;
220 1.2 leo vregs->vd_h_hold_tim = VIDEO->vd_h_hold_tim;
221 1.2 leo vregs->vd_h_bord_beg = VIDEO->vd_h_bord_beg;
222 1.2 leo vregs->vd_h_bord_end = VIDEO->vd_h_bord_end;
223 1.2 leo vregs->vd_h_dis_beg = VIDEO->vd_h_dis_beg;
224 1.2 leo vregs->vd_h_dis_end = VIDEO->vd_h_dis_end;
225 1.2 leo vregs->vd_h_ss = VIDEO->vd_h_ss;
226 1.2 leo vregs->vd_h_fs = VIDEO->vd_h_fs;
227 1.2 leo vregs->vd_h_hh = VIDEO->vd_h_hh;
228 1.2 leo vregs->vd_v_freq_tim = VIDEO->vd_v_freq_tim;
229 1.2 leo vregs->vd_v_bord_beg = VIDEO->vd_v_bord_beg;
230 1.2 leo vregs->vd_v_bord_end = VIDEO->vd_v_bord_end;
231 1.2 leo vregs->vd_v_dis_beg = VIDEO->vd_v_dis_beg;
232 1.2 leo vregs->vd_v_dis_end = VIDEO->vd_v_dis_end;
233 1.2 leo vregs->vd_v_ss = VIDEO->vd_v_ss;
234 1.2 leo vregs->vd_fal_ctrl = VIDEO->vd_fal_ctrl;
235 1.2 leo vregs->vd_fal_mode = VIDEO->vd_fal_mode;
236 1.2 leo
237 1.1 leo
238 1.1 leo /*
239 1.1 leo * Calculate the depth of the screen
240 1.1 leo */
241 1.1 leo
242 1.2 leo falshift = vregs->vd_fal_res;
243 1.2 leo stshift = vregs->vd_st_res;
244 1.1 leo
245 1.1 leo if (falshift & 0x400) /* 2 color */
246 1.1 leo dm->depth = 1;
247 1.1 leo else if (falshift & 0x100) /* high color, direct */
248 1.1 leo dm->depth = 16;
249 1.1 leo else if (falshift & 0x10) /* 256 color */
250 1.1 leo dm->depth = 8;
251 1.1 leo else if (stshift == 0) /* 16 color */
252 1.1 leo dm->depth = 4;
253 1.1 leo else if (stshift == 1) /* 4 color */
254 1.1 leo dm->depth = 2;
255 1.1 leo else dm->depth = 1; /* 2 color */
256 1.1 leo
257 1.1 leo /*
258 1.1 leo * Now calculate the screen hight
259 1.1 leo */
260 1.1 leo
261 1.2 leo dm->size.height = vregs->vd_v_dis_end - vregs->vd_v_dis_beg;
262 1.2 leo if (!((vregs->vd_fal_mode & 0x2) >> 1)) /* if not interlaced */
263 1.2 leo dm->size.height >>=1;
264 1.2 leo if (vregs->vd_fal_mode & 0x1) /* if doublescan */
265 1.2 leo dm->size.height >>=1;
266 1.1 leo
267 1.1 leo /*
268 1.1 leo * And the width
269 1.1 leo */
270 1.1 leo
271 1.2 leo dm->size.width = vregs->vd_vert_wrap * 16 / dm->depth;
272 1.2 leo
273 1.1 leo }
274 1.1 leo
275 1.1 leo static void
276 1.1 leo falcon_display_view(v)
277 1.1 leo view_t *v;
278 1.1 leo {
279 1.1 leo dmode_t *dm = v->mode;
280 1.1 leo bmap_t *bm = v->bitmap;
281 1.3 leo struct videl *vregs = v->mode->vm_regs;
282 1.1 leo
283 1.1 leo if (dm->current_view) {
284 1.1 leo /*
285 1.1 leo * Mark current view for this mode as no longer displayed
286 1.1 leo */
287 1.1 leo dm->current_view->flags &= ~VF_DISPLAY;
288 1.1 leo }
289 1.1 leo dm->current_view = v;
290 1.1 leo v->flags |= VF_DISPLAY;
291 1.1 leo
292 1.1 leo falcon_use_colormap(v, v->colormap);
293 1.1 leo
294 1.3 leo /* XXX: should use vbl for this */
295 1.3 leo
296 1.1 leo VIDEO->vd_raml = (u_long)bm->hw_address & 0xff;
297 1.1 leo VIDEO->vd_ramm = ((u_long)bm->hw_address >> 8) & 0xff;
298 1.1 leo VIDEO->vd_ramh = ((u_long)bm->hw_address >> 16) & 0xff;
299 1.3 leo
300 1.3 leo /*
301 1.3 leo * Write to videl registers only on VGA displays
302 1.3 leo * This is only a hack. Must be fixed soon. XXX -- Thomas
303 1.3 leo */
304 1.3 leo if(mon_type != FAL_VGA) return;
305 1.2 leo
306 1.2 leo VIDEO->vd_v_freq_tim = vregs->vd_v_freq_tim;
307 1.2 leo VIDEO->vd_v_ss = vregs->vd_v_ss;
308 1.2 leo VIDEO->vd_v_bord_beg = vregs->vd_v_bord_beg;
309 1.2 leo VIDEO->vd_v_bord_end = vregs->vd_v_bord_end;
310 1.2 leo VIDEO->vd_v_dis_beg = vregs->vd_v_dis_beg;
311 1.2 leo VIDEO->vd_v_dis_end = vregs->vd_v_dis_end;
312 1.2 leo VIDEO->vd_h_hold_tim = vregs->vd_h_hold_tim;
313 1.2 leo VIDEO->vd_h_ss = vregs->vd_h_ss;
314 1.2 leo VIDEO->vd_h_bord_beg = vregs->vd_h_bord_beg;
315 1.2 leo VIDEO->vd_h_bord_end = vregs->vd_h_bord_end;
316 1.2 leo VIDEO->vd_h_dis_beg = vregs->vd_h_dis_beg;
317 1.2 leo VIDEO->vd_h_dis_end = vregs->vd_h_dis_end;
318 1.2 leo #if 0 /* This seems not to be necessary -- Thomas */
319 1.2 leo VIDEO->vd_h_fs = vregs->vd_h_fs;
320 1.2 leo VIDEO->vd_h_hh = vregs->vd_h_hh;
321 1.2 leo #endif
322 1.2 leo VIDEO->vd_sync = vregs->vd_syncmode;
323 1.2 leo VIDEO->vd_fal_res = 0;
324 1.2 leo if (dm->depth == 2)
325 1.2 leo VIDEO->vd_st_res = vregs->vd_st_res;
326 1.2 leo else {
327 1.2 leo VIDEO->vd_st_res = 0;
328 1.2 leo VIDEO->vd_fal_res = vregs->vd_fal_res;
329 1.2 leo }
330 1.2 leo VIDEO->vd_vert_wrap = vregs->vd_vert_wrap;
331 1.2 leo VIDEO->vd_line_wide = vregs->vd_line_wide;
332 1.2 leo VIDEO->vd_fal_ctrl = vregs->vd_fal_ctrl;
333 1.2 leo VIDEO->vd_fal_mode = vregs->vd_fal_mode;
334 1.1 leo }
335 1.1 leo
336 1.1 leo static void
337 1.1 leo falcon_remove_view(v)
338 1.1 leo view_t *v;
339 1.1 leo {
340 1.1 leo dmode_t *mode = v->mode;
341 1.1 leo
342 1.1 leo if (mode->current_view == v) {
343 1.1 leo #if 0
344 1.1 leo if (v->flags & VF_DISPLAY)
345 1.1 leo panic("Cannot shutdown display\n"); /* XXX */
346 1.1 leo #endif
347 1.1 leo mode->current_view = NULL;
348 1.1 leo }
349 1.1 leo v->flags &= ~VF_DISPLAY;
350 1.1 leo }
351 1.1 leo
352 1.1 leo static void
353 1.1 leo falcon_free_view(v)
354 1.1 leo view_t *v;
355 1.1 leo {
356 1.1 leo if (v) {
357 1.1 leo falcon_remove_view(v);
358 1.1 leo if (v->colormap != &gra_con_cmap)
359 1.1 leo free(v->colormap, M_DEVBUF);
360 1.1 leo free_bitmap(v->bitmap);
361 1.1 leo if (v != &gra_con_view)
362 1.1 leo free(v, M_DEVBUF);
363 1.1 leo }
364 1.1 leo }
365 1.1 leo
366 1.1 leo static int
367 1.1 leo falcon_use_colormap(v, cm)
368 1.1 leo view_t *v;
369 1.1 leo colormap_t *cm;
370 1.1 leo {
371 1.1 leo dmode_t *dm;
372 1.1 leo volatile u_short *creg;
373 1.1 leo volatile u_long *fcreg;
374 1.1 leo u_long *src;
375 1.1 leo colormap_t *vcm;
376 1.1 leo u_long *vcreg;
377 1.1 leo u_short ncreg;
378 1.1 leo int i;
379 1.1 leo
380 1.1 leo dm = v->mode;
381 1.1 leo vcm = v->colormap;
382 1.1 leo
383 1.1 leo /*
384 1.1 leo * I guess it seems reasonable to require the maps to be
385 1.1 leo * of the same type...
386 1.1 leo */
387 1.1 leo if (cm->type != vcm->type)
388 1.1 leo return (EINVAL);
389 1.1 leo
390 1.1 leo /*
391 1.1 leo * First get the colormap addresses an calculate
392 1.1 leo * howmany colors are in it.
393 1.1 leo */
394 1.1 leo if (dm->depth == 16) /* direct color, no colormap;
395 1.1 leo but also not (yet) supported */
396 1.1 leo return(0);
397 1.1 leo fcreg = &VIDEO->vd_fal_rgb[0];
398 1.1 leo creg = &VIDEO->vd_st_rgb[0];
399 1.1 leo ncreg = 1 << dm->depth;
400 1.1 leo
401 1.1 leo /* If first entry specified beyond capabilities -> error */
402 1.1 leo if (cm->first >= ncreg)
403 1.1 leo return (EINVAL);
404 1.1 leo
405 1.1 leo /*
406 1.1 leo * A little tricky, the actual colormap pointer will be NULL
407 1.1 leo * when view is not displaying, valid otherwise.
408 1.1 leo */
409 1.1 leo if (v->flags & VF_DISPLAY)
410 1.1 leo creg = &creg[cm->first];
411 1.1 leo else creg = NULL;
412 1.1 leo
413 1.1 leo vcreg = &vcm->entry[cm->first];
414 1.1 leo ncreg -= cm->first;
415 1.1 leo if (cm->size > ncreg)
416 1.1 leo return (EINVAL);
417 1.1 leo ncreg = cm->size;
418 1.1 leo
419 1.1 leo for (i = 0, src = cm->entry; i < ncreg; i++, vcreg++) {
420 1.1 leo *vcreg = *src++;
421 1.1 leo
422 1.1 leo /*
423 1.1 leo * If displaying, also update actual color register.
424 1.1 leo */
425 1.1 leo if (creg != NULL) {
426 1.1 leo *fcreg++ = CM_L2FAL(*vcreg);
427 1.1 leo if (i < 16 )
428 1.1 leo *creg++ = CM_L2ST(*vcreg);
429 1.1 leo }
430 1.1 leo }
431 1.1 leo return (0);
432 1.1 leo }
433 1.1 leo
434 1.1 leo static view_t *
435 1.1 leo falcon_alloc_view(mode, dim, depth)
436 1.1 leo dmode_t *mode;
437 1.1 leo dimen_t *dim;
438 1.1 leo u_char depth;
439 1.1 leo {
440 1.1 leo view_t *v;
441 1.1 leo bmap_t *bm;
442 1.1 leo
443 1.1 leo if (!atari_realconfig)
444 1.1 leo v = &gra_con_view;
445 1.1 leo else v = malloc(sizeof(*v), M_DEVBUF, M_NOWAIT);
446 1.1 leo if (v == NULL)
447 1.1 leo return(NULL);
448 1.1 leo
449 1.1 leo bm = alloc_bitmap(mode->size.width, mode->size.height, mode->depth);
450 1.1 leo if (bm) {
451 1.1 leo box_t box;
452 1.1 leo
453 1.1 leo v->colormap = alloc_colormap(mode);
454 1.1 leo if (v->colormap) {
455 1.1 leo INIT_BOX(&box,0,0,mode->size.width,mode->size.height);
456 1.1 leo init_view(v, bm, mode, &box);
457 1.1 leo return(v);
458 1.1 leo }
459 1.1 leo free_bitmap(bm);
460 1.1 leo }
461 1.1 leo if (v != &gra_con_view)
462 1.1 leo free(v, M_DEVBUF);
463 1.1 leo return (NULL);
464 1.1 leo }
465 1.1 leo
466 1.1 leo static void
467 1.1 leo init_view(v, bm, mode, dbox)
468 1.1 leo view_t *v;
469 1.1 leo bmap_t *bm;
470 1.1 leo dmode_t *mode;
471 1.1 leo box_t *dbox;
472 1.1 leo {
473 1.1 leo v->bitmap = bm;
474 1.1 leo v->mode = mode;
475 1.1 leo v->flags = 0;
476 1.1 leo bcopy(dbox, &v->display, sizeof(box_t));
477 1.1 leo }
478 1.1 leo
479 1.1 leo /* bitmap functions */
480 1.1 leo
481 1.1 leo static bmap_t *
482 1.1 leo alloc_bitmap(width, height, depth)
483 1.1 leo u_long width, height;
484 1.1 leo u_char depth;
485 1.1 leo {
486 1.1 leo u_long total_size, bm_size;
487 1.1 leo void *hw_address;
488 1.1 leo bmap_t *bm;
489 1.1 leo
490 1.1 leo /*
491 1.1 leo * Sigh, it seems for mapping to work we need the bitplane data to
492 1.1 leo * 1: be aligned on a page boundry.
493 1.1 leo * 2: be n pages large.
494 1.1 leo *
495 1.1 leo * why? because the user gets a page aligned address, if this is before
496 1.1 leo * your allocation, too bad. Also it seems that the mapping routines
497 1.1 leo * do not watch to closely to the allowable length. so if you go over
498 1.1 leo * n pages by less than another page, the user gets to write all over
499 1.1 leo * the entire page. Since you did not allocate up to a page boundry
500 1.1 leo * (or more) the user writes into someone elses memory. -ch
501 1.1 leo */
502 1.1 leo bm_size = atari_round_page((width * height * depth) / NBBY);
503 1.1 leo total_size = bm_size + sizeof(bmap_t) + NBPG;
504 1.1 leo
505 1.1 leo if ((bm = (bmap_t*)alloc_stmem(total_size, &hw_address)) == NULL)
506 1.1 leo return(NULL);
507 1.1 leo
508 1.1 leo bm->plane = (u_char*)bm + sizeof(bmap_t);
509 1.1 leo bm->plane = (u_char*)atari_round_page(bm->plane);
510 1.1 leo bm->hw_address = (u_char*)hw_address + sizeof(bmap_t);
511 1.1 leo bm->hw_address = (u_char*)atari_round_page(bm->hw_address);
512 1.1 leo bm->bytes_per_row = (width * depth) / NBBY;
513 1.1 leo bm->rows = height;
514 1.1 leo bm->depth = depth;
515 1.1 leo
516 1.1 leo bzero(bm->plane, bm_size);
517 1.1 leo return (bm);
518 1.1 leo }
519 1.1 leo
520 1.1 leo static void
521 1.1 leo free_bitmap(bm)
522 1.1 leo bmap_t *bm;
523 1.1 leo {
524 1.1 leo if (bm)
525 1.1 leo free_stmem(bm);
526 1.1 leo }
527 1.1 leo
528 1.1 leo static colormap_t *
529 1.1 leo alloc_colormap(dm)
530 1.1 leo dmode_t *dm;
531 1.1 leo {
532 1.1 leo int nentries, i;
533 1.1 leo colormap_t *cm;
534 1.1 leo u_char type = CM_COLOR;
535 1.1 leo
536 1.1 leo if (dm->depth == 16) /* direct color, no colormap;
537 1.1 leo not (yet) supported */
538 1.1 leo nentries = 0;
539 1.1 leo else
540 1.1 leo nentries = 1 << dm->depth;
541 1.1 leo
542 1.1 leo if (!atari_realconfig) {
543 1.1 leo cm = &gra_con_cmap;
544 1.1 leo cm->entry = gra_con_colors;
545 1.1 leo }
546 1.1 leo else {
547 1.1 leo int size;
548 1.1 leo
549 1.1 leo size = sizeof(*cm) + (nentries * sizeof(cm->entry[0]));
550 1.1 leo cm = malloc(size, M_DEVBUF, M_NOWAIT);
551 1.1 leo if (cm == NULL)
552 1.1 leo return(NULL);
553 1.1 leo cm->entry = (long *)&cm[1];
554 1.1 leo
555 1.1 leo }
556 1.1 leo
557 1.1 leo if ((cm->type = type) == CM_COLOR)
558 1.1 leo cm->red_mask = cm->green_mask = cm->blue_mask = 0x3f;
559 1.1 leo
560 1.1 leo cm->first = 0;
561 1.1 leo cm->size = nentries;
562 1.1 leo
563 1.1 leo for (i = 0; i < nentries; i++)
564 1.1 leo cm->entry[i] = gra_def_color16[i % 16];
565 1.1 leo return (cm);
566 1.1 leo }
567 1.1 leo #endif /* FALCON_VIDEO */
568