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