#include "opt_g42xxlcd.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/conf.h>
#include <sys/uio.h>
#include <dev/cons.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsdisplayvar.h>
#include <dev/wscons/wscons_callbacks.h>
#include <sys/bus.h>
#include <arm/sa11x0/sa11x0_var.h>
#include <arm/xscale/pxa2x0var.h>
#include <arm/xscale/pxa2x0reg.h>
#include <arm/xscale/pxa2x0_lcd.h>
#include <arch/evbarm/g42xxeb/g42xxeb_reg.h>
#include <arch/evbarm/g42xxeb/g42xxeb_var.h>
#include "wsdisplay.h"
#include "ioconf.h"
int lcd_match(device_t, cfdata_t, void *);
void lcd_attach(device_t, device_t, void *);
int lcdintr(void *);
#if NWSDISPLAY > 0
struct pxa2x0_wsscreen_descr lcd_bpp16_screen = {
{
"bpp16", 0, 0,
&pxa2x0_lcd_emulops,
0, 0,
WSSCREEN_WSCOLORS,
},
16
}, lcd_bpp8_screen = {
{
"bpp8", 0, 0,
&pxa2x0_lcd_emulops,
0, 0,
WSSCREEN_WSCOLORS,
},
8
}, lcd_bpp4_screen = {
{
"bpp4", 0, 0,
&pxa2x0_lcd_emulops,
0, 0,
WSSCREEN_WSCOLORS,
},
4
};
static const struct wsscreen_descr *lcd_scr_descr[] = {
&lcd_bpp4_screen.c,
&lcd_bpp8_screen.c,
&lcd_bpp16_screen.c,
};
const struct wsscreen_list lcd_screen_list = {
sizeof lcd_scr_descr / sizeof lcd_scr_descr[0],
lcd_scr_descr
};
int lcd_ioctl(void *, void *, u_long, void *, int, struct lwp *);
int lcd_show_screen(void *, void *, int,
void (*)(void *, int, int), void *);
const struct wsdisplay_accessops lcd_accessops = {
lcd_ioctl,
pxa2x0_lcd_mmap,
pxa2x0_lcd_alloc_screen,
pxa2x0_lcd_free_screen,
lcd_show_screen,
NULL,
};
#else
dev_type_open(lcdopen);
dev_type_close(lcdclose);
dev_type_ioctl(lcdioctl);
dev_type_mmap(lcdmmap);
const struct cdevsw lcd_cdevsw = {
.d_open = lcdopen,
.d_close = lcdclose,
.d_read = noread,
.d_write = nowrite,
.d_ioctl = lcdioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = nopoll,
.d_mmap = lcdmmap,
.d_kqfilter = nokqfilter,
.d_discard = nodiscard,
.d_flag = D_TTY
};
#endif
CFATTACH_DECL_NEW(lcd_obio, sizeof (struct pxa2x0_lcd_softc),
lcd_match, lcd_attach, NULL, NULL);
int
lcd_match( device_t parent, cfdata_t cf, void *aux )
{
return 1;
}
#ifdef G4250_LCD_NEC_NL3224BC35
static const struct lcd_panel_geometry nec_NL3224BC35 =
{
320,
240,
0,
LCDPANEL_SINGLE|LCDPANEL_ACTIVE|LCDPANEL_PCP|
LCDPANEL_VSP|LCDPANEL_HSP,
7,
0xff,
6,
70,
7,
10,
11,
1,
};
#endif
#ifdef G4250_LCD_TOSHIBA_LTM035
const struct lcd_panel_geometry toshiba_LTM035 =
{
240,
320,
0,
LCDPANEL_SINGLE|LCDPANEL_ACTIVE|
LCDPANEL_VSP|LCDPANEL_HSP,
11,
0xff,
4,
8,
4,
2,
2,
3,
};
#endif
void lcd_attach(device_t parent, device_t self, void *aux)
{
struct pxa2x0_lcd_softc *sc = device_private(self);
struct pxaip_attach_args paa;
struct obio_attach_args *oba = aux;
sc->dev = self;
paa.pxa_name = "obio";
paa.pxa_iot = oba->oba_iot;
paa.pxa_addr = oba->oba_addr;
paa.pxa_size = 0;
paa.pxa_intr = oba->oba_intr;
#ifdef G4250_LCD_TOSHIBA_LTM035
# define PANEL toshiba_LTM035
#else
# define PANEL nec_NL3224BC35
#endif
pxa2x0_lcd_attach_sub(sc, &paa, &PANEL);
#if NWSDISPLAY > 0
{
struct wsemuldisplaydev_attach_args aa;
pxa2x0_lcd_setup_wsscreen(&lcd_bpp16_screen, &PANEL, NULL);
pxa2x0_lcd_setup_wsscreen(&lcd_bpp8_screen, &PANEL, NULL);
pxa2x0_lcd_setup_wsscreen(&lcd_bpp4_screen, &PANEL, NULL);
aa.console = 0;
aa.scrdata = &lcd_screen_list;
aa.accessops = &lcd_accessops;
aa.accesscookie = sc;
(void) config_found(self, &aa, wsemuldisplaydevprint,
CFARGS_NONE);
}
#else
{
struct pxa2x0_lcd_screen *screen;
int error;
error = pxa2x0_lcd_new_screen( sc, 16, &screen );
if (error == 0) {
sc->active = screen;
pxa2x0_lcd_start_dma(sc, screen);
}
}
#endif
#undef PANEL
}
#if NWSDISPLAY > 0
int
lcd_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
{
struct pxa2x0_lcd_softc *sc = v;
struct obio_softc *osc =
device_private(device_parent(sc->dev));
uint16_t reg;
switch (cmd) {
case WSDISPLAYIO_SVIDEO:
reg = bus_space_read_2(osc->sc_iot, osc->sc_obioreg_ioh,
G42XXEB_LCDCTL);
if (*(int *)data == WSDISPLAYIO_VIDEO_ON)
reg |= LCDCTL_BL_ON;
else
reg &= ~LCDCTL_BL_ON;
bus_space_write_2(osc->sc_iot, osc->sc_obioreg_ioh,
G42XXEB_LCDCTL, reg);
bus_space_write_1(osc->sc_iot, osc->sc_obioreg_ioh,
G42XXEB_LED, reg);
printf("LCD control: %x\n", reg);
break;
}
return pxa2x0_lcd_ioctl(v, vs, cmd, data, flag, l);
}
int
lcd_show_screen(void *v, void *cookie, int waitok,
void (*cb)(void *, int, int), void *cbarg)
{
struct pxa2x0_lcd_softc *sc = v;
struct obio_softc *osc =
device_private(device_parent(sc->dev));
uint16_t reg;
pxa2x0_lcd_show_screen(v,cookie,waitok,cb,cbarg);
reg = bus_space_read_2(osc->sc_iot, osc->sc_obioreg_ioh, G42XXEB_LCDCTL);
bus_space_write_2(osc->sc_iot, osc->sc_obioreg_ioh, G42XXEB_LCDCTL,
(reg & ~LCDCTL_BL_PWN) | 0x4000 | LCDCTL_BL_ON);
return 0;
}
#else
int
lcdopen(dev_t dev, int oflags, int devtype, struct lwp *l)
{
struct pxa2x0_lcd_softc *sc =
device_lookup_private(&lcd_cd, minor(dev));
struct obio_softc *osc =
device_private(device_parent(sc->dev));
uint16_t reg;
reg = bus_space_read_2(osc->sc_iot, osc->sc_obioreg_ioh, G42XXEB_LCDCTL);
bus_space_write_2(osc->sc_iot, osc->sc_obioreg_ioh, G42XXEB_LCDCTL,
(reg & ~LCDCTL_BL_PWN) | 0x4000 | LCDCTL_BL_ON);
return 0;
}
int
lcdclose(dev_t dev, int fflag, int devtype, struct lwp *l)
{
return 0;
}
paddr_t
lcdmmap(dev_t dev, off_t offset, int size)
{
struct pxa2x0_lcd_softc *sc =
device_lookup_private(&lcd_cd, minor(dev));
struct pxa2x0_lcd_screen *scr = sc->active;
return bus_dmamem_mmap( &pxa2x0_bus_dma_tag, scr->segs, scr->nsegs,
offset, 0, BUS_DMA_WAITOK|BUS_DMA_COHERENT );
}
int
lcdioctl(dev_t dev, u_long cmd, void *data,
int fflag, struct lwp *l)
{
return EOPNOTSUPP;
}
#endif