pxa2x0_lcd.c revision 1.8 1 1.8 bsh /* $NetBSD: pxa2x0_lcd.c,v 1.8 2003/10/03 07:24:05 bsh Exp $ */
2 1.1 bsh
3 1.1 bsh /*
4 1.1 bsh * Copyright (c) 2002 Genetec Corporation. All rights reserved.
5 1.1 bsh * Written by Hiroyuki Bessho for Genetec Corporation.
6 1.1 bsh *
7 1.1 bsh * Redistribution and use in source and binary forms, with or without
8 1.1 bsh * modification, are permitted provided that the following conditions
9 1.1 bsh * are met:
10 1.1 bsh * 1. Redistributions of source code must retain the above copyright
11 1.1 bsh * notice, this list of conditions and the following disclaimer.
12 1.1 bsh * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 bsh * notice, this list of conditions and the following disclaimer in the
14 1.1 bsh * documentation and/or other materials provided with the distribution.
15 1.1 bsh * 3. All advertising materials mentioning features or use of this software
16 1.1 bsh * must display the following acknowledgement:
17 1.1 bsh * This product includes software developed for the NetBSD Project by
18 1.1 bsh * Genetec Corporation.
19 1.1 bsh * 4. The name of Genetec Corporation may not be used to endorse or
20 1.1 bsh * promote products derived from this software without specific prior
21 1.1 bsh * written permission.
22 1.1 bsh *
23 1.1 bsh * THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND
24 1.1 bsh * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
25 1.1 bsh * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
26 1.1 bsh * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL GENETEC CORPORATION
27 1.1 bsh * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 1.1 bsh * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 1.1 bsh * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30 1.1 bsh * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
31 1.1 bsh * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 1.1 bsh * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33 1.1 bsh * POSSIBILITY OF SUCH DAMAGE.
34 1.1 bsh */
35 1.1 bsh
36 1.1 bsh /*
37 1.1 bsh * Support PXA2[15]0's integrated LCD controller.
38 1.1 bsh */
39 1.6 lukem
40 1.6 lukem #include <sys/cdefs.h>
41 1.8 bsh __KERNEL_RCSID(0, "$NetBSD: pxa2x0_lcd.c,v 1.8 2003/10/03 07:24:05 bsh Exp $");
42 1.6 lukem
43 1.1 bsh #include <sys/param.h>
44 1.1 bsh #include <sys/systm.h>
45 1.1 bsh #include <sys/conf.h>
46 1.1 bsh #include <sys/uio.h>
47 1.1 bsh #include <sys/malloc.h>
48 1.1 bsh #include <sys/kernel.h> /* for cold */
49 1.1 bsh
50 1.2 thorpej #include <uvm/uvm_extern.h>
51 1.2 thorpej
52 1.1 bsh #include <dev/cons.h>
53 1.1 bsh #include <dev/wscons/wsconsio.h>
54 1.1 bsh #include <dev/wscons/wsdisplayvar.h>
55 1.1 bsh #include <dev/wscons/wscons_callbacks.h>
56 1.1 bsh #include <dev/rasops/rasops.h>
57 1.1 bsh #include <dev/wsfont/wsfont.h>
58 1.1 bsh
59 1.1 bsh #include <machine/bus.h>
60 1.1 bsh #include <machine/cpu.h>
61 1.1 bsh #include <arm/cpufunc.h>
62 1.1 bsh
63 1.1 bsh #include <arm/xscale/pxa2x0var.h>
64 1.1 bsh #include <arm/xscale/pxa2x0reg.h>
65 1.1 bsh #include <arm/xscale/pxa2x0_lcd.h>
66 1.5 bsh #include <arm/xscale/pxa2x0_gpio.h>
67 1.1 bsh
68 1.1 bsh #include "wsdisplay.h"
69 1.1 bsh
70 1.1 bsh int lcdintr(void *);
71 1.1 bsh
72 1.1 bsh void
73 1.4 bsh pxa2x0_lcd_geometry(struct pxa2x0_lcd_softc *sc,
74 1.4 bsh const struct lcd_panel_geometry *info)
75 1.1 bsh {
76 1.1 bsh int lines;
77 1.1 bsh bus_space_tag_t iot = sc->iot;
78 1.1 bsh bus_space_handle_t ioh = sc->ioh;
79 1.1 bsh uint32_t ccr0;
80 1.1 bsh
81 1.1 bsh sc->geometry = info;
82 1.1 bsh
83 1.1 bsh ccr0 = LCCR0_IMASK;
84 1.4 bsh if (info->panel_info & LCDPANEL_ACTIVE)
85 1.4 bsh ccr0 |= LCCR0_PAS; /* active mode */
86 1.4 bsh if ((info->panel_info & (LCDPANEL_DUAL|LCDPANEL_ACTIVE))
87 1.4 bsh == LCDPANEL_DUAL)
88 1.1 bsh ccr0 |= LCCR0_SDS; /* dual panel */
89 1.4 bsh if (info->panel_info & LCDPANEL_MONOCHROME)
90 1.1 bsh ccr0 |= LCCR0_CMS;
91 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCCR0, ccr0);
92 1.1 bsh
93 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCCR1,
94 1.1 bsh (info->panel_width-1)
95 1.1 bsh | ((info->hsync_pulse_width-1)<<10)
96 1.1 bsh | ((info->end_line_wait-1)<<16)
97 1.4 bsh | ((info->beg_line_wait-1)<<24));
98 1.1 bsh
99 1.4 bsh if (info->panel_info & LCDPANEL_DUAL)
100 1.1 bsh lines = info->panel_height/2 + info->extra_lines;
101 1.1 bsh else
102 1.1 bsh lines = info->panel_height + info->extra_lines;
103 1.1 bsh
104 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCCR2,
105 1.1 bsh (lines-1)
106 1.1 bsh | (info->vsync_pulse_width<<10)
107 1.1 bsh | (info->end_frame_wait<<16)
108 1.4 bsh | (info->beg_frame_wait<<24));
109 1.1 bsh
110 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCCR3,
111 1.1 bsh (info->pixel_clock_div<<0)
112 1.1 bsh | (info->ac_bias << 8)
113 1.1 bsh | ((info->panel_info &
114 1.1 bsh (LCDPANEL_VSP|LCDPANEL_HSP|LCDPANEL_PCP|LCDPANEL_OEP))
115 1.1 bsh <<20)
116 1.4 bsh | (4 << 24) /* 16bpp */
117 1.1 bsh | ((info->panel_info & LCDPANEL_DPC) ? (1<<27) : 0)
118 1.1 bsh );
119 1.1 bsh }
120 1.1 bsh
121 1.1 bsh void
122 1.5 bsh pxa2x0_lcd_attach_sub(struct pxa2x0_lcd_softc *sc,
123 1.5 bsh struct pxaip_attach_args *pxa, const struct lcd_panel_geometry *geom)
124 1.1 bsh {
125 1.5 bsh bus_space_tag_t iot = pxa->pxa_iot;
126 1.1 bsh bus_space_handle_t ioh;
127 1.3 scw int error, nldd;
128 1.1 bsh
129 1.1 bsh sc->n_screens = 0;
130 1.1 bsh LIST_INIT(&sc->screens);
131 1.1 bsh
132 1.1 bsh /* map controller registers */
133 1.4 bsh error = bus_space_map(iot, PXA2X0_LCDC_BASE,
134 1.4 bsh PXA2X0_LCDC_SIZE, 0, &ioh);
135 1.4 bsh if (error) {
136 1.4 bsh printf(": failed to map registers %d", error);
137 1.1 bsh return;
138 1.1 bsh }
139 1.1 bsh
140 1.1 bsh sc->iot = iot;
141 1.1 bsh sc->ioh = ioh;
142 1.1 bsh sc->dma_tag = &pxa2x0_bus_dma_tag;
143 1.1 bsh
144 1.1 bsh sc->ih = pxa2x0_intr_establish(17, IPL_BIO, lcdintr, sc);
145 1.1 bsh if (sc->ih == NULL)
146 1.1 bsh printf("%s: unable to establish interrupt at irq %d",
147 1.1 bsh sc->dev.dv_xname, 17);
148 1.1 bsh
149 1.1 bsh /* Initialize LCD controller */
150 1.1 bsh
151 1.1 bsh /* enable clock */
152 1.5 bsh pxa2x0_clkman_config(CKEN_LCD, 1);
153 1.1 bsh
154 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCCR0, LCCR0_IMASK);
155 1.1 bsh
156 1.1 bsh /*
157 1.1 bsh * setup GP[77:58] for LCD
158 1.1 bsh */
159 1.3 scw /* Always use [FLP]CLK, ACBIAS */
160 1.3 scw pxa2x0_gpio_set_function(74, GPIO_ALT_FN_2_OUT);
161 1.3 scw pxa2x0_gpio_set_function(75, GPIO_ALT_FN_2_OUT);
162 1.3 scw pxa2x0_gpio_set_function(76, GPIO_ALT_FN_2_OUT);
163 1.3 scw pxa2x0_gpio_set_function(77, GPIO_ALT_FN_2_OUT);
164 1.3 scw
165 1.3 scw if ((geom->panel_info & LCDPANEL_ACTIVE) ||
166 1.3 scw ((geom->panel_info & (LCDPANEL_MONOCHROME|LCDPANEL_DUAL)) ==
167 1.3 scw LCDPANEL_DUAL)) {
168 1.3 scw /* active and color dual panel need L_DD[15:0] */
169 1.3 scw nldd = 16;
170 1.3 scw } else
171 1.3 scw if ((geom->panel_info & LCDPANEL_DUAL) ||
172 1.3 scw !(geom->panel_info & LCDPANEL_MONOCHROME)) {
173 1.3 scw /* dual or color need L_DD[7:0] */
174 1.3 scw nldd = 8;
175 1.3 scw } else {
176 1.3 scw /* Otherwise just L_DD[3:0] */
177 1.3 scw nldd = 4;
178 1.1 bsh }
179 1.1 bsh
180 1.3 scw while (nldd--)
181 1.3 scw pxa2x0_gpio_set_function(58 + nldd, GPIO_ALT_FN_2_OUT);
182 1.1 bsh
183 1.4 bsh pxa2x0_lcd_geometry(sc, geom);
184 1.1 bsh }
185 1.1 bsh
186 1.1 bsh
187 1.1 bsh int
188 1.1 bsh lcdintr(void *arg)
189 1.1 bsh {
190 1.1 bsh struct pxa2x0_lcd_softc *sc = arg;
191 1.1 bsh bus_space_tag_t iot = sc->iot;
192 1.1 bsh bus_space_handle_t ioh = sc->ioh;
193 1.1 bsh
194 1.1 bsh static uint32_t status;
195 1.1 bsh
196 1.4 bsh status = bus_space_read_4(iot, ioh, LCDC_LCSR);
197 1.1 bsh /* Clear stickey status bits */
198 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCSR, status);
199 1.1 bsh
200 1.1 bsh return 1;
201 1.1 bsh }
202 1.1 bsh
203 1.1 bsh void
204 1.4 bsh pxa2x0_lcd_start_dma(struct pxa2x0_lcd_softc *sc,
205 1.4 bsh struct pxa2x0_lcd_screen *scr)
206 1.1 bsh {
207 1.1 bsh uint32_t tmp;
208 1.1 bsh bus_space_tag_t iot = sc->iot;
209 1.1 bsh bus_space_handle_t ioh = sc->ioh;
210 1.1 bsh int val, save;
211 1.1 bsh
212 1.4 bsh save = disable_interrupts(I32_bit);
213 1.1 bsh
214 1.4 bsh switch (scr->depth) {
215 1.1 bsh case 1: val = 0; break;
216 1.1 bsh case 2: val = 1; break;
217 1.1 bsh case 4: val = 2; break;
218 1.1 bsh case 8: val = 3; break;
219 1.1 bsh case 16: /* FALLTHROUGH */
220 1.1 bsh default:
221 1.1 bsh val = 4; break;
222 1.1 bsh }
223 1.1 bsh
224 1.4 bsh tmp = bus_space_read_4(iot, ioh, LCDC_LCCR3);
225 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCCR3,
226 1.4 bsh (tmp & ~LCCR3_BPP) | (val << LCCR3_BPP_SHIFT));
227 1.1 bsh
228 1.4 bsh bus_space_write_4(iot, ioh, LCDC_FDADR0,
229 1.1 bsh scr->depth == 16 ? scr->dma_desc_pa :
230 1.4 bsh scr->dma_desc_pa + 2 * sizeof (struct lcd_dma_descriptor));
231 1.4 bsh bus_space_write_4(iot, ioh, LCDC_FDADR1,
232 1.4 bsh scr->dma_desc_pa + 1 * sizeof (struct lcd_dma_descriptor));
233 1.1 bsh
234 1.1 bsh /* clear status */
235 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCSR, 0);
236 1.1 bsh
237 1.1 bsh delay(1000); /* ??? */
238 1.1 bsh
239 1.1 bsh /* Enable LCDC */
240 1.4 bsh tmp = bus_space_read_4(iot, ioh, LCDC_LCCR0);
241 1.1 bsh /*tmp &= ~LCCR0_SFM;*/
242 1.4 bsh bus_space_write_4(iot, ioh, LCDC_LCCR0, tmp | LCCR0_ENB);
243 1.1 bsh
244 1.4 bsh restore_interrupts(save);
245 1.1 bsh
246 1.1 bsh }
247 1.1 bsh
248 1.1 bsh
249 1.5 bsh #if NWSDISPLAY > 0
250 1.1 bsh static void
251 1.4 bsh pxa2x0_lcd_stop_dma(struct pxa2x0_lcd_softc *sc)
252 1.1 bsh {
253 1.1 bsh /* Stop LCD DMA after current frame */
254 1.4 bsh bus_space_write_4(sc->iot, sc->ioh, LCDC_LCCR0,
255 1.1 bsh LCCR0_DIS |
256 1.4 bsh bus_space_read_4(sc->iot, sc->ioh, LCDC_LCCR0));
257 1.1 bsh
258 1.1 bsh /* wait for disabling done.
259 1.1 bsh XXX: use interrupt. */
260 1.4 bsh while (LCCR0_ENB &
261 1.4 bsh bus_space_read_4(sc->iot, sc->ioh, LCDC_LCCR0))
262 1.1 bsh ;
263 1.1 bsh
264 1.4 bsh bus_space_write_4(sc->iot, sc->ioh, LCDC_LCCR0,
265 1.1 bsh ~LCCR0_DIS &
266 1.4 bsh bus_space_read_4(sc->iot, sc->ioh, LCDC_LCCR0));
267 1.1 bsh }
268 1.5 bsh #endif
269 1.1 bsh
270 1.1 bsh #define _rgb(r,g,b) (((r)<<11) | ((g)<<5) | b)
271 1.1 bsh #define rgb(r,g,b) _rgb((r)>>1,g,(b)>>1)
272 1.1 bsh
273 1.1 bsh #define L 0x1f /* low intensity */
274 1.1 bsh #define H 0x3f /* hight intensity */
275 1.1 bsh
276 1.1 bsh static uint16_t basic_color_map[] = {
277 1.1 bsh rgb( 0, 0, 0), /* black */
278 1.1 bsh rgb( L, 0, 0), /* red */
279 1.1 bsh rgb( 0, L, 0), /* green */
280 1.1 bsh rgb( L, L, 0), /* brown */
281 1.1 bsh rgb( 0, 0, L), /* blue */
282 1.1 bsh rgb( L, 0, L), /* magenta */
283 1.1 bsh rgb( 0, L, L), /* cyan */
284 1.1 bsh _rgb(0x1c,0x38,0x1c), /* white */
285 1.1 bsh
286 1.1 bsh rgb( L, L, L), /* black */
287 1.1 bsh rgb( H, 0, 0), /* red */
288 1.1 bsh rgb( 0, H, 0), /* green */
289 1.1 bsh rgb( H, H, 0), /* brown */
290 1.1 bsh rgb( 0, 0, H), /* blue */
291 1.1 bsh rgb( H, 0, H), /* magenta */
292 1.1 bsh rgb( 0, H, H), /* cyan */
293 1.1 bsh rgb( H, H, H)
294 1.1 bsh };
295 1.1 bsh
296 1.1 bsh #undef H
297 1.1 bsh #undef L
298 1.1 bsh
299 1.1 bsh static void
300 1.4 bsh init_pallet(uint16_t *buf, int depth)
301 1.1 bsh {
302 1.1 bsh int i;
303 1.1 bsh
304 1.1 bsh /* convert RGB332 to RGB565 */
305 1.4 bsh switch (depth) {
306 1.1 bsh case 8:
307 1.1 bsh case 4:
308 1.1 bsh #if 0
309 1.4 bsh for (i=0; i <= 255; ++i) {
310 1.1 bsh buf[i] = ((9 * ((i>>5) & 0x07)) <<11) |
311 1.1 bsh ((9 * ((i>>2) & 0x07)) << 5) |
312 1.4 bsh ((21 * (i & 0x03))/2);
313 1.1 bsh }
314 1.1 bsh #else
315 1.4 bsh memcpy(buf, basic_color_map, sizeof basic_color_map);
316 1.4 bsh for (i=16; i < (1<<depth); ++i)
317 1.1 bsh buf[i] = 0xffff;
318 1.1 bsh #endif
319 1.1 bsh break;
320 1.8 bsh case 16:
321 1.8 bsh /* pallet is not needed */
322 1.8 bsh break;
323 1.1 bsh default:
324 1.8 bsh /* other depths are not supported */
325 1.8 bsh break;
326 1.1 bsh }
327 1.1 bsh }
328 1.1 bsh
329 1.1 bsh struct pxa2x0_lcd_screen *
330 1.4 bsh pxa2x0_lcd_new_screen(struct pxa2x0_lcd_softc *sc,
331 1.4 bsh int depth)
332 1.1 bsh {
333 1.1 bsh struct pxa2x0_lcd_screen *scr = NULL;
334 1.1 bsh int width, height;
335 1.1 bsh bus_size_t size;
336 1.1 bsh int error, pallet_size;
337 1.1 bsh int busdma_flag = (cold ? BUS_DMA_NOWAIT : BUS_DMA_WAITOK);
338 1.1 bsh struct lcd_dma_descriptor *desc;
339 1.1 bsh paddr_t buf_pa, desc_pa;
340 1.1 bsh
341 1.1 bsh width = sc->geometry->panel_width;
342 1.1 bsh height = sc->geometry->panel_height;
343 1.1 bsh pallet_size = 0;
344 1.1 bsh
345 1.4 bsh switch (depth) {
346 1.1 bsh case 1:
347 1.1 bsh case 2:
348 1.1 bsh case 4:
349 1.1 bsh case 8:
350 1.1 bsh pallet_size = (1<<depth) * sizeof (uint16_t);
351 1.1 bsh /* FALLTHROUGH */
352 1.1 bsh case 16:
353 1.1 bsh size = roundup(width,4)*depth/8 * height;
354 1.1 bsh break;
355 1.1 bsh default:
356 1.4 bsh printf("%s: Unknown depth (%d)\n", sc->dev.dv_xname, depth);
357 1.1 bsh return NULL;
358 1.1 bsh }
359 1.1 bsh
360 1.4 bsh scr = malloc(sizeof *scr, M_DEVBUF,
361 1.4 bsh M_ZERO | (cold ? M_NOWAIT : M_WAITOK));
362 1.1 bsh
363 1.4 bsh if (scr == NULL)
364 1.1 bsh return NULL;
365 1.1 bsh
366 1.1 bsh scr->nsegs = 0;
367 1.1 bsh scr->depth = depth;
368 1.1 bsh scr->buf_size = size;
369 1.1 bsh scr->buf_va = NULL;
370 1.1 bsh size = roundup(size,16) + 3 * sizeof (struct lcd_dma_descriptor)
371 1.1 bsh + pallet_size;
372 1.1 bsh
373 1.4 bsh error = bus_dmamem_alloc(sc->dma_tag, size, 16, 0,
374 1.4 bsh scr->segs, 1, &(scr->nsegs), busdma_flag);
375 1.1 bsh
376 1.4 bsh if (error || scr->nsegs != 1) {
377 1.1 bsh /* XXX: Actually we can handle nsegs>1 case by means
378 1.1 bsh of multiple DMA descriptors for a panel. it will
379 1.1 bsh makes code here a bit hairly */
380 1.1 bsh goto bad;
381 1.1 bsh }
382 1.1 bsh
383 1.4 bsh error = bus_dmamem_map(sc->dma_tag, scr->segs, scr->nsegs,
384 1.4 bsh size, (caddr_t *)&(scr->buf_va), busdma_flag | BUS_DMA_COHERENT);
385 1.4 bsh if (error)
386 1.1 bsh goto bad;
387 1.1 bsh
388 1.1 bsh
389 1.4 bsh memset (scr->buf_va, 0, scr->buf_size);
390 1.1 bsh
391 1.1 bsh /* map memory for DMA */
392 1.4 bsh if (bus_dmamap_create(sc->dma_tag, 1024*1024*2, 1,
393 1.4 bsh 1024*1024*2, 0, busdma_flag, &scr->dma))
394 1.1 bsh goto bad;
395 1.4 bsh error = bus_dmamap_load(sc->dma_tag, scr->dma,
396 1.4 bsh scr->buf_va, size, NULL, busdma_flag);
397 1.4 bsh if (error) {
398 1.1 bsh goto bad;
399 1.1 bsh }
400 1.1 bsh
401 1.1 bsh buf_pa = scr->segs[0].ds_addr;
402 1.2 thorpej desc_pa = buf_pa + roundup(size, PAGE_SIZE) - 3*sizeof *desc;
403 1.1 bsh
404 1.1 bsh /* make descriptors at the top of mapped memory */
405 1.1 bsh desc = (struct lcd_dma_descriptor *)(
406 1.2 thorpej (caddr_t)(scr->buf_va) + roundup(size, PAGE_SIZE) -
407 1.2 thorpej 3*sizeof *desc);
408 1.1 bsh
409 1.1 bsh desc[0].fdadr = desc_pa;
410 1.1 bsh desc[0].fsadr = buf_pa;
411 1.1 bsh desc[0].ldcmd = scr->buf_size;
412 1.1 bsh
413 1.4 bsh if (pallet_size) {
414 1.4 bsh init_pallet((uint16_t *)((char *)desc - pallet_size), depth);
415 1.1 bsh
416 1.1 bsh desc[2].fdadr = desc_pa; /* chain to panel 0 */
417 1.1 bsh desc[2].fsadr = desc_pa - pallet_size;
418 1.1 bsh desc[2].ldcmd = pallet_size | LDCMD_PAL;
419 1.1 bsh }
420 1.1 bsh
421 1.4 bsh if (sc->geometry->panel_info & LCDPANEL_DUAL) {
422 1.1 bsh /* Dual panel */
423 1.1 bsh desc[1].fdadr = desc_pa + sizeof *desc;
424 1.1 bsh desc[1].fsadr = buf_pa + scr->buf_size/2;
425 1.1 bsh desc[0].ldcmd = desc[1].ldcmd = scr->buf_size/2;
426 1.1 bsh
427 1.1 bsh }
428 1.1 bsh
429 1.1 bsh #if 0
430 1.1 bsh desc[0].ldcmd |= LDCMD_SOFINT;
431 1.1 bsh desc[1].ldcmd |= LDCMD_SOFINT;
432 1.1 bsh #endif
433 1.1 bsh
434 1.1 bsh scr->dma_desc = desc;
435 1.1 bsh scr->dma_desc_pa = desc_pa;
436 1.1 bsh scr->map_size = size; /* used when unmap this. */
437 1.1 bsh
438 1.4 bsh LIST_INSERT_HEAD(&(sc->screens), scr, link);
439 1.1 bsh sc->n_screens++;
440 1.1 bsh
441 1.1 bsh return scr;
442 1.1 bsh
443 1.1 bsh bad:
444 1.4 bsh if (scr) {
445 1.4 bsh if (scr->buf_va)
446 1.4 bsh bus_dmamem_unmap(sc->dma_tag, scr->buf_va, size);
447 1.4 bsh if (scr->nsegs)
448 1.4 bsh bus_dmamem_free(sc->dma_tag, scr->segs, scr->nsegs);
449 1.4 bsh free(scr, M_DEVBUF);
450 1.1 bsh }
451 1.1 bsh return NULL;
452 1.1 bsh }
453 1.1 bsh
454 1.1 bsh
455 1.1 bsh #if NWSDISPLAY > 0
456 1.1 bsh
457 1.1 bsh /*
458 1.1 bsh * Initialize struct wsscreen_descr based on values calculated by
459 1.1 bsh * raster operation subsystem.
460 1.1 bsh */
461 1.1 bsh int
462 1.1 bsh pxa2x0_lcd_setup_wsscreen(struct pxa2x0_wsscreen_descr *descr,
463 1.1 bsh const struct lcd_panel_geometry *geom,
464 1.4 bsh const char *fontname)
465 1.1 bsh {
466 1.1 bsh int width = geom->panel_width;
467 1.1 bsh int height = geom->panel_height;
468 1.1 bsh int cookie = -1;
469 1.1 bsh struct rasops_info rinfo;
470 1.1 bsh
471 1.4 bsh memset(&rinfo, 0, sizeof rinfo);
472 1.1 bsh
473 1.4 bsh if (fontname) {
474 1.1 bsh wsfont_init();
475 1.4 bsh cookie = wsfont_find((char *)fontname, 0, 0, 0,
476 1.4 bsh WSDISPLAY_FONTORDER_L2R, WSDISPLAY_FONTORDER_L2R);
477 1.4 bsh if (cookie < 0 ||
478 1.4 bsh wsfont_lock(cookie, &rinfo.ri_font))
479 1.1 bsh return -1;
480 1.1 bsh }
481 1.1 bsh else {
482 1.1 bsh /* let rasops_init() choose any font */
483 1.1 bsh }
484 1.1 bsh
485 1.1 bsh /* let rasops_init calculate # of cols and rows in character */
486 1.1 bsh rinfo.ri_flg = 0;
487 1.1 bsh rinfo.ri_depth = descr->depth;
488 1.1 bsh rinfo.ri_bits = NULL;
489 1.1 bsh rinfo.ri_width = width;
490 1.1 bsh rinfo.ri_height = height;
491 1.1 bsh rinfo.ri_stride = width * rinfo.ri_depth / 8;
492 1.1 bsh rinfo.ri_wsfcookie = cookie;
493 1.1 bsh
494 1.4 bsh rasops_init(&rinfo, 100, 100);
495 1.1 bsh
496 1.1 bsh descr->c.nrows = rinfo.ri_rows;
497 1.1 bsh descr->c.ncols = rinfo.ri_cols;
498 1.1 bsh descr->c.capabilities = rinfo.ri_caps;
499 1.1 bsh
500 1.1 bsh return cookie;
501 1.1 bsh }
502 1.1 bsh
503 1.1 bsh
504 1.1 bsh int
505 1.1 bsh pxa2x0_lcd_show_screen(void *v, void *cookie, int waitok,
506 1.1 bsh void (*cb)(void *, int, int), void *cbarg)
507 1.1 bsh {
508 1.1 bsh struct pxa2x0_lcd_softc *sc = v;
509 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie, *old;
510 1.1 bsh
511 1.1 bsh old = sc->active;
512 1.4 bsh if (old == scr)
513 1.1 bsh return 0;
514 1.1 bsh
515 1.4 bsh if (old)
516 1.4 bsh pxa2x0_lcd_stop_dma(sc);
517 1.1 bsh
518 1.4 bsh pxa2x0_lcd_start_dma(sc, scr);
519 1.1 bsh
520 1.1 bsh sc->active = scr;
521 1.1 bsh return 0;
522 1.1 bsh }
523 1.1 bsh
524 1.1 bsh int
525 1.1 bsh pxa2x0_lcd_alloc_screen(void *v, const struct wsscreen_descr *_type,
526 1.1 bsh void **cookiep, int *curxp, int *curyp, long *attrp)
527 1.1 bsh {
528 1.1 bsh struct pxa2x0_lcd_softc *sc = v;
529 1.1 bsh struct pxa2x0_lcd_screen *scr;
530 1.1 bsh struct pxa2x0_wsscreen_descr *type = (struct pxa2x0_wsscreen_descr *)_type;
531 1.1 bsh
532 1.4 bsh scr = pxa2x0_lcd_new_screen(sc, type->depth);
533 1.4 bsh if (scr == NULL)
534 1.1 bsh return -1;
535 1.1 bsh
536 1.1 bsh /*
537 1.1 bsh * initialize raster operation for this screen.
538 1.1 bsh */
539 1.1 bsh scr->rinfo.ri_flg = 0;
540 1.1 bsh scr->rinfo.ri_depth = type->depth;
541 1.1 bsh scr->rinfo.ri_bits = scr->buf_va;
542 1.1 bsh scr->rinfo.ri_width = sc->geometry->panel_width;
543 1.1 bsh scr->rinfo.ri_height = sc->geometry->panel_height;
544 1.1 bsh scr->rinfo.ri_stride = scr->rinfo.ri_width * scr->rinfo.ri_depth / 8;
545 1.1 bsh scr->rinfo.ri_wsfcookie = -1; /* XXX */
546 1.1 bsh
547 1.4 bsh rasops_init(&scr->rinfo, type->c.nrows, type->c.ncols);
548 1.1 bsh
549 1.4 bsh (* scr->rinfo.ri_ops.allocattr)(&scr->rinfo, 0, 0, 0, attrp);
550 1.1 bsh
551 1.1 bsh *cookiep = scr;
552 1.1 bsh *curxp = 0;
553 1.1 bsh *curyp = 0;
554 1.1 bsh
555 1.1 bsh return 0;
556 1.1 bsh }
557 1.1 bsh
558 1.1 bsh
559 1.1 bsh void
560 1.1 bsh pxa2x0_lcd_free_screen(void *v, void *cookie)
561 1.1 bsh {
562 1.1 bsh struct pxa2x0_lcd_softc *sc = v;
563 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
564 1.1 bsh
565 1.4 bsh LIST_REMOVE(scr, link);
566 1.1 bsh sc->n_screens--;
567 1.4 bsh if (scr == sc->active) {
568 1.1 bsh /* at first, we need to stop LCD DMA */
569 1.1 bsh sc->active = NULL;
570 1.1 bsh
571 1.4 bsh printf("lcd_free on active screen\n");
572 1.1 bsh
573 1.1 bsh pxa2x0_lcd_stop_dma(sc);
574 1.1 bsh }
575 1.1 bsh
576 1.4 bsh if (scr->buf_va)
577 1.4 bsh bus_dmamem_unmap(sc->dma_tag, scr->buf_va, scr->map_size);
578 1.1 bsh
579 1.4 bsh if (scr->nsegs > 0)
580 1.4 bsh bus_dmamem_free(sc->dma_tag, scr->segs, scr->nsegs);
581 1.1 bsh
582 1.4 bsh free(scr, M_DEVBUF);
583 1.1 bsh }
584 1.1 bsh
585 1.1 bsh int
586 1.1 bsh pxa2x0_lcd_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
587 1.1 bsh {
588 1.1 bsh struct pxa2x0_lcd_softc *sc = v;
589 1.1 bsh struct wsdisplay_fbinfo *wsdisp_info;
590 1.1 bsh uint32_t ccr0;
591 1.1 bsh
592 1.1 bsh switch (cmd) {
593 1.1 bsh case WSDISPLAYIO_GTYPE:
594 1.1 bsh *(u_int *)data = WSDISPLAY_TYPE_UNKNOWN; /* XXX */
595 1.1 bsh return 0;
596 1.1 bsh
597 1.1 bsh case WSDISPLAYIO_GINFO:
598 1.1 bsh wsdisp_info = (struct wsdisplay_fbinfo *)data;
599 1.1 bsh
600 1.1 bsh wsdisp_info->height = sc->geometry->panel_height;
601 1.1 bsh wsdisp_info->width = sc->geometry->panel_width;
602 1.1 bsh wsdisp_info->depth = 16; /* XXX */
603 1.1 bsh wsdisp_info->cmsize = 0;
604 1.1 bsh return 0;
605 1.1 bsh
606 1.1 bsh case WSDISPLAYIO_GETCMAP:
607 1.1 bsh case WSDISPLAYIO_PUTCMAP:
608 1.1 bsh return EPASSTHROUGH; /* XXX Colormap */
609 1.1 bsh
610 1.1 bsh case WSDISPLAYIO_SVIDEO:
611 1.4 bsh if (*(int *)data == WSDISPLAYIO_VIDEO_ON) {
612 1.1 bsh /* turn it on */
613 1.1 bsh }
614 1.1 bsh else {
615 1.1 bsh /* start LCD shutdown */
616 1.1 bsh /* sleep until interrupt */
617 1.1 bsh }
618 1.1 bsh return 0;
619 1.1 bsh
620 1.1 bsh case WSDISPLAYIO_GVIDEO:
621 1.4 bsh ccr0 = bus_space_read_4(sc->iot, sc->ioh, LCDC_LCCR0);
622 1.1 bsh *(u_int *)data = (ccr0 & (LCCR0_ENB|LCCR0_DIS)) == LCCR0_ENB ?
623 1.1 bsh WSDISPLAYIO_VIDEO_ON : WSDISPLAYIO_VIDEO_OFF;
624 1.1 bsh return 0;
625 1.1 bsh
626 1.1 bsh
627 1.1 bsh
628 1.1 bsh case WSDISPLAYIO_GCURPOS:
629 1.1 bsh case WSDISPLAYIO_SCURPOS:
630 1.1 bsh case WSDISPLAYIO_GCURMAX:
631 1.1 bsh case WSDISPLAYIO_GCURSOR:
632 1.1 bsh case WSDISPLAYIO_SCURSOR:
633 1.1 bsh return EPASSTHROUGH; /* XXX */
634 1.1 bsh }
635 1.1 bsh
636 1.1 bsh return EPASSTHROUGH;
637 1.1 bsh }
638 1.1 bsh
639 1.1 bsh paddr_t
640 1.1 bsh pxa2x0_lcd_mmap(void *v, off_t offset, int prot)
641 1.1 bsh {
642 1.1 bsh struct pxa2x0_lcd_softc *sc = v;
643 1.1 bsh struct pxa2x0_lcd_screen *screen = sc->active; /* ??? */
644 1.1 bsh
645 1.4 bsh if (screen == NULL)
646 1.1 bsh return -1;
647 1.1 bsh
648 1.4 bsh return bus_dmamem_mmap(sc->dma_tag, screen->segs, screen->nsegs,
649 1.4 bsh offset, prot, BUS_DMA_WAITOK|BUS_DMA_COHERENT);
650 1.1 bsh return -1;
651 1.1 bsh }
652 1.1 bsh
653 1.1 bsh
654 1.1 bsh static void
655 1.4 bsh pxa2x0_lcd_cursor(void *cookie, int on, int row, int col)
656 1.1 bsh {
657 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
658 1.1 bsh
659 1.4 bsh (* scr->rinfo.ri_ops.cursor)(&scr->rinfo, on, row, col);
660 1.1 bsh }
661 1.1 bsh
662 1.1 bsh static int
663 1.4 bsh pxa2x0_lcd_mapchar(void *cookie, int c, unsigned int *cp)
664 1.1 bsh {
665 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
666 1.1 bsh
667 1.4 bsh return (* scr->rinfo.ri_ops.mapchar)(&scr->rinfo, c, cp);
668 1.1 bsh }
669 1.1 bsh
670 1.1 bsh static void
671 1.4 bsh pxa2x0_lcd_putchar(void *cookie, int row, int col, u_int uc, long attr)
672 1.1 bsh {
673 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
674 1.1 bsh
675 1.4 bsh (* scr->rinfo.ri_ops.putchar)(&scr->rinfo,
676 1.4 bsh row, col, uc, attr);
677 1.1 bsh }
678 1.1 bsh
679 1.1 bsh static void
680 1.4 bsh pxa2x0_lcd_copycols(void *cookie, int row, int src, int dst, int num)
681 1.1 bsh {
682 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
683 1.1 bsh
684 1.4 bsh (* scr->rinfo.ri_ops.copycols)(&scr->rinfo,
685 1.4 bsh row, src, dst, num);
686 1.1 bsh }
687 1.1 bsh
688 1.1 bsh static void
689 1.4 bsh pxa2x0_lcd_erasecols(void *cookie, int row, int col, int num, long attr)
690 1.1 bsh {
691 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
692 1.1 bsh
693 1.4 bsh (* scr->rinfo.ri_ops.erasecols)(&scr->rinfo,
694 1.4 bsh row, col, num, attr);
695 1.1 bsh }
696 1.1 bsh
697 1.1 bsh static void
698 1.4 bsh pxa2x0_lcd_copyrows(void *cookie, int src, int dst, int num)
699 1.1 bsh {
700 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
701 1.1 bsh
702 1.4 bsh (* scr->rinfo.ri_ops.copyrows)(&scr->rinfo,
703 1.4 bsh src, dst, num);
704 1.1 bsh }
705 1.1 bsh
706 1.1 bsh static void
707 1.4 bsh pxa2x0_lcd_eraserows(void *cookie, int row, int num, long attr)
708 1.1 bsh {
709 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
710 1.1 bsh
711 1.4 bsh (* scr->rinfo.ri_ops.eraserows)(&scr->rinfo,
712 1.4 bsh row, num, attr);
713 1.1 bsh }
714 1.1 bsh
715 1.1 bsh static int
716 1.4 bsh pxa2x0_lcd_alloc_attr(void *cookie, int fg, int bg, int flg, long *attr)
717 1.1 bsh {
718 1.1 bsh struct pxa2x0_lcd_screen *scr = cookie;
719 1.1 bsh
720 1.4 bsh return (* scr->rinfo.ri_ops.allocattr)(&scr->rinfo,
721 1.4 bsh fg, bg, flg, attr);
722 1.1 bsh }
723 1.1 bsh
724 1.1 bsh
725 1.1 bsh const struct wsdisplay_emulops pxa2x0_lcd_emulops = {
726 1.1 bsh pxa2x0_lcd_cursor,
727 1.1 bsh pxa2x0_lcd_mapchar,
728 1.1 bsh pxa2x0_lcd_putchar,
729 1.1 bsh pxa2x0_lcd_copycols,
730 1.1 bsh pxa2x0_lcd_erasecols,
731 1.1 bsh pxa2x0_lcd_copyrows,
732 1.1 bsh pxa2x0_lcd_eraserows,
733 1.1 bsh pxa2x0_lcd_alloc_attr
734 1.1 bsh };
735 1.1 bsh
736 1.1 bsh #endif /* NWSDISPLAY > 0 */
737