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