cfb.c revision 1.26 1 1.26 nisimura /* $NetBSD: cfb.c,v 1.26 2001/01/16 05:32:16 nisimura Exp $ */
2 1.2 nisimura
3 1.2 nisimura /*
4 1.12 nisimura * Copyright (c) 1998, 1999 Tohru Nishimura. All rights reserved.
5 1.2 nisimura *
6 1.2 nisimura * Redistribution and use in source and binary forms, with or without
7 1.2 nisimura * modification, are permitted provided that the following conditions
8 1.2 nisimura * are met:
9 1.2 nisimura * 1. Redistributions of source code must retain the above copyright
10 1.2 nisimura * notice, this list of conditions and the following disclaimer.
11 1.2 nisimura * 2. Redistributions in binary form must reproduce the above copyright
12 1.2 nisimura * notice, this list of conditions and the following disclaimer in the
13 1.2 nisimura * documentation and/or other materials provided with the distribution.
14 1.2 nisimura * 3. All advertising materials mentioning features or use of this software
15 1.2 nisimura * must display the following acknowledgement:
16 1.2 nisimura * This product includes software developed by Tohru Nishimura
17 1.2 nisimura * for the NetBSD Project.
18 1.2 nisimura * 4. The name of the author may not be used to endorse or promote products
19 1.2 nisimura * derived from this software without specific prior written permission
20 1.2 nisimura *
21 1.2 nisimura * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 1.2 nisimura * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 1.2 nisimura * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 1.2 nisimura * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 1.2 nisimura * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 1.2 nisimura * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 1.2 nisimura * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.2 nisimura * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 1.2 nisimura * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 1.2 nisimura * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 1.2 nisimura */
32 1.1 nisimura
33 1.1 nisimura #include <sys/cdefs.h> /* RCS ID & Copyright macro defns */
34 1.1 nisimura
35 1.26 nisimura __KERNEL_RCSID(0, "$NetBSD: cfb.c,v 1.26 2001/01/16 05:32:16 nisimura Exp $");
36 1.1 nisimura
37 1.1 nisimura #include <sys/param.h>
38 1.1 nisimura #include <sys/systm.h>
39 1.1 nisimura #include <sys/kernel.h>
40 1.1 nisimura #include <sys/device.h>
41 1.1 nisimura #include <sys/malloc.h>
42 1.1 nisimura #include <sys/buf.h>
43 1.1 nisimura #include <sys/ioctl.h>
44 1.1 nisimura
45 1.1 nisimura #include <machine/bus.h>
46 1.1 nisimura #include <machine/intr.h>
47 1.1 nisimura
48 1.1 nisimura #include <dev/wscons/wsconsio.h>
49 1.1 nisimura #include <dev/wscons/wsdisplayvar.h>
50 1.1 nisimura
51 1.18 nisimura #include <dev/rasops/rasops.h>
52 1.18 nisimura #include <dev/wsfont/wsfont.h>
53 1.18 nisimura
54 1.1 nisimura #include <dev/tc/tcvar.h>
55 1.1 nisimura #include <dev/ic/bt459reg.h>
56 1.1 nisimura
57 1.1 nisimura #include <uvm/uvm_extern.h>
58 1.1 nisimura
59 1.7 thorpej #if defined(pmax)
60 1.1 nisimura #define machine_btop(x) mips_btop(x)
61 1.1 nisimura #define MACHINE_KSEG0_TO_PHYS(x) MIPS_KSEG1_TO_PHYS(x)
62 1.1 nisimura #endif
63 1.1 nisimura
64 1.26 nisimura #if defined(alpha)
65 1.1 nisimura #define machine_btop(x) alpha_btop(x)
66 1.1 nisimura #define MACHINE_KSEG0_TO_PHYS(x) ALPHA_K0SEG_TO_PHYS(x)
67 1.1 nisimura #endif
68 1.1 nisimura
69 1.1 nisimura /*
70 1.1 nisimura * N.B., Bt459 registers are 8bit width. Some of TC framebuffers have
71 1.3 nisimura * obscure register layout such as 2nd and 3rd Bt459 registers are
72 1.3 nisimura * adjacent each other in a word, i.e.,
73 1.1 nisimura * struct bt459triplet {
74 1.1 nisimura * struct {
75 1.1 nisimura * u_int8_t u0;
76 1.1 nisimura * u_int8_t u1;
77 1.1 nisimura * u_int8_t u2;
78 1.1 nisimura * unsigned :8;
79 1.1 nisimura * } bt_lo;
80 1.1 nisimura * ...
81 1.1 nisimura * Although CX has single Bt459, 32bit R/W can be done w/o any trouble.
82 1.26 nisimura * struct bt459reg {
83 1.26 nisimura * u_int32_t bt_lo;
84 1.26 nisimura * u_int32_t bt_hi;
85 1.26 nisimura * u_int32_t bt_reg;
86 1.26 nisimura * u_int32_t bt_cmap;
87 1.26 nisimura * };
88 1.1 nisimura */
89 1.2 nisimura
90 1.12 nisimura /* Bt459 hardware registers */
91 1.12 nisimura #define bt_lo 0
92 1.12 nisimura #define bt_hi 1
93 1.12 nisimura #define bt_reg 2
94 1.12 nisimura #define bt_cmap 3
95 1.12 nisimura
96 1.12 nisimura #define REG(base, index) *((u_int32_t *)(base) + (index))
97 1.12 nisimura #define SELECT(vdac, regno) do { \
98 1.12 nisimura REG(vdac, bt_lo) = ((regno) & 0x00ff); \
99 1.12 nisimura REG(vdac, bt_hi) = ((regno) & 0x0f00) >> 8; \
100 1.12 nisimura tc_wmb(); \
101 1.12 nisimura } while (0)
102 1.1 nisimura
103 1.1 nisimura struct fb_devconfig {
104 1.1 nisimura vaddr_t dc_vaddr; /* memory space virtual base address */
105 1.1 nisimura paddr_t dc_paddr; /* memory space physical base address */
106 1.26 nisimura vsize_t dc_size; /* size of slot memory */
107 1.1 nisimura int dc_wid; /* width of frame buffer */
108 1.1 nisimura int dc_ht; /* height of frame buffer */
109 1.1 nisimura int dc_depth; /* depth, bits per pixel */
110 1.1 nisimura int dc_rowbytes; /* bytes in a FB scan line */
111 1.26 nisimura vaddr_t dc_videobase; /* base of flat frame buffer */
112 1.26 nisimura int dc_blanked; /* currently has video disabled */
113 1.18 nisimura
114 1.18 nisimura struct rasops_info rinfo;
115 1.1 nisimura };
116 1.1 nisimura
117 1.11 nisimura struct hwcmap256 {
118 1.1 nisimura #define CMAP_SIZE 256 /* 256 R/G/B entries */
119 1.1 nisimura u_int8_t r[CMAP_SIZE];
120 1.1 nisimura u_int8_t g[CMAP_SIZE];
121 1.1 nisimura u_int8_t b[CMAP_SIZE];
122 1.1 nisimura };
123 1.1 nisimura
124 1.11 nisimura struct hwcursor64 {
125 1.1 nisimura struct wsdisplay_curpos cc_pos;
126 1.1 nisimura struct wsdisplay_curpos cc_hot;
127 1.1 nisimura struct wsdisplay_curpos cc_size;
128 1.11 nisimura struct wsdisplay_curpos cc_magic;
129 1.1 nisimura #define CURSOR_MAX_SIZE 64
130 1.1 nisimura u_int8_t cc_color[6];
131 1.1 nisimura u_int64_t cc_image[64 + 64];
132 1.1 nisimura };
133 1.1 nisimura
134 1.1 nisimura struct cfb_softc {
135 1.1 nisimura struct device sc_dev;
136 1.1 nisimura struct fb_devconfig *sc_dc; /* device configuration */
137 1.11 nisimura struct hwcmap256 sc_cmap; /* software copy of colormap */
138 1.11 nisimura struct hwcursor64 sc_cursor; /* software copy of cursor */
139 1.1 nisimura int sc_curenb; /* cursor sprite enabled */
140 1.26 nisimura int sc_changed; /* need update of hardware */
141 1.26 nisimura #define WSDISPLAY_CMAP_DOLUT 0x20
142 1.1 nisimura int nscreens;
143 1.11 nisimura };
144 1.11 nisimura
145 1.12 nisimura #define CX_MAGIC_X 220
146 1.12 nisimura #define CX_MAGIC_Y 35
147 1.1 nisimura
148 1.3 nisimura #define CX_FB_OFFSET 0x000000
149 1.3 nisimura #define CX_FB_SIZE 0x100000
150 1.3 nisimura #define CX_BT459_OFFSET 0x200000
151 1.3 nisimura #define CX_OFFSET_IREQ 0x300000 /* Interrupt req. control */
152 1.3 nisimura
153 1.14 nisimura static int cfbmatch __P((struct device *, struct cfdata *, void *));
154 1.14 nisimura static void cfbattach __P((struct device *, struct device *, void *));
155 1.1 nisimura
156 1.14 nisimura const struct cfattach cfb_ca = {
157 1.1 nisimura sizeof(struct cfb_softc), cfbmatch, cfbattach,
158 1.1 nisimura };
159 1.1 nisimura
160 1.14 nisimura static void cfb_getdevconfig __P((tc_addr_t, struct fb_devconfig *));
161 1.14 nisimura static struct fb_devconfig cfb_console_dc;
162 1.14 nisimura static tc_addr_t cfb_consaddr;
163 1.1 nisimura
164 1.14 nisimura static struct wsscreen_descr cfb_stdscreen = {
165 1.1 nisimura "std", 0, 0,
166 1.18 nisimura 0, /* textops */
167 1.1 nisimura 0, 0,
168 1.13 nisimura WSSCREEN_REVERSE
169 1.1 nisimura };
170 1.1 nisimura
171 1.14 nisimura static const struct wsscreen_descr *_cfb_scrlist[] = {
172 1.1 nisimura &cfb_stdscreen,
173 1.1 nisimura };
174 1.1 nisimura
175 1.14 nisimura static const struct wsscreen_list cfb_screenlist = {
176 1.1 nisimura sizeof(_cfb_scrlist) / sizeof(struct wsscreen_descr *), _cfb_scrlist
177 1.1 nisimura };
178 1.1 nisimura
179 1.21 simonb static int cfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
180 1.21 simonb static paddr_t cfbmmap __P((void *, off_t, int));
181 1.1 nisimura
182 1.21 simonb static int cfb_alloc_screen __P((void *, const struct wsscreen_descr *,
183 1.1 nisimura void **, int *, int *, long *));
184 1.21 simonb static void cfb_free_screen __P((void *, void *));
185 1.21 simonb static int cfb_show_screen __P((void *, void *, int,
186 1.21 simonb void (*) (void *, int, int), void *));
187 1.1 nisimura
188 1.14 nisimura static const struct wsdisplay_accessops cfb_accessops = {
189 1.1 nisimura cfbioctl,
190 1.1 nisimura cfbmmap,
191 1.1 nisimura cfb_alloc_screen,
192 1.1 nisimura cfb_free_screen,
193 1.1 nisimura cfb_show_screen,
194 1.6 drochner 0 /* load_font */
195 1.1 nisimura };
196 1.1 nisimura
197 1.1 nisimura int cfb_cnattach __P((tc_addr_t));
198 1.14 nisimura static int cfbintr __P((void *));
199 1.14 nisimura static void cfbinit __P((struct fb_devconfig *));
200 1.1 nisimura
201 1.1 nisimura static int get_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
202 1.1 nisimura static int set_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
203 1.1 nisimura static int set_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
204 1.1 nisimura static int get_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
205 1.1 nisimura static void set_curpos __P((struct cfb_softc *, struct wsdisplay_curpos *));
206 1.1 nisimura
207 1.3 nisimura /*
208 1.3 nisimura * Compose 2 bit/pixel cursor image. Bit order will be reversed.
209 1.3 nisimura * M M M M I I I I M I M I M I M I
210 1.3 nisimura * [ before ] [ after ]
211 1.3 nisimura * 3 2 1 0 3 2 1 0 0 0 1 1 2 2 3 3
212 1.3 nisimura * 7 6 5 4 7 6 5 4 4 4 5 5 6 6 7 7
213 1.3 nisimura */
214 1.14 nisimura static const u_int8_t shuffle[256] = {
215 1.3 nisimura 0x00, 0x40, 0x10, 0x50, 0x04, 0x44, 0x14, 0x54,
216 1.3 nisimura 0x01, 0x41, 0x11, 0x51, 0x05, 0x45, 0x15, 0x55,
217 1.3 nisimura 0x80, 0xc0, 0x90, 0xd0, 0x84, 0xc4, 0x94, 0xd4,
218 1.3 nisimura 0x81, 0xc1, 0x91, 0xd1, 0x85, 0xc5, 0x95, 0xd5,
219 1.3 nisimura 0x20, 0x60, 0x30, 0x70, 0x24, 0x64, 0x34, 0x74,
220 1.3 nisimura 0x21, 0x61, 0x31, 0x71, 0x25, 0x65, 0x35, 0x75,
221 1.3 nisimura 0xa0, 0xe0, 0xb0, 0xf0, 0xa4, 0xe4, 0xb4, 0xf4,
222 1.3 nisimura 0xa1, 0xe1, 0xb1, 0xf1, 0xa5, 0xe5, 0xb5, 0xf5,
223 1.3 nisimura 0x08, 0x48, 0x18, 0x58, 0x0c, 0x4c, 0x1c, 0x5c,
224 1.3 nisimura 0x09, 0x49, 0x19, 0x59, 0x0d, 0x4d, 0x1d, 0x5d,
225 1.3 nisimura 0x88, 0xc8, 0x98, 0xd8, 0x8c, 0xcc, 0x9c, 0xdc,
226 1.3 nisimura 0x89, 0xc9, 0x99, 0xd9, 0x8d, 0xcd, 0x9d, 0xdd,
227 1.3 nisimura 0x28, 0x68, 0x38, 0x78, 0x2c, 0x6c, 0x3c, 0x7c,
228 1.3 nisimura 0x29, 0x69, 0x39, 0x79, 0x2d, 0x6d, 0x3d, 0x7d,
229 1.3 nisimura 0xa8, 0xe8, 0xb8, 0xf8, 0xac, 0xec, 0xbc, 0xfc,
230 1.3 nisimura 0xa9, 0xe9, 0xb9, 0xf9, 0xad, 0xed, 0xbd, 0xfd,
231 1.3 nisimura 0x02, 0x42, 0x12, 0x52, 0x06, 0x46, 0x16, 0x56,
232 1.3 nisimura 0x03, 0x43, 0x13, 0x53, 0x07, 0x47, 0x17, 0x57,
233 1.3 nisimura 0x82, 0xc2, 0x92, 0xd2, 0x86, 0xc6, 0x96, 0xd6,
234 1.3 nisimura 0x83, 0xc3, 0x93, 0xd3, 0x87, 0xc7, 0x97, 0xd7,
235 1.3 nisimura 0x22, 0x62, 0x32, 0x72, 0x26, 0x66, 0x36, 0x76,
236 1.3 nisimura 0x23, 0x63, 0x33, 0x73, 0x27, 0x67, 0x37, 0x77,
237 1.3 nisimura 0xa2, 0xe2, 0xb2, 0xf2, 0xa6, 0xe6, 0xb6, 0xf6,
238 1.3 nisimura 0xa3, 0xe3, 0xb3, 0xf3, 0xa7, 0xe7, 0xb7, 0xf7,
239 1.3 nisimura 0x0a, 0x4a, 0x1a, 0x5a, 0x0e, 0x4e, 0x1e, 0x5e,
240 1.3 nisimura 0x0b, 0x4b, 0x1b, 0x5b, 0x0f, 0x4f, 0x1f, 0x5f,
241 1.3 nisimura 0x8a, 0xca, 0x9a, 0xda, 0x8e, 0xce, 0x9e, 0xde,
242 1.3 nisimura 0x8b, 0xcb, 0x9b, 0xdb, 0x8f, 0xcf, 0x9f, 0xdf,
243 1.3 nisimura 0x2a, 0x6a, 0x3a, 0x7a, 0x2e, 0x6e, 0x3e, 0x7e,
244 1.3 nisimura 0x2b, 0x6b, 0x3b, 0x7b, 0x2f, 0x6f, 0x3f, 0x7f,
245 1.3 nisimura 0xaa, 0xea, 0xba, 0xfa, 0xae, 0xee, 0xbe, 0xfe,
246 1.3 nisimura 0xab, 0xeb, 0xbb, 0xfb, 0xaf, 0xef, 0xbf, 0xff,
247 1.3 nisimura };
248 1.1 nisimura
249 1.14 nisimura static int
250 1.1 nisimura cfbmatch(parent, match, aux)
251 1.1 nisimura struct device *parent;
252 1.1 nisimura struct cfdata *match;
253 1.1 nisimura void *aux;
254 1.1 nisimura {
255 1.1 nisimura struct tc_attach_args *ta = aux;
256 1.1 nisimura
257 1.1 nisimura if (strncmp("PMAG-BA ", ta->ta_modname, TC_ROM_LLEN) != 0)
258 1.1 nisimura return (0);
259 1.1 nisimura
260 1.1 nisimura return (1);
261 1.1 nisimura }
262 1.1 nisimura
263 1.14 nisimura static void
264 1.1 nisimura cfb_getdevconfig(dense_addr, dc)
265 1.1 nisimura tc_addr_t dense_addr;
266 1.1 nisimura struct fb_devconfig *dc;
267 1.1 nisimura {
268 1.18 nisimura int i, cookie;
269 1.1 nisimura
270 1.1 nisimura dc->dc_vaddr = dense_addr;
271 1.3 nisimura dc->dc_paddr = MACHINE_KSEG0_TO_PHYS(dc->dc_vaddr + CX_FB_OFFSET);
272 1.1 nisimura
273 1.1 nisimura dc->dc_wid = 1024;
274 1.1 nisimura dc->dc_ht = 864;
275 1.1 nisimura dc->dc_depth = 8;
276 1.1 nisimura dc->dc_rowbytes = 1024;
277 1.3 nisimura dc->dc_videobase = dc->dc_vaddr + CX_FB_OFFSET;
278 1.1 nisimura dc->dc_blanked = 0;
279 1.1 nisimura
280 1.1 nisimura /* initialize colormap and cursor resource */
281 1.1 nisimura cfbinit(dc);
282 1.1 nisimura
283 1.1 nisimura /* clear the screen */
284 1.1 nisimura for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
285 1.1 nisimura *(u_int32_t *)(dc->dc_videobase + i) = 0x0;
286 1.1 nisimura
287 1.20 nisimura dc->rinfo.ri_flg = RI_CENTER;
288 1.18 nisimura dc->rinfo.ri_depth = dc->dc_depth;
289 1.18 nisimura dc->rinfo.ri_bits = (void *)dc->dc_videobase;
290 1.18 nisimura dc->rinfo.ri_width = dc->dc_wid;
291 1.18 nisimura dc->rinfo.ri_height = dc->dc_ht;
292 1.18 nisimura dc->rinfo.ri_stride = dc->dc_rowbytes;
293 1.18 nisimura
294 1.18 nisimura wsfont_init();
295 1.18 nisimura /* prefer 8 pixel wide font */
296 1.18 nisimura if ((cookie = wsfont_find(NULL, 8, 0, 0)) <= 0)
297 1.18 nisimura cookie = wsfont_find(NULL, 0, 0, 0);
298 1.18 nisimura if (cookie <= 0) {
299 1.18 nisimura printf("cfb: font table is empty\n");
300 1.18 nisimura return;
301 1.18 nisimura }
302 1.18 nisimura
303 1.18 nisimura if (wsfont_lock(cookie, &dc->rinfo.ri_font,
304 1.23 nisimura WSDISPLAY_FONTORDER_L2R, WSDISPLAY_FONTORDER_L2R) <= 0) {
305 1.18 nisimura printf("cfb: couldn't lock font\n");
306 1.18 nisimura return;
307 1.18 nisimura }
308 1.18 nisimura dc->rinfo.ri_wsfcookie = cookie;
309 1.18 nisimura
310 1.18 nisimura rasops_init(&dc->rinfo, 34, 80);
311 1.1 nisimura
312 1.18 nisimura /* XXX shouldn't be global */
313 1.18 nisimura cfb_stdscreen.nrows = dc->rinfo.ri_rows;
314 1.18 nisimura cfb_stdscreen.ncols = dc->rinfo.ri_cols;
315 1.18 nisimura cfb_stdscreen.textops = &dc->rinfo.ri_ops;
316 1.18 nisimura cfb_stdscreen.capabilities = dc->rinfo.ri_caps;
317 1.1 nisimura }
318 1.1 nisimura
319 1.14 nisimura static void
320 1.1 nisimura cfbattach(parent, self, aux)
321 1.1 nisimura struct device *parent, *self;
322 1.1 nisimura void *aux;
323 1.1 nisimura {
324 1.1 nisimura struct cfb_softc *sc = (struct cfb_softc *)self;
325 1.1 nisimura struct tc_attach_args *ta = aux;
326 1.1 nisimura struct wsemuldisplaydev_attach_args waa;
327 1.24 nisimura struct hwcmap256 *cm;
328 1.24 nisimura const u_int8_t *p;
329 1.24 nisimura int console, index;
330 1.1 nisimura
331 1.1 nisimura console = (ta->ta_addr == cfb_consaddr);
332 1.1 nisimura if (console) {
333 1.1 nisimura sc->sc_dc = &cfb_console_dc;
334 1.1 nisimura sc->nscreens = 1;
335 1.1 nisimura }
336 1.1 nisimura else {
337 1.1 nisimura sc->sc_dc = (struct fb_devconfig *)
338 1.1 nisimura malloc(sizeof(struct fb_devconfig), M_DEVBUF, M_WAITOK);
339 1.1 nisimura cfb_getdevconfig(ta->ta_addr, sc->sc_dc);
340 1.1 nisimura }
341 1.1 nisimura printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
342 1.1 nisimura sc->sc_dc->dc_depth);
343 1.1 nisimura
344 1.24 nisimura cm = &sc->sc_cmap;
345 1.24 nisimura p = rasops_cmap;
346 1.25 nisimura for (index = 0; index < CMAP_SIZE; index++, p += 3) {
347 1.24 nisimura cm->r[index] = p[0];
348 1.24 nisimura cm->g[index] = p[1];
349 1.24 nisimura cm->b[index] = p[2];
350 1.24 nisimura }
351 1.11 nisimura
352 1.11 nisimura sc->sc_cursor.cc_magic.x = CX_MAGIC_X;
353 1.11 nisimura sc->sc_cursor.cc_magic.y = CX_MAGIC_Y;
354 1.1 nisimura
355 1.1 nisimura /* Establish an interrupt handler, and clear any pending interrupts */
356 1.14 nisimura tc_intr_establish(parent, ta->ta_cookie, IPL_TTY, cfbintr, sc);
357 1.3 nisimura *(u_int8_t *)(sc->sc_dc->dc_vaddr + CX_OFFSET_IREQ) = 0;
358 1.1 nisimura
359 1.1 nisimura waa.console = console;
360 1.1 nisimura waa.scrdata = &cfb_screenlist;
361 1.1 nisimura waa.accessops = &cfb_accessops;
362 1.1 nisimura waa.accesscookie = sc;
363 1.1 nisimura
364 1.1 nisimura config_found(self, &waa, wsemuldisplaydevprint);
365 1.1 nisimura }
366 1.1 nisimura
367 1.14 nisimura static int
368 1.1 nisimura cfbioctl(v, cmd, data, flag, p)
369 1.1 nisimura void *v;
370 1.1 nisimura u_long cmd;
371 1.1 nisimura caddr_t data;
372 1.1 nisimura int flag;
373 1.1 nisimura struct proc *p;
374 1.1 nisimura {
375 1.1 nisimura struct cfb_softc *sc = v;
376 1.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
377 1.1 nisimura int turnoff;
378 1.1 nisimura
379 1.1 nisimura switch (cmd) {
380 1.1 nisimura case WSDISPLAYIO_GTYPE:
381 1.1 nisimura *(u_int *)data = WSDISPLAY_TYPE_CFB;
382 1.1 nisimura return (0);
383 1.1 nisimura
384 1.1 nisimura case WSDISPLAYIO_GINFO:
385 1.1 nisimura #define wsd_fbip ((struct wsdisplay_fbinfo *)data)
386 1.1 nisimura wsd_fbip->height = sc->sc_dc->dc_ht;
387 1.1 nisimura wsd_fbip->width = sc->sc_dc->dc_wid;
388 1.1 nisimura wsd_fbip->depth = sc->sc_dc->dc_depth;
389 1.1 nisimura wsd_fbip->cmsize = CMAP_SIZE;
390 1.1 nisimura #undef fbt
391 1.1 nisimura return (0);
392 1.1 nisimura
393 1.1 nisimura case WSDISPLAYIO_GETCMAP:
394 1.1 nisimura return get_cmap(sc, (struct wsdisplay_cmap *)data);
395 1.1 nisimura
396 1.1 nisimura case WSDISPLAYIO_PUTCMAP:
397 1.1 nisimura return set_cmap(sc, (struct wsdisplay_cmap *)data);
398 1.1 nisimura
399 1.1 nisimura case WSDISPLAYIO_SVIDEO:
400 1.1 nisimura turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
401 1.1 nisimura if ((dc->dc_blanked == 0) ^ turnoff) {
402 1.1 nisimura dc->dc_blanked = turnoff;
403 1.3 nisimura /* XXX later XXX */
404 1.1 nisimura }
405 1.1 nisimura return (0);
406 1.1 nisimura
407 1.1 nisimura case WSDISPLAYIO_GVIDEO:
408 1.1 nisimura *(u_int *)data = dc->dc_blanked ?
409 1.1 nisimura WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
410 1.1 nisimura return (0);
411 1.1 nisimura
412 1.1 nisimura case WSDISPLAYIO_GCURPOS:
413 1.1 nisimura *(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
414 1.1 nisimura return (0);
415 1.1 nisimura
416 1.1 nisimura case WSDISPLAYIO_SCURPOS:
417 1.1 nisimura set_curpos(sc, (struct wsdisplay_curpos *)data);
418 1.26 nisimura sc->sc_changed = WSDISPLAY_CURSOR_DOPOS;
419 1.1 nisimura return (0);
420 1.1 nisimura
421 1.1 nisimura case WSDISPLAYIO_GCURMAX:
422 1.1 nisimura ((struct wsdisplay_curpos *)data)->x =
423 1.1 nisimura ((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
424 1.1 nisimura return (0);
425 1.1 nisimura
426 1.1 nisimura case WSDISPLAYIO_GCURSOR:
427 1.1 nisimura return get_cursor(sc, (struct wsdisplay_cursor *)data);
428 1.1 nisimura
429 1.1 nisimura case WSDISPLAYIO_SCURSOR:
430 1.1 nisimura return set_cursor(sc, (struct wsdisplay_cursor *)data);
431 1.1 nisimura }
432 1.1 nisimura return ENOTTY;
433 1.1 nisimura }
434 1.1 nisimura
435 1.21 simonb paddr_t
436 1.1 nisimura cfbmmap(v, offset, prot)
437 1.1 nisimura void *v;
438 1.1 nisimura off_t offset;
439 1.1 nisimura int prot;
440 1.1 nisimura {
441 1.1 nisimura struct cfb_softc *sc = v;
442 1.1 nisimura
443 1.5 mrg if (offset >= CX_FB_SIZE || offset < 0)
444 1.1 nisimura return (-1);
445 1.1 nisimura return machine_btop(sc->sc_dc->dc_paddr + offset);
446 1.1 nisimura }
447 1.1 nisimura
448 1.14 nisimura static int
449 1.1 nisimura cfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
450 1.1 nisimura void *v;
451 1.1 nisimura const struct wsscreen_descr *type;
452 1.1 nisimura void **cookiep;
453 1.1 nisimura int *curxp, *curyp;
454 1.1 nisimura long *attrp;
455 1.1 nisimura {
456 1.1 nisimura struct cfb_softc *sc = v;
457 1.1 nisimura long defattr;
458 1.1 nisimura
459 1.1 nisimura if (sc->nscreens > 0)
460 1.1 nisimura return (ENOMEM);
461 1.1 nisimura
462 1.18 nisimura *cookiep = &sc->sc_dc->rinfo; /* one and only for now */
463 1.1 nisimura *curxp = 0;
464 1.1 nisimura *curyp = 0;
465 1.18 nisimura (*sc->sc_dc->rinfo.ri_ops.alloc_attr)(&sc->sc_dc->rinfo, 0, 0, 0, &defattr);
466 1.1 nisimura *attrp = defattr;
467 1.1 nisimura sc->nscreens++;
468 1.1 nisimura return (0);
469 1.1 nisimura }
470 1.1 nisimura
471 1.14 nisimura static void
472 1.1 nisimura cfb_free_screen(v, cookie)
473 1.1 nisimura void *v;
474 1.1 nisimura void *cookie;
475 1.1 nisimura {
476 1.1 nisimura struct cfb_softc *sc = v;
477 1.1 nisimura
478 1.1 nisimura if (sc->sc_dc == &cfb_console_dc)
479 1.1 nisimura panic("cfb_free_screen: console");
480 1.1 nisimura
481 1.1 nisimura sc->nscreens--;
482 1.1 nisimura }
483 1.1 nisimura
484 1.15 drochner static int
485 1.16 nisimura cfb_show_screen(v, cookie, waitok, cb, cbarg)
486 1.1 nisimura void *v;
487 1.1 nisimura void *cookie;
488 1.15 drochner int waitok;
489 1.15 drochner void (*cb) __P((void *, int, int));
490 1.15 drochner void *cbarg;
491 1.1 nisimura {
492 1.15 drochner
493 1.15 drochner return (0);
494 1.1 nisimura }
495 1.1 nisimura
496 1.14 nisimura /* EXPORT */ int
497 1.1 nisimura cfb_cnattach(addr)
498 1.18 nisimura tc_addr_t addr;
499 1.1 nisimura {
500 1.18 nisimura struct fb_devconfig *dcp = &cfb_console_dc;
501 1.18 nisimura long defattr;
502 1.1 nisimura
503 1.18 nisimura cfb_getdevconfig(addr, dcp);
504 1.18 nisimura (*dcp->rinfo.ri_ops.alloc_attr)(&dcp->rinfo, 0, 0, 0, &defattr);
505 1.18 nisimura wsdisplay_cnattach(&cfb_stdscreen, &dcp->rinfo, 0, 0, defattr);
506 1.18 nisimura cfb_consaddr = addr;
507 1.18 nisimura return(0);
508 1.1 nisimura }
509 1.1 nisimura
510 1.14 nisimura static int
511 1.1 nisimura cfbintr(arg)
512 1.1 nisimura void *arg;
513 1.1 nisimura {
514 1.1 nisimura struct cfb_softc *sc = arg;
515 1.1 nisimura caddr_t cfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
516 1.26 nisimura caddr_t vdac;
517 1.1 nisimura int v;
518 1.1 nisimura
519 1.3 nisimura *(u_int8_t *)(cfbbase + CX_OFFSET_IREQ) = 0;
520 1.1 nisimura if (sc->sc_changed == 0)
521 1.1 nisimura return (1);
522 1.1 nisimura
523 1.26 nisimura vdac = cfbbase + CX_BT459_OFFSET;
524 1.1 nisimura v = sc->sc_changed;
525 1.26 nisimura if (v & WSDISPLAY_CURSOR_DOCUR) {
526 1.17 ad SELECT(vdac, BT459_IREG_CCR);
527 1.12 nisimura REG(vdac, bt_reg) = (sc->sc_curenb) ? 0xc0 : 0x00;
528 1.1 nisimura }
529 1.26 nisimura if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOHOT)) {
530 1.26 nisimura int x, y;
531 1.26 nisimura
532 1.26 nisimura x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
533 1.26 nisimura y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
534 1.26 nisimura
535 1.26 nisimura x += sc->sc_cursor.cc_magic.x;
536 1.26 nisimura y += sc->sc_cursor.cc_magic.y;
537 1.26 nisimura
538 1.26 nisimura SELECT(vdac, BT459_IREG_CURSOR_X_LOW);
539 1.26 nisimura REG(vdac, bt_reg) = x; tc_wmb();
540 1.26 nisimura REG(vdac, bt_reg) = x >> 8; tc_wmb();
541 1.26 nisimura REG(vdac, bt_reg) = y; tc_wmb();
542 1.26 nisimura REG(vdac, bt_reg) = y >> 8; tc_wmb();
543 1.26 nisimura }
544 1.26 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
545 1.1 nisimura u_int8_t *cp = sc->sc_cursor.cc_color;
546 1.1 nisimura
547 1.17 ad SELECT(vdac, BT459_IREG_CCOLOR_2);
548 1.12 nisimura REG(vdac, bt_reg) = cp[1]; tc_wmb();
549 1.12 nisimura REG(vdac, bt_reg) = cp[3]; tc_wmb();
550 1.12 nisimura REG(vdac, bt_reg) = cp[5]; tc_wmb();
551 1.12 nisimura
552 1.12 nisimura REG(vdac, bt_reg) = cp[0]; tc_wmb();
553 1.12 nisimura REG(vdac, bt_reg) = cp[2]; tc_wmb();
554 1.12 nisimura REG(vdac, bt_reg) = cp[4]; tc_wmb();
555 1.1 nisimura }
556 1.26 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
557 1.3 nisimura u_int8_t *ip, *mp, img, msk;
558 1.3 nisimura u_int8_t u;
559 1.3 nisimura int bcnt;
560 1.3 nisimura
561 1.3 nisimura ip = (u_int8_t *)sc->sc_cursor.cc_image;
562 1.3 nisimura mp = (u_int8_t *)(sc->sc_cursor.cc_image + CURSOR_MAX_SIZE);
563 1.3 nisimura
564 1.3 nisimura bcnt = 0;
565 1.17 ad SELECT(vdac, BT459_IREG_CRAM_BASE+0);
566 1.3 nisimura /* 64 pixel scan line is consisted with 16 byte cursor ram */
567 1.3 nisimura while (bcnt < sc->sc_cursor.cc_size.y * 16) {
568 1.3 nisimura /* pad right half 32 pixel when smaller than 33 */
569 1.3 nisimura if ((bcnt & 0x8) && sc->sc_cursor.cc_size.x < 33) {
570 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
571 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
572 1.3 nisimura }
573 1.3 nisimura else {
574 1.3 nisimura img = *ip++;
575 1.3 nisimura msk = *mp++;
576 1.3 nisimura img &= msk; /* cookie off image */
577 1.3 nisimura u = (msk & 0x0f) << 4 | (img & 0x0f);
578 1.12 nisimura REG(vdac, bt_reg) = shuffle[u]; tc_wmb();
579 1.3 nisimura u = (msk & 0xf0) | (img & 0xf0) >> 4;
580 1.12 nisimura REG(vdac, bt_reg) = shuffle[u]; tc_wmb();
581 1.3 nisimura }
582 1.3 nisimura bcnt += 2;
583 1.3 nisimura }
584 1.3 nisimura /* pad unoccupied scan lines */
585 1.3 nisimura while (bcnt < CURSOR_MAX_SIZE * 16) {
586 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
587 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
588 1.3 nisimura bcnt += 2;
589 1.1 nisimura }
590 1.1 nisimura }
591 1.26 nisimura if (v & WSDISPLAY_CMAP_DOLUT) {
592 1.11 nisimura struct hwcmap256 *cm = &sc->sc_cmap;
593 1.1 nisimura int index;
594 1.1 nisimura
595 1.12 nisimura SELECT(vdac, 0);
596 1.1 nisimura for (index = 0; index < CMAP_SIZE; index++) {
597 1.12 nisimura REG(vdac, bt_cmap) = cm->r[index]; tc_wmb();
598 1.12 nisimura REG(vdac, bt_cmap) = cm->g[index]; tc_wmb();
599 1.12 nisimura REG(vdac, bt_cmap) = cm->b[index]; tc_wmb();
600 1.1 nisimura }
601 1.1 nisimura }
602 1.26 nisimura sc->sc_changed = 0;
603 1.1 nisimura return (1);
604 1.1 nisimura }
605 1.1 nisimura
606 1.14 nisimura static void
607 1.1 nisimura cfbinit(dc)
608 1.1 nisimura struct fb_devconfig *dc;
609 1.1 nisimura {
610 1.26 nisimura caddr_t vdac = (caddr_t)dc->dc_vaddr + CX_BT459_OFFSET;
611 1.24 nisimura const u_int8_t *p;
612 1.1 nisimura int i;
613 1.1 nisimura
614 1.17 ad SELECT(vdac, BT459_IREG_COMMAND_0);
615 1.12 nisimura REG(vdac, bt_reg) = 0x40; /* CMD0 */ tc_wmb();
616 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* CMD1 */ tc_wmb();
617 1.12 nisimura REG(vdac, bt_reg) = 0xc0; /* CMD2 */ tc_wmb();
618 1.12 nisimura REG(vdac, bt_reg) = 0xff; /* PRM */ tc_wmb();
619 1.12 nisimura REG(vdac, bt_reg) = 0; /* 205 */ tc_wmb();
620 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* PBM */ tc_wmb();
621 1.12 nisimura REG(vdac, bt_reg) = 0; /* 207 */ tc_wmb();
622 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* ORM */ tc_wmb();
623 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* OBM */ tc_wmb();
624 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* ILV */ tc_wmb();
625 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* TEST */ tc_wmb();
626 1.12 nisimura
627 1.17 ad SELECT(vdac, BT459_IREG_CCR);
628 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
629 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
630 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
631 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
632 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
633 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
634 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
635 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
636 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
637 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
638 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
639 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
640 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
641 1.3 nisimura
642 1.3 nisimura /* build sane colormap */
643 1.12 nisimura SELECT(vdac, 0);
644 1.24 nisimura p = rasops_cmap;
645 1.25 nisimura for (i = 0; i < CMAP_SIZE; i++, p += 3) {
646 1.24 nisimura REG(vdac, bt_cmap) = p[0]; tc_wmb();
647 1.24 nisimura REG(vdac, bt_cmap) = p[1]; tc_wmb();
648 1.24 nisimura REG(vdac, bt_cmap) = p[2]; tc_wmb();
649 1.3 nisimura }
650 1.3 nisimura
651 1.3 nisimura /* clear out cursor image */
652 1.17 ad SELECT(vdac, BT459_IREG_CRAM_BASE);
653 1.3 nisimura for (i = 0; i < 1024; i++)
654 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
655 1.3 nisimura
656 1.3 nisimura /*
657 1.3 nisimura * 2 bit/pixel cursor. Assign MSB for cursor mask and LSB for
658 1.3 nisimura * cursor image. CCOLOR_2 for mask color, while CCOLOR_3 for
659 1.3 nisimura * image color. CCOLOR_1 will be never used.
660 1.3 nisimura */
661 1.17 ad SELECT(vdac, BT459_IREG_CCOLOR_1);
662 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
663 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
664 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
665 1.12 nisimura
666 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
667 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
668 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
669 1.12 nisimura
670 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
671 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
672 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
673 1.1 nisimura }
674 1.1 nisimura
675 1.1 nisimura static int
676 1.1 nisimura get_cmap(sc, p)
677 1.1 nisimura struct cfb_softc *sc;
678 1.1 nisimura struct wsdisplay_cmap *p;
679 1.1 nisimura {
680 1.1 nisimura u_int index = p->index, count = p->count;
681 1.1 nisimura
682 1.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
683 1.1 nisimura return (EINVAL);
684 1.1 nisimura
685 1.9 mrg if (!uvm_useracc(p->red, count, B_WRITE) ||
686 1.9 mrg !uvm_useracc(p->green, count, B_WRITE) ||
687 1.9 mrg !uvm_useracc(p->blue, count, B_WRITE))
688 1.1 nisimura return (EFAULT);
689 1.1 nisimura
690 1.1 nisimura copyout(&sc->sc_cmap.r[index], p->red, count);
691 1.1 nisimura copyout(&sc->sc_cmap.g[index], p->green, count);
692 1.1 nisimura copyout(&sc->sc_cmap.b[index], p->blue, count);
693 1.1 nisimura
694 1.1 nisimura return (0);
695 1.1 nisimura }
696 1.1 nisimura
697 1.1 nisimura static int
698 1.1 nisimura set_cmap(sc, p)
699 1.1 nisimura struct cfb_softc *sc;
700 1.1 nisimura struct wsdisplay_cmap *p;
701 1.1 nisimura {
702 1.1 nisimura u_int index = p->index, count = p->count;
703 1.1 nisimura
704 1.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
705 1.1 nisimura return (EINVAL);
706 1.1 nisimura
707 1.9 mrg if (!uvm_useracc(p->red, count, B_READ) ||
708 1.9 mrg !uvm_useracc(p->green, count, B_READ) ||
709 1.9 mrg !uvm_useracc(p->blue, count, B_READ))
710 1.1 nisimura return (EFAULT);
711 1.1 nisimura
712 1.1 nisimura copyin(p->red, &sc->sc_cmap.r[index], count);
713 1.1 nisimura copyin(p->green, &sc->sc_cmap.g[index], count);
714 1.1 nisimura copyin(p->blue, &sc->sc_cmap.b[index], count);
715 1.26 nisimura sc->sc_changed |= WSDISPLAY_CMAP_DOLUT;
716 1.1 nisimura return (0);
717 1.1 nisimura }
718 1.1 nisimura
719 1.1 nisimura static int
720 1.1 nisimura set_cursor(sc, p)
721 1.1 nisimura struct cfb_softc *sc;
722 1.1 nisimura struct wsdisplay_cursor *p;
723 1.1 nisimura {
724 1.1 nisimura #define cc (&sc->sc_cursor)
725 1.4 nisimura int v, index, count, icount;
726 1.1 nisimura
727 1.1 nisimura v = p->which;
728 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
729 1.1 nisimura index = p->cmap.index;
730 1.1 nisimura count = p->cmap.count;
731 1.1 nisimura if (index >= 2 || (index + count) > 2)
732 1.1 nisimura return (EINVAL);
733 1.9 mrg if (!uvm_useracc(p->cmap.red, count, B_READ) ||
734 1.9 mrg !uvm_useracc(p->cmap.green, count, B_READ) ||
735 1.9 mrg !uvm_useracc(p->cmap.blue, count, B_READ))
736 1.1 nisimura return (EFAULT);
737 1.1 nisimura }
738 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
739 1.1 nisimura if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
740 1.1 nisimura return (EINVAL);
741 1.4 nisimura icount = ((p->size.x < 33) ? 4 : 8) * p->size.y;
742 1.9 mrg if (!uvm_useracc(p->image, icount, B_READ) ||
743 1.9 mrg !uvm_useracc(p->mask, icount, B_READ))
744 1.1 nisimura return (EFAULT);
745 1.1 nisimura }
746 1.1 nisimura
747 1.26 nisimura if (v & WSDISPLAY_CURSOR_DOCUR)
748 1.1 nisimura sc->sc_curenb = p->enable;
749 1.26 nisimura if (v & WSDISPLAY_CURSOR_DOPOS)
750 1.26 nisimura set_curpos(sc, &p->pos);
751 1.26 nisimura if (v & WSDISPLAY_CURSOR_DOHOT)
752 1.26 nisimura cc->cc_hot = p->hot;
753 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
754 1.1 nisimura copyin(p->cmap.red, &cc->cc_color[index], count);
755 1.1 nisimura copyin(p->cmap.green, &cc->cc_color[index + 2], count);
756 1.1 nisimura copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
757 1.1 nisimura }
758 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
759 1.1 nisimura cc->cc_size = p->size;
760 1.1 nisimura memset(cc->cc_image, 0, sizeof cc->cc_image);
761 1.4 nisimura copyin(p->image, cc->cc_image, icount);
762 1.4 nisimura copyin(p->mask, cc->cc_image+CURSOR_MAX_SIZE, icount);
763 1.1 nisimura }
764 1.26 nisimura sc->sc_changed = v;
765 1.1 nisimura
766 1.1 nisimura return (0);
767 1.1 nisimura #undef cc
768 1.1 nisimura }
769 1.1 nisimura
770 1.1 nisimura static int
771 1.1 nisimura get_cursor(sc, p)
772 1.1 nisimura struct cfb_softc *sc;
773 1.1 nisimura struct wsdisplay_cursor *p;
774 1.1 nisimura {
775 1.1 nisimura return (ENOTTY); /* XXX */
776 1.1 nisimura }
777 1.1 nisimura
778 1.1 nisimura static void
779 1.1 nisimura set_curpos(sc, curpos)
780 1.1 nisimura struct cfb_softc *sc;
781 1.1 nisimura struct wsdisplay_curpos *curpos;
782 1.1 nisimura {
783 1.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
784 1.1 nisimura int x = curpos->x, y = curpos->y;
785 1.1 nisimura
786 1.1 nisimura if (y < 0)
787 1.1 nisimura y = 0;
788 1.3 nisimura else if (y > dc->dc_ht)
789 1.3 nisimura y = dc->dc_ht;
790 1.1 nisimura if (x < 0)
791 1.1 nisimura x = 0;
792 1.3 nisimura else if (x > dc->dc_wid)
793 1.3 nisimura x = dc->dc_wid;
794 1.1 nisimura sc->sc_cursor.cc_pos.x = x;
795 1.1 nisimura sc->sc_cursor.cc_pos.y = y;
796 1.1 nisimura }
797