Home | History | Annotate | Line # | Download | only in ic
hd44780_subr.c revision 1.6
      1  1.6  perry /* $NetBSD: hd44780_subr.c,v 1.6 2005/02/27 00:27:01 perry Exp $ */
      2  1.1  soren 
      3  1.1  soren /*
      4  1.1  soren  * Copyright (c) 2002 Dennis I. Chernoivanov
      5  1.1  soren  * All rights reserved.
      6  1.1  soren  *
      7  1.1  soren  * Redistribution and use in source and binary forms, with or without
      8  1.1  soren  * modification, are permitted provided that the following conditions
      9  1.1  soren  * are met:
     10  1.1  soren  * 1. Redistributions of source code must retain the above copyright
     11  1.1  soren  *    notice, this list of conditions and the following disclaimer.
     12  1.1  soren  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  soren  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  soren  *    documentation and/or other materials provided with the distribution.
     15  1.1  soren  * 3. The name of the author may not be used to endorse or promote products
     16  1.1  soren  *    derived from this software without specific prior written permission
     17  1.1  soren  *
     18  1.1  soren  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19  1.1  soren  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     20  1.1  soren  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     21  1.1  soren  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     22  1.1  soren  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     23  1.1  soren  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     24  1.1  soren  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     25  1.1  soren  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     26  1.1  soren  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     27  1.1  soren  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     28  1.1  soren  */
     29  1.1  soren 
     30  1.1  soren /*
     31  1.1  soren  * Subroutines for Hitachi HD44870 style displays
     32  1.1  soren  */
     33  1.1  soren 
     34  1.1  soren #include <sys/cdefs.h>
     35  1.6  perry __KERNEL_RCSID(0, "$NetBSD: hd44780_subr.c,v 1.6 2005/02/27 00:27:01 perry Exp $");
     36  1.1  soren 
     37  1.1  soren #include <sys/param.h>
     38  1.1  soren #include <sys/systm.h>
     39  1.1  soren #include <sys/conf.h>
     40  1.1  soren #include <sys/kernel.h>
     41  1.5   joff #include <sys/malloc.h>
     42  1.1  soren #include <sys/types.h>
     43  1.1  soren #include <sys/ioccom.h>
     44  1.1  soren 
     45  1.1  soren #include <machine/autoconf.h>
     46  1.1  soren #include <machine/intr.h>
     47  1.1  soren #include <machine/bus.h>
     48  1.1  soren 
     49  1.5   joff #include <uvm/uvm_extern.h>
     50  1.5   joff 
     51  1.5   joff #include <dev/wscons/wsdisplayvar.h>
     52  1.5   joff #include <dev/wscons/wsconsio.h>
     53  1.5   joff #include <dev/wscons/wscons_callbacks.h>
     54  1.5   joff 
     55  1.1  soren #include <dev/ic/hd44780reg.h>
     56  1.4   joff #include <dev/ic/hd44780var.h>
     57  1.1  soren 
     58  1.5   joff #define COORD_TO_IDX(x, y)	((y) * sc->sc_cols + (x))
     59  1.5   joff #define COORD_TO_DADDR(x, y)	((y) * HD_ROW2_ADDR + (x))
     60  1.5   joff #define IDX_TO_ROW(idx)		(((idx) >= sc->sc_cols) ? 1 : 0)
     61  1.5   joff #define IDX_TO_COL(idx)		(((idx) >= sc->sc_cols) ? \
     62  1.5   joff 				((idx) - sc->sc_cols) : (idx))
     63  1.5   joff #define IDX_TO_DDADDR(idx)	((IDX_TO_ROW((idx)) == 1) ? \
     64  1.5   joff 				(HD_ROW2_ADDR + IDX_TO_COL((idx))) : \
     65  1.5   joff 				(IDX_TO_COL((idx))))
     66  1.5   joff #define DADDR_TO_ROW(daddr)	(((daddr) >= HD_ROW2_ADDR) ? 1 : 0)
     67  1.5   joff #define DADDR_TO_COL(daddr)	((DADDR_TO_ROW((daddr)) == 1) ? \
     68  1.5   joff 				((daddr) - HD_ROW2_ADDR) : (daddr))
     69  1.5   joff 
     70  1.5   joff static void	hlcd_cursor(void *, int, int, int);
     71  1.5   joff static int	hlcd_mapchar(void *, int, unsigned int *);
     72  1.5   joff static void	hlcd_putchar(void *, int, int, u_int, long);
     73  1.5   joff static void	hlcd_copycols(void *, int, int, int,int);
     74  1.5   joff static void	hlcd_erasecols(void *, int, int, int, long);
     75  1.5   joff static void	hlcd_copyrows(void *, int, int, int);
     76  1.5   joff static void	hlcd_eraserows(void *, int, int, long);
     77  1.5   joff static int	hlcd_allocattr(void *, int, int, int, long *);
     78  1.5   joff static void	hlcd_updatechar(struct hd44780_chip *, int, int);
     79  1.5   joff static void	hlcd_redraw(void *);
     80  1.5   joff 
     81  1.5   joff const struct wsdisplay_emulops hlcd_emulops = {
     82  1.5   joff 	hlcd_cursor,
     83  1.5   joff 	hlcd_mapchar,
     84  1.5   joff 	hlcd_putchar,
     85  1.5   joff 	hlcd_copycols,
     86  1.5   joff 	hlcd_erasecols,
     87  1.5   joff 	hlcd_copyrows,
     88  1.5   joff 	hlcd_eraserows,
     89  1.5   joff 	hlcd_allocattr
     90  1.5   joff };
     91  1.5   joff 
     92  1.5   joff static int	hlcd_ioctl(void *, u_long, caddr_t, int, struct proc *);
     93  1.5   joff static paddr_t	hlcd_mmap(void *, off_t, int);
     94  1.5   joff static int	hlcd_alloc_screen(void *, const struct wsscreen_descr *,
     95  1.5   joff 		    void **, int *, int *, long *);
     96  1.5   joff static void	hlcd_free_screen(void *, void *);
     97  1.5   joff static int	hlcd_show_screen(void *, void *, int,
     98  1.5   joff 		    void (*) (void *, int, int), void *);
     99  1.5   joff 
    100  1.5   joff const struct wsdisplay_accessops hlcd_accessops = {
    101  1.5   joff 	hlcd_ioctl,
    102  1.5   joff 	hlcd_mmap,
    103  1.5   joff 	hlcd_alloc_screen,
    104  1.5   joff 	hlcd_free_screen,
    105  1.5   joff 	hlcd_show_screen,
    106  1.5   joff 	0 /* load_font */
    107  1.5   joff };
    108  1.5   joff 
    109  1.5   joff static void
    110  1.5   joff hlcd_cursor(id, on, row, col)
    111  1.5   joff 	void *id;
    112  1.5   joff 	int on, row, col;
    113  1.5   joff {
    114  1.5   joff 	struct hlcd_screen *hdscr = id;
    115  1.5   joff 
    116  1.5   joff 	hdscr->hlcd_curon = on;
    117  1.5   joff 	hdscr->hlcd_curx = col;
    118  1.5   joff 	hdscr->hlcd_cury = row;
    119  1.5   joff }
    120  1.5   joff 
    121  1.5   joff static int
    122  1.5   joff hlcd_mapchar(id, uni, index)
    123  1.5   joff 	void *id;
    124  1.5   joff 	int uni;
    125  1.5   joff 	unsigned int *index;
    126  1.5   joff {
    127  1.5   joff 	if (uni < 256) {
    128  1.5   joff 		*index = uni;
    129  1.5   joff 		return (5);
    130  1.5   joff 	}
    131  1.5   joff 	*index = ' ';
    132  1.5   joff 	return (0);
    133  1.5   joff }
    134  1.5   joff 
    135  1.5   joff static void
    136  1.5   joff hlcd_putchar(id, row, col, c, attr)
    137  1.5   joff 	void *id;
    138  1.5   joff 	int row, col;
    139  1.5   joff 	u_int c;
    140  1.5   joff 	long attr;
    141  1.5   joff {
    142  1.5   joff 	struct hlcd_screen *hdscr = id;
    143  1.6  perry 
    144  1.5   joff 	c &= 0xff;
    145  1.5   joff 	if (row > 0 && (hdscr->hlcd_sc->sc_flags & HD_MULTILINE))
    146  1.5   joff 		hdscr->image[hdscr->hlcd_sc->sc_cols * row + col] = c;
    147  1.5   joff 	else
    148  1.5   joff 		hdscr->image[col] = c;
    149  1.5   joff }
    150  1.5   joff 
    151  1.5   joff /*
    152  1.5   joff  * copies columns inside a row.
    153  1.5   joff  */
    154  1.5   joff static void
    155  1.5   joff hlcd_copycols(id, row, srccol, dstcol, ncols)
    156  1.5   joff 	void *id;
    157  1.5   joff 	int row, srccol, dstcol, ncols;
    158  1.5   joff {
    159  1.5   joff 	struct hlcd_screen *hdscr = id;
    160  1.5   joff 
    161  1.5   joff 	if ((dstcol + ncols - 1) > hdscr->hlcd_sc->sc_cols)
    162  1.5   joff 		ncols = hdscr->hlcd_sc->sc_cols - srccol;
    163  1.5   joff 
    164  1.5   joff 	if (row > 0 && (hdscr->hlcd_sc->sc_flags & HD_MULTILINE))
    165  1.5   joff 		bcopy(&hdscr->image[hdscr->hlcd_sc->sc_cols * row + srccol],
    166  1.5   joff 		    &hdscr->image[hdscr->hlcd_sc->sc_cols * row + dstcol], ncols);
    167  1.5   joff 	else
    168  1.5   joff 		bcopy(&hdscr->image[srccol], &hdscr->image[dstcol], ncols);
    169  1.5   joff }
    170  1.5   joff 
    171  1.5   joff 
    172  1.5   joff /*
    173  1.5   joff  * Erases a bunch of chars inside one row.
    174  1.5   joff  */
    175  1.5   joff static void
    176  1.5   joff hlcd_erasecols(id, row, startcol, ncols, fillattr)
    177  1.5   joff 	void *id;
    178  1.5   joff 	int row, startcol, ncols;
    179  1.5   joff 	long fillattr;
    180  1.5   joff {
    181  1.5   joff 	struct hlcd_screen *hdscr = id;
    182  1.5   joff 
    183  1.5   joff 	if ((startcol + ncols) > hdscr->hlcd_sc->sc_cols)
    184  1.5   joff 		ncols = hdscr->hlcd_sc->sc_cols - startcol;
    185  1.5   joff 
    186  1.5   joff 	if (row > 0 && (hdscr->hlcd_sc->sc_flags & HD_MULTILINE))
    187  1.6  perry 		memset(&hdscr->image[hdscr->hlcd_sc->sc_cols * row + startcol],
    188  1.5   joff 		    ' ', ncols);
    189  1.5   joff 	else
    190  1.5   joff 		memset(&hdscr->image[startcol], ' ', ncols);
    191  1.5   joff }
    192  1.5   joff 
    193  1.5   joff 
    194  1.5   joff static void
    195  1.5   joff hlcd_copyrows(id, srcrow, dstrow, nrows)
    196  1.5   joff 	void *id;
    197  1.5   joff 	int srcrow, dstrow, nrows;
    198  1.5   joff {
    199  1.5   joff 	struct hlcd_screen *hdscr = id;
    200  1.5   joff 	int ncols = hdscr->hlcd_sc->sc_cols;
    201  1.6  perry 
    202  1.5   joff 	if (!(hdscr->hlcd_sc->sc_flags & HD_MULTILINE))
    203  1.5   joff 		return;
    204  1.5   joff 	bcopy(&hdscr->image[srcrow * ncols], &hdscr->image[dstrow * ncols],
    205  1.5   joff 	    nrows * ncols);
    206  1.5   joff }
    207  1.5   joff 
    208  1.5   joff static void
    209  1.5   joff hlcd_eraserows(id, startrow, nrows, fillattr)
    210  1.5   joff 	void *id;
    211  1.5   joff 	int startrow, nrows;
    212  1.5   joff 	long fillattr;
    213  1.5   joff {
    214  1.5   joff 	struct hlcd_screen *hdscr = id;
    215  1.5   joff 	int ncols = hdscr->hlcd_sc->sc_cols;
    216  1.5   joff 
    217  1.5   joff 	memset(&hdscr->image[startrow * ncols], ' ', ncols * nrows);
    218  1.5   joff }
    219  1.5   joff 
    220  1.5   joff 
    221  1.5   joff static int
    222  1.5   joff hlcd_allocattr(id, fg, bg, flags, attrp)
    223  1.5   joff 	void *id;
    224  1.5   joff 	int fg, bg, flags;
    225  1.5   joff 	long *attrp;
    226  1.5   joff {
    227  1.5   joff         *attrp = flags;
    228  1.5   joff         return 0;
    229  1.5   joff }
    230  1.5   joff 
    231  1.5   joff static int
    232  1.5   joff hlcd_ioctl(v, cmd, data, flag, p)
    233  1.5   joff 	void *v;
    234  1.5   joff 	u_long cmd;
    235  1.5   joff 	caddr_t data;
    236  1.5   joff 	int flag;
    237  1.5   joff 	struct proc *p;
    238  1.5   joff {
    239  1.5   joff 
    240  1.5   joff 	switch (cmd) {
    241  1.5   joff 	case WSDISPLAYIO_GTYPE:
    242  1.5   joff 		*(u_int *)data = WSDISPLAY_TYPE_HDLCD;
    243  1.5   joff 		break;
    244  1.5   joff 
    245  1.5   joff 	case WSDISPLAYIO_SVIDEO:
    246  1.5   joff 		break;
    247  1.5   joff 
    248  1.5   joff 	case WSDISPLAYIO_GVIDEO:
    249  1.5   joff 		*(u_int *)data = WSDISPLAYIO_VIDEO_ON;
    250  1.5   joff 		break;
    251  1.5   joff 
    252  1.5   joff 	default:
    253  1.5   joff 		return EPASSTHROUGH;
    254  1.5   joff 	}
    255  1.5   joff 	return 0;
    256  1.5   joff }
    257  1.5   joff 
    258  1.5   joff static paddr_t
    259  1.5   joff hlcd_mmap(v, offset, prot)
    260  1.5   joff 	void *v;
    261  1.5   joff 	off_t offset;
    262  1.5   joff 	int prot;
    263  1.5   joff {
    264  1.5   joff 	return -1;
    265  1.5   joff }
    266  1.5   joff 
    267  1.5   joff static int
    268  1.5   joff hlcd_alloc_screen(v, type, cookiep, curxp, curyp, defattrp)
    269  1.5   joff 	void *v;
    270  1.5   joff 	const struct wsscreen_descr *type;
    271  1.5   joff 	void **cookiep;
    272  1.5   joff 	int *curxp, *curyp;
    273  1.5   joff 	long *defattrp;
    274  1.5   joff {
    275  1.5   joff 	struct hlcd_screen *hdscr = v, *new;
    276  1.5   joff 
    277  1.5   joff 	new = *cookiep = malloc(sizeof(struct hlcd_screen), M_DEVBUF, M_WAITOK);
    278  1.5   joff 	bzero(*cookiep, sizeof(struct hlcd_screen));
    279  1.5   joff 	new->hlcd_sc = hdscr->hlcd_sc;
    280  1.5   joff 	new->image = malloc(PAGE_SIZE, M_DEVBUF, M_WAITOK);
    281  1.5   joff 	memset(new->image, ' ', PAGE_SIZE);
    282  1.5   joff 	*curxp = *curyp = *defattrp = 0;
    283  1.5   joff 	return 0;
    284  1.5   joff }
    285  1.5   joff 
    286  1.5   joff static void
    287  1.5   joff hlcd_free_screen(v, cookie)
    288  1.5   joff 	void *v, *cookie;
    289  1.5   joff {
    290  1.5   joff }
    291  1.5   joff 
    292  1.5   joff static int
    293  1.5   joff hlcd_show_screen(v, cookie, waitok, cb, cbarg)
    294  1.5   joff 	void *v, *cookie, *cbarg;
    295  1.5   joff 	int waitok;
    296  1.5   joff 	void (*cb)(void *, int, int);
    297  1.5   joff {
    298  1.5   joff 	struct hlcd_screen *hdscr = v;
    299  1.5   joff 
    300  1.5   joff 	hdscr->hlcd_sc->sc_curscr = cookie;
    301  1.5   joff 	callout_schedule(&hdscr->hlcd_sc->redraw, 1);
    302  1.5   joff 	return (0);
    303  1.5   joff }
    304  1.5   joff 
    305  1.5   joff static void
    306  1.5   joff hlcd_updatechar(sc, daddr, c)
    307  1.5   joff 	struct hd44780_chip *sc;
    308  1.5   joff 	int daddr, c;
    309  1.5   joff {
    310  1.5   joff 	int curdaddr;
    311  1.5   joff 
    312  1.5   joff 	curdaddr = COORD_TO_DADDR(sc->sc_screen.hlcd_curx,
    313  1.5   joff 	    sc->sc_screen.hlcd_cury);
    314  1.5   joff 	if (daddr != curdaddr)
    315  1.5   joff 		hd44780_ir_write(sc, cmd_ddramset(daddr));
    316  1.5   joff 
    317  1.5   joff 	hd44780_dr_write(sc, c);
    318  1.5   joff 
    319  1.5   joff 	daddr++;
    320  1.5   joff 	sc->sc_screen.hlcd_curx = DADDR_TO_COL(daddr);
    321  1.5   joff 	sc->sc_screen.hlcd_cury = DADDR_TO_ROW(daddr);
    322  1.5   joff }
    323  1.5   joff 
    324  1.5   joff static void
    325  1.5   joff hlcd_redraw(arg)
    326  1.5   joff 	void *arg;
    327  1.5   joff {
    328  1.5   joff 	struct hd44780_chip *sc = arg;
    329  1.5   joff 	int len, crsridx, startidx, x, y;
    330  1.5   joff 	u_char *img, *curimg;
    331  1.6  perry 
    332  1.5   joff 	if (sc->sc_curscr == NULL)
    333  1.5   joff 		return;
    334  1.5   joff 
    335  1.5   joff 	if (sc->sc_flags & HD_MULTILINE)
    336  1.5   joff 		len = 2 * sc->sc_cols;
    337  1.5   joff 	else
    338  1.5   joff 		len = sc->sc_cols;
    339  1.5   joff 
    340  1.5   joff 	img = sc->sc_screen.image;
    341  1.5   joff 	curimg = sc->sc_curscr->image;
    342  1.5   joff 	startidx = crsridx =
    343  1.5   joff 	    COORD_TO_IDX(sc->sc_screen.hlcd_curx, sc->sc_screen.hlcd_cury);
    344  1.5   joff 	do {
    345  1.5   joff 		if (img[crsridx] != curimg[crsridx]) {
    346  1.6  perry 			hlcd_updatechar(sc, IDX_TO_DDADDR(crsridx),
    347  1.5   joff 			    curimg[crsridx]);
    348  1.5   joff 			img[crsridx] = curimg[crsridx];
    349  1.5   joff 		}
    350  1.5   joff 		crsridx++;
    351  1.5   joff 		if (crsridx == len)
    352  1.5   joff 			crsridx = 0;
    353  1.5   joff 	} while (crsridx != startidx);
    354  1.6  perry 
    355  1.5   joff 	if (sc->sc_screen.hlcd_curx != sc->sc_curscr->hlcd_curx ||
    356  1.5   joff 	    sc->sc_screen.hlcd_cury != sc->sc_curscr->hlcd_cury) {
    357  1.5   joff 		x = sc->sc_screen.hlcd_curx = sc->sc_curscr->hlcd_curx;
    358  1.5   joff 		y = sc->sc_screen.hlcd_cury = sc->sc_curscr->hlcd_cury;
    359  1.5   joff 		hd44780_ir_write(sc, cmd_ddramset(COORD_TO_DADDR(x, y)));
    360  1.5   joff 	}
    361  1.5   joff 
    362  1.5   joff 	if (sc->sc_screen.hlcd_curon != sc->sc_curscr->hlcd_curon) {
    363  1.5   joff 		sc->sc_screen.hlcd_curon = sc->sc_curscr->hlcd_curon;
    364  1.5   joff 		if (sc->sc_screen.hlcd_curon)
    365  1.5   joff 			hd44780_ir_write(sc, cmd_dispctl(1, 1, 1));
    366  1.5   joff 		else
    367  1.5   joff 			hd44780_ir_write(sc, cmd_dispctl(1, 0, 0));
    368  1.5   joff 	}
    369  1.5   joff 
    370  1.5   joff 	callout_schedule(&sc->redraw, 1);
    371  1.5   joff }
    372  1.5   joff 
    373  1.5   joff 
    374  1.1  soren /*
    375  1.1  soren  * Finish device attach. sc_writereg, sc_readreg and sc_flags must be properly
    376  1.1  soren  * initialized prior to this call.
    377  1.1  soren  */
    378  1.1  soren void
    379  1.1  soren hd44780_attach_subr(sc)
    380  1.1  soren 	struct hd44780_chip *sc;
    381  1.1  soren {
    382  1.3   joff 	int err = 0;
    383  1.1  soren 	/* Putc/getc are supposed to be set by platform-dependent code. */
    384  1.2   joff 	if ((sc->sc_writereg == NULL) || (sc->sc_readreg == NULL))
    385  1.1  soren 		sc->sc_dev_ok = 0;
    386  1.1  soren 
    387  1.1  soren 	/* Make sure that HD_MAX_CHARS is enough. */
    388  1.5   joff 	if ((sc->sc_flags & HD_MULTILINE) && (2 * sc->sc_cols > HD_MAX_CHARS))
    389  1.1  soren 		sc->sc_dev_ok = 0;
    390  1.5   joff 	else if (sc->sc_cols > HD_MAX_CHARS)
    391  1.1  soren 		sc->sc_dev_ok = 0;
    392  1.1  soren 
    393  1.1  soren 	if (sc->sc_dev_ok) {
    394  1.6  perry 		if ((sc->sc_flags & HD_UP) == 0)
    395  1.3   joff 			err = hd44780_init(sc);
    396  1.3   joff 		if (err != 0)
    397  1.4   joff 			printf("%s: LCD not responding or unconnected\n", sc->sc_dev->dv_xname);
    398  1.1  soren 
    399  1.1  soren 	}
    400  1.5   joff 
    401  1.5   joff 	sc->sc_screen.hlcd_sc = sc;
    402  1.6  perry 
    403  1.5   joff 	sc->sc_screen.image = malloc(PAGE_SIZE, M_DEVBUF, M_WAITOK);
    404  1.5   joff 	memset(sc->sc_screen.image, ' ', PAGE_SIZE);
    405  1.5   joff 	sc->sc_curscr = NULL;
    406  1.5   joff 	callout_init(&sc->redraw);
    407  1.5   joff 	callout_setfunc(&sc->redraw, hlcd_redraw, sc);
    408  1.1  soren }
    409  1.1  soren 
    410  1.1  soren /*
    411  1.1  soren  * Initialize 4-bit or 8-bit connected device.
    412  1.1  soren  */
    413  1.3   joff int
    414  1.1  soren hd44780_init(sc)
    415  1.1  soren 	struct hd44780_chip *sc;
    416  1.1  soren {
    417  1.3   joff 	u_int8_t cmd, dat;
    418  1.1  soren 
    419  1.3   joff 	sc->sc_flags &= ~(HD_TIMEDOUT|HD_UP);
    420  1.3   joff 	sc->sc_dev_ok = 1;
    421  1.1  soren 	cmd = cmd_init(sc->sc_flags & HD_8BIT);
    422  1.2   joff 	hd44780_ir_write(sc, cmd);
    423  1.2   joff 	delay(HD_TIMEOUT_LONG);
    424  1.2   joff 	hd44780_ir_write(sc, cmd);
    425  1.2   joff 	hd44780_ir_write(sc, cmd);
    426  1.1  soren 
    427  1.1  soren 	cmd = cmd_funcset(
    428  1.1  soren 			sc->sc_flags & HD_8BIT,
    429  1.1  soren 			sc->sc_flags & HD_MULTILINE,
    430  1.1  soren 			sc->sc_flags & HD_BIGFONT);
    431  1.1  soren 
    432  1.1  soren 	if ((sc->sc_flags & HD_8BIT) == 0)
    433  1.2   joff 		hd44780_ir_write(sc, cmd);
    434  1.1  soren 
    435  1.2   joff 	sc->sc_flags |= HD_UP;
    436  1.2   joff 
    437  1.2   joff 	hd44780_ir_write(sc, cmd);
    438  1.2   joff 	hd44780_ir_write(sc, cmd_dispctl(0, 0, 0));
    439  1.2   joff 	hd44780_ir_write(sc, cmd_clear());
    440  1.2   joff 	hd44780_ir_write(sc, cmd_modset(1, 0));
    441  1.3   joff 
    442  1.3   joff 	if (sc->sc_flags & HD_TIMEDOUT) {
    443  1.3   joff 		sc->sc_flags &= ~HD_UP;
    444  1.3   joff 		return EIO;
    445  1.6  perry 	}
    446  1.3   joff 
    447  1.3   joff 	/* Turn display on and clear it. */
    448  1.3   joff 	hd44780_ir_write(sc, cmd_clear());
    449  1.3   joff 	hd44780_ir_write(sc, cmd_dispctl(1, 0, 0));
    450  1.3   joff 
    451  1.3   joff 	/* Attempt a simple probe for presence */
    452  1.3   joff 	hd44780_ir_write(sc, cmd_ddramset(0x5));
    453  1.3   joff 	hd44780_ir_write(sc, cmd_shift(0, 1));
    454  1.3   joff 	hd44780_busy_wait(sc);
    455  1.3   joff 	if ((dat = hd44780_ir_read(sc) & 0x7f) != 0x6) {
    456  1.3   joff 		sc->sc_dev_ok = 0;
    457  1.3   joff 		sc->sc_flags &= ~HD_UP;
    458  1.3   joff 		return EIO;
    459  1.3   joff 	}
    460  1.3   joff 	hd44780_ir_write(sc, cmd_ddramset(0));
    461  1.3   joff 
    462  1.3   joff 	return 0;
    463  1.1  soren }
    464  1.1  soren 
    465  1.1  soren /*
    466  1.1  soren  * Standard hd44780 ioctl() functions.
    467  1.1  soren  */
    468  1.1  soren int
    469  1.1  soren hd44780_ioctl_subr(sc, cmd, data)
    470  1.1  soren 	struct hd44780_chip *sc;
    471  1.1  soren 	u_long cmd;
    472  1.1  soren 	caddr_t data;
    473  1.1  soren {
    474  1.1  soren 	u_int8_t tmp;
    475  1.1  soren 	int error = 0;
    476  1.1  soren 
    477  1.1  soren #define hd44780_io()	((struct hd44780_io *)data)
    478  1.1  soren #define hd44780_info()	((struct hd44780_info*)data)
    479  1.1  soren #define hd44780_ctrl()	((struct hd44780_dispctl*)data)
    480  1.1  soren 
    481  1.1  soren 	switch (cmd) {
    482  1.1  soren 		/* Clear the LCD. */
    483  1.1  soren 		case HLCD_CLEAR:
    484  1.1  soren 			hd44780_ir_write(sc, cmd_clear());
    485  1.1  soren 			break;
    486  1.1  soren 
    487  1.1  soren 		/* Move the cursor one position to the left. */
    488  1.1  soren 		case HLCD_CURSOR_LEFT:
    489  1.1  soren 			hd44780_ir_write(sc, cmd_shift(0, 0));
    490  1.1  soren 			break;
    491  1.1  soren 
    492  1.1  soren 		/* Move the cursor one position to the right. */
    493  1.1  soren 		case HLCD_CURSOR_RIGHT:
    494  1.1  soren 			hd44780_ir_write(sc, cmd_shift(0, 1));
    495  1.6  perry 			break;
    496  1.1  soren 
    497  1.1  soren 		/* Control the LCD. */
    498  1.1  soren 		case HLCD_DISPCTL:
    499  1.1  soren 			hd44780_ir_write(sc, cmd_dispctl(
    500  1.1  soren 						hd44780_ctrl()->display_on,
    501  1.1  soren 						hd44780_ctrl()->cursor_on,
    502  1.1  soren 						hd44780_ctrl()->blink_on));
    503  1.1  soren 			break;
    504  1.1  soren 
    505  1.1  soren 		/* Get LCD configuration. */
    506  1.1  soren 		case HLCD_GET_INFO:
    507  1.1  soren 			hd44780_info()->lines
    508  1.1  soren 				= (sc->sc_flags & HD_MULTILINE) ? 2 : 1;
    509  1.5   joff 			hd44780_info()->phys_rows = sc->sc_cols;
    510  1.5   joff 			hd44780_info()->virt_rows = sc->sc_vcols;
    511  1.1  soren 			hd44780_info()->is_wide = sc->sc_flags & HD_8BIT;
    512  1.1  soren 			hd44780_info()->is_bigfont = sc->sc_flags & HD_BIGFONT;
    513  1.1  soren 			hd44780_info()->kp_present = sc->sc_flags & HD_KEYPAD;
    514  1.1  soren 			break;
    515  1.1  soren 
    516  1.1  soren 
    517  1.1  soren 		/* Reset the LCD. */
    518  1.1  soren 		case HLCD_RESET:
    519  1.3   joff 			error = hd44780_init(sc);
    520  1.1  soren 			break;
    521  1.1  soren 
    522  1.1  soren 		/* Get the current cursor position. */
    523  1.1  soren 		case HLCD_GET_CURSOR_POS:
    524  1.1  soren 			hd44780_io()->dat = (hd44780_ir_read(sc) & 0x7f);
    525  1.1  soren 			break;
    526  1.1  soren 
    527  1.1  soren 		/* Set the cursor position. */
    528  1.1  soren 		case HLCD_SET_CURSOR_POS:
    529  1.1  soren 			hd44780_ir_write(sc, cmd_ddramset(hd44780_io()->dat));
    530  1.1  soren 			break;
    531  1.1  soren 
    532  1.1  soren 		/* Get the value at the current cursor position. */
    533  1.1  soren 		case HLCD_GETC:
    534  1.1  soren 			tmp = (hd44780_ir_read(sc) & 0x7f);
    535  1.1  soren 			hd44780_ir_write(sc, cmd_ddramset(tmp));
    536  1.1  soren 			hd44780_io()->dat = hd44780_dr_read(sc);
    537  1.1  soren 			break;
    538  1.1  soren 
    539  1.1  soren 		/* Set the character at the cursor position + advance cursor. */
    540  1.1  soren 		case HLCD_PUTC:
    541  1.1  soren 			hd44780_dr_write(sc, hd44780_io()->dat);
    542  1.1  soren 			break;
    543  1.1  soren 
    544  1.1  soren 		/* Shift display left. */
    545  1.1  soren 		case HLCD_SHIFT_LEFT:
    546  1.1  soren 			hd44780_ir_write(sc, cmd_shift(1, 0));
    547  1.1  soren 			break;
    548  1.1  soren 
    549  1.1  soren 		/* Shift display right. */
    550  1.1  soren 		case HLCD_SHIFT_RIGHT:
    551  1.1  soren 			hd44780_ir_write(sc, cmd_shift(1, 1));
    552  1.1  soren 			break;
    553  1.1  soren 
    554  1.1  soren 		/* Return home. */
    555  1.1  soren 		case HLCD_HOME:
    556  1.1  soren 			hd44780_ir_write(sc, cmd_rethome());
    557  1.1  soren 			break;
    558  1.1  soren 
    559  1.1  soren 		/* Write a string to the LCD virtual area. */
    560  1.1  soren 		case HLCD_WRITE:
    561  1.1  soren 			error = hd44780_ddram_io(sc, hd44780_io(), HD_DDRAM_WRITE);
    562  1.6  perry 			break;
    563  1.1  soren 
    564  1.1  soren 		/* Read LCD virtual area. */
    565  1.1  soren 		case HLCD_READ:
    566  1.1  soren 			error = hd44780_ddram_io(sc, hd44780_io(), HD_DDRAM_READ);
    567  1.1  soren 			break;
    568  1.1  soren 
    569  1.1  soren 		/* Write to the LCD visible area. */
    570  1.1  soren 		case HLCD_REDRAW:
    571  1.1  soren 			hd44780_ddram_redraw(sc, hd44780_io());
    572  1.1  soren 			break;
    573  1.1  soren 
    574  1.1  soren 		/* Write raw instruction. */
    575  1.1  soren 		case HLCD_WRITE_INST:
    576  1.1  soren 			hd44780_ir_write(sc, hd44780_io()->dat);
    577  1.1  soren 			break;
    578  1.1  soren 
    579  1.1  soren 		/* Write raw data. */
    580  1.1  soren 		case HLCD_WRITE_DATA:
    581  1.1  soren 			hd44780_dr_write(sc, hd44780_io()->dat);
    582  1.1  soren 			break;
    583  1.1  soren 
    584  1.1  soren 		default:
    585  1.1  soren 			error = EINVAL;
    586  1.1  soren 	}
    587  1.1  soren 
    588  1.3   joff 	if (sc->sc_flags & HD_TIMEDOUT)
    589  1.3   joff 		error = EIO;
    590  1.3   joff 
    591  1.1  soren 	return error;
    592  1.1  soren }
    593  1.1  soren 
    594  1.1  soren /*
    595  1.1  soren  * Read/write particular area of the LCD screen.
    596  1.1  soren  */
    597  1.1  soren int
    598  1.1  soren hd44780_ddram_io(sc, io, dir)
    599  1.1  soren 	struct hd44780_chip *sc;
    600  1.1  soren 	struct hd44780_io *io;
    601  1.1  soren 	u_char dir;
    602  1.1  soren {
    603  1.1  soren 	u_int8_t hi;
    604  1.1  soren 	u_int8_t addr;
    605  1.1  soren 
    606  1.1  soren 	int error = 0;
    607  1.1  soren 	u_int8_t i = 0;
    608  1.1  soren 
    609  1.5   joff 	if (io->dat < sc->sc_vcols) {
    610  1.5   joff 		hi = HD_ROW1_ADDR + sc->sc_vcols;
    611  1.1  soren 		addr = HD_ROW1_ADDR + io->dat;
    612  1.1  soren 		for (; (addr < hi) && (i < io->len); addr++, i++) {
    613  1.1  soren 			hd44780_ir_write(sc, cmd_ddramset(addr));
    614  1.1  soren 			if (dir == HD_DDRAM_READ)
    615  1.1  soren 				io->buf[i] = hd44780_dr_read(sc);
    616  1.1  soren 			else
    617  1.1  soren 				hd44780_dr_write(sc, io->buf[i]);
    618  1.1  soren 		}
    619  1.1  soren 	}
    620  1.5   joff 	if (io->dat < 2 * sc->sc_vcols) {
    621  1.5   joff 		hi = HD_ROW2_ADDR + sc->sc_vcols;
    622  1.5   joff 		if (io->dat >= sc->sc_vcols)
    623  1.5   joff 			addr = HD_ROW2_ADDR + io->dat - sc->sc_vcols;
    624  1.1  soren 		else
    625  1.1  soren 			addr = HD_ROW2_ADDR;
    626  1.1  soren 		for (; (addr < hi) && (i < io->len); addr++, i++) {
    627  1.1  soren 			hd44780_ir_write(sc, cmd_ddramset(addr));
    628  1.1  soren 			if (dir == HD_DDRAM_READ)
    629  1.1  soren 				io->buf[i] = hd44780_dr_read(sc);
    630  1.1  soren 			else
    631  1.1  soren 				hd44780_dr_write(sc, io->buf[i]);
    632  1.1  soren 		}
    633  1.1  soren 		if (i < io->len)
    634  1.1  soren 			io->len = i;
    635  1.1  soren 	} else {
    636  1.1  soren 		error = EINVAL;
    637  1.1  soren 	}
    638  1.1  soren 	return error;
    639  1.1  soren }
    640  1.1  soren 
    641  1.1  soren /*
    642  1.1  soren  * Write to the visible area of the display.
    643  1.1  soren  */
    644  1.1  soren void
    645  1.1  soren hd44780_ddram_redraw(sc, io)
    646  1.1  soren 	struct hd44780_chip *sc;
    647  1.1  soren 	struct hd44780_io *io;
    648  1.1  soren {
    649  1.1  soren 	u_int8_t i;
    650  1.1  soren 
    651  1.1  soren 	hd44780_ir_write(sc, cmd_clear());
    652  1.1  soren 	hd44780_ir_write(sc, cmd_rethome());
    653  1.5   joff 	for (i = 0; (i < io->len) && (i < sc->sc_cols); i++) {
    654  1.1  soren 		hd44780_dr_write(sc, io->buf[i]);
    655  1.1  soren 	}
    656  1.1  soren 	hd44780_ir_write(sc, cmd_ddramset(HD_ROW2_ADDR));
    657  1.1  soren 	for (; (i < io->len); i++)
    658  1.1  soren 		hd44780_dr_write(sc, io->buf[i]);
    659  1.1  soren }
    660  1.1  soren 
    661  1.3   joff void
    662  1.3   joff hd44780_busy_wait(sc)
    663  1.3   joff 	struct hd44780_chip *sc;
    664  1.3   joff {
    665  1.3   joff 	int nloops = 100;
    666  1.3   joff 
    667  1.3   joff 	if (sc->sc_flags & HD_TIMEDOUT)
    668  1.3   joff 		return;
    669  1.3   joff 
    670  1.3   joff 	while(nloops-- && (hd44780_ir_read(sc) & BUSY_FLAG) == BUSY_FLAG);
    671  1.3   joff 
    672  1.3   joff 	if (nloops == 0) {
    673  1.3   joff 		sc->sc_flags |= HD_TIMEDOUT;
    674  1.3   joff 		sc->sc_dev_ok = 0;
    675  1.3   joff 	}
    676  1.3   joff }
    677  1.3   joff 
    678  1.1  soren #if defined(HD44780_STD_WIDE)
    679  1.1  soren /*
    680  1.2   joff  * Standard 8-bit version of 'sc_writereg' (8-bit port, 8-bit access)
    681  1.1  soren  */
    682  1.1  soren void
    683  1.2   joff hd44780_writereg(sc, reg, cmd)
    684  1.2   joff 	struct hd44780_chip *sc;
    685  1.2   joff 	u_int32_t reg;
    686  1.1  soren 	u_int8_t cmd;
    687  1.1  soren {
    688  1.2   joff 	bus_space_tag_t iot = sc->sc_iot;
    689  1.2   joff 	bus_space_handle_t ioh;
    690  1.2   joff 
    691  1.3   joff 	if (sc->sc_dev_ok == 0)
    692  1.3   joff 		return;
    693  1.3   joff 
    694  1.2   joff 	if (reg == 0)
    695  1.6  perry 		ioh = sc->sc_ioir;
    696  1.2   joff 	else
    697  1.2   joff 		ioh = sc->sc_iodr;
    698  1.2   joff 
    699  1.1  soren 	bus_space_write_1(iot, ioh, 0x00, cmd);
    700  1.2   joff 	delay(HD_TIMEOUT_NORMAL);
    701  1.1  soren }
    702  1.1  soren 
    703  1.1  soren /*
    704  1.2   joff  * Standard 8-bit version of 'sc_readreg' (8-bit port, 8-bit access)
    705  1.1  soren  */
    706  1.1  soren u_int8_t
    707  1.2   joff hd44780_readreg(sc, reg)
    708  1.2   joff 	struct hd44780_chip *sc;
    709  1.2   joff 	u_int32_t reg;
    710  1.2   joff {
    711  1.2   joff 	bus_space_tag_t iot = sc->sc_iot;
    712  1.1  soren 	bus_space_handle_t ioh;
    713  1.2   joff 
    714  1.3   joff 	if (sc->sc_dev_ok == 0)
    715  1.3   joff 		return;
    716  1.3   joff 
    717  1.2   joff 	if (reg == 0)
    718  1.6  perry 		ioh = sc->sc_ioir;
    719  1.2   joff 	else
    720  1.2   joff 		ioh = sc->sc_iodr;
    721  1.2   joff 
    722  1.2   joff 	delay(HD_TIMEOUT_NORMAL);
    723  1.1  soren 	return bus_space_read_1(iot, ioh, 0x00);
    724  1.1  soren }
    725  1.1  soren #elif defined(HD44780_STD_SHORT)
    726  1.1  soren /*
    727  1.2   joff  * Standard 4-bit version of 'sc_writereg' (4-bit port, 8-bit access)
    728  1.1  soren  */
    729  1.1  soren void
    730  1.2   joff hd44780_writereg(sc, reg, cmd)
    731  1.2   joff 	struct hd44780_chip *sc;
    732  1.2   joff 	u_int32_t reg;
    733  1.1  soren 	u_int8_t cmd;
    734  1.1  soren {
    735  1.2   joff 	bus_space_tag_t iot = sc->sc_iot;
    736  1.2   joff 	bus_space_handle_t ioh;
    737  1.2   joff 
    738  1.3   joff 	if (sc->sc_dev_ok == 0)
    739  1.3   joff 		return;
    740  1.3   joff 
    741  1.2   joff 	if (reg == 0)
    742  1.6  perry 		ioh = sc->sc_ioir;
    743  1.2   joff 	else
    744  1.2   joff 		ioh = sc->sc_iodr;
    745  1.1  soren 
    746  1.1  soren 	bus_space_write_1(iot, ioh, 0x00, hi_bits(cmd));
    747  1.6  perry 	if (sc->sc_flags & HD_UP)
    748  1.2   joff 		bus_space_write_1(iot, ioh, 0x00, lo_bits(cmd));
    749  1.2   joff 	delay(HD_TIMEOUT_NORMAL);
    750  1.1  soren }
    751  1.1  soren 
    752  1.1  soren /*
    753  1.2   joff  * Standard 4-bit version of 'sc_readreg' (4-bit port, 8-bit access)
    754  1.1  soren  */
    755  1.1  soren u_int8_t
    756  1.2   joff hd44780_readreg(sc, reg)
    757  1.2   joff 	struct hd44780_chip *sc;
    758  1.2   joff 	u_int32_t reg;
    759  1.2   joff {
    760  1.2   joff 	bus_space_tag_t iot = sc->sc_iot;
    761  1.1  soren 	bus_space_handle_t ioh;
    762  1.2   joff 	u_int8_t rd, dat;
    763  1.2   joff 
    764  1.3   joff 	if (sc->sc_dev_ok == 0)
    765  1.3   joff 		return;
    766  1.3   joff 
    767  1.2   joff 	if (reg == 0)
    768  1.6  perry 		ioh = sc->sc_ioir;
    769  1.2   joff 	else
    770  1.2   joff 		ioh = sc->sc_iodr;
    771  1.1  soren 
    772  1.1  soren 	rd = bus_space_read_1(iot, ioh, 0x00);
    773  1.1  soren 	dat = (rd & 0x0f) << 4;
    774  1.1  soren 	rd = bus_space_read_1(iot, ioh, 0x00);
    775  1.1  soren 	return (dat | (rd & 0x0f));
    776  1.1  soren }
    777  1.1  soren #endif
    778