Home | History | Annotate | Line # | Download | only in xscale
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