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