hd44780_subr.c revision 1.1.2.3
1 1.1.2.3 skrll /* $NetBSD: hd44780_subr.c,v 1.1.2.3 2005/02/09 15:16:28 skrll 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.1.2.3 skrll __KERNEL_RCSID(0, "$NetBSD: hd44780_subr.c,v 1.1.2.3 2005/02/09 15:16:28 skrll 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.1.2.2 skrll #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.1.2.2 skrll #include <uvm/uvm_extern.h> 50 1.1.2.2 skrll 51 1.1.2.2 skrll #include <dev/wscons/wsdisplayvar.h> 52 1.1.2.2 skrll #include <dev/wscons/wsconsio.h> 53 1.1.2.2 skrll #include <dev/wscons/wscons_callbacks.h> 54 1.1.2.2 skrll 55 1.1 soren #include <dev/ic/hd44780reg.h> 56 1.1.2.1 skrll #include <dev/ic/hd44780var.h> 57 1.1 soren 58 1.1.2.2 skrll #define COORD_TO_IDX(x, y) ((y) * sc->sc_cols + (x)) 59 1.1.2.2 skrll #define COORD_TO_DADDR(x, y) ((y) * HD_ROW2_ADDR + (x)) 60 1.1.2.2 skrll #define IDX_TO_ROW(idx) (((idx) >= sc->sc_cols) ? 1 : 0) 61 1.1.2.2 skrll #define IDX_TO_COL(idx) (((idx) >= sc->sc_cols) ? \ 62 1.1.2.2 skrll ((idx) - sc->sc_cols) : (idx)) 63 1.1.2.2 skrll #define IDX_TO_DDADDR(idx) ((IDX_TO_ROW((idx)) == 1) ? \ 64 1.1.2.2 skrll (HD_ROW2_ADDR + IDX_TO_COL((idx))) : \ 65 1.1.2.2 skrll (IDX_TO_COL((idx)))) 66 1.1.2.2 skrll #define DADDR_TO_ROW(daddr) (((daddr) >= HD_ROW2_ADDR) ? 1 : 0) 67 1.1.2.2 skrll #define DADDR_TO_COL(daddr) ((DADDR_TO_ROW((daddr)) == 1) ? \ 68 1.1.2.2 skrll ((daddr) - HD_ROW2_ADDR) : (daddr)) 69 1.1.2.2 skrll 70 1.1.2.2 skrll static void hlcd_cursor(void *, int, int, int); 71 1.1.2.2 skrll static int hlcd_mapchar(void *, int, unsigned int *); 72 1.1.2.2 skrll static void hlcd_putchar(void *, int, int, u_int, long); 73 1.1.2.2 skrll static void hlcd_copycols(void *, int, int, int,int); 74 1.1.2.2 skrll static void hlcd_erasecols(void *, int, int, int, long); 75 1.1.2.2 skrll static void hlcd_copyrows(void *, int, int, int); 76 1.1.2.2 skrll static void hlcd_eraserows(void *, int, int, long); 77 1.1.2.2 skrll static int hlcd_allocattr(void *, int, int, int, long *); 78 1.1.2.2 skrll static void hlcd_updatechar(struct hd44780_chip *, int, int); 79 1.1.2.2 skrll static void hlcd_redraw(void *); 80 1.1.2.2 skrll 81 1.1.2.2 skrll const struct wsdisplay_emulops hlcd_emulops = { 82 1.1.2.2 skrll hlcd_cursor, 83 1.1.2.2 skrll hlcd_mapchar, 84 1.1.2.2 skrll hlcd_putchar, 85 1.1.2.2 skrll hlcd_copycols, 86 1.1.2.2 skrll hlcd_erasecols, 87 1.1.2.2 skrll hlcd_copyrows, 88 1.1.2.2 skrll hlcd_eraserows, 89 1.1.2.2 skrll hlcd_allocattr 90 1.1.2.2 skrll }; 91 1.1.2.2 skrll 92 1.1.2.3 skrll static int hlcd_ioctl(void *, u_long, caddr_t, int, struct lwp *); 93 1.1.2.2 skrll static paddr_t hlcd_mmap(void *, off_t, int); 94 1.1.2.2 skrll static int hlcd_alloc_screen(void *, const struct wsscreen_descr *, 95 1.1.2.2 skrll void **, int *, int *, long *); 96 1.1.2.2 skrll static void hlcd_free_screen(void *, void *); 97 1.1.2.2 skrll static int hlcd_show_screen(void *, void *, int, 98 1.1.2.2 skrll void (*) (void *, int, int), void *); 99 1.1.2.2 skrll 100 1.1.2.2 skrll const struct wsdisplay_accessops hlcd_accessops = { 101 1.1.2.2 skrll hlcd_ioctl, 102 1.1.2.2 skrll hlcd_mmap, 103 1.1.2.2 skrll hlcd_alloc_screen, 104 1.1.2.2 skrll hlcd_free_screen, 105 1.1.2.2 skrll hlcd_show_screen, 106 1.1.2.2 skrll 0 /* load_font */ 107 1.1.2.2 skrll }; 108 1.1.2.2 skrll 109 1.1.2.2 skrll static void 110 1.1.2.2 skrll hlcd_cursor(id, on, row, col) 111 1.1.2.2 skrll void *id; 112 1.1.2.2 skrll int on, row, col; 113 1.1.2.2 skrll { 114 1.1.2.2 skrll struct hlcd_screen *hdscr = id; 115 1.1.2.2 skrll 116 1.1.2.2 skrll hdscr->hlcd_curon = on; 117 1.1.2.2 skrll hdscr->hlcd_curx = col; 118 1.1.2.2 skrll hdscr->hlcd_cury = row; 119 1.1.2.2 skrll } 120 1.1.2.2 skrll 121 1.1.2.2 skrll static int 122 1.1.2.2 skrll hlcd_mapchar(id, uni, index) 123 1.1.2.2 skrll void *id; 124 1.1.2.2 skrll int uni; 125 1.1.2.2 skrll unsigned int *index; 126 1.1.2.2 skrll { 127 1.1.2.2 skrll if (uni < 256) { 128 1.1.2.2 skrll *index = uni; 129 1.1.2.2 skrll return (5); 130 1.1.2.2 skrll } 131 1.1.2.2 skrll *index = ' '; 132 1.1.2.2 skrll return (0); 133 1.1.2.2 skrll } 134 1.1.2.2 skrll 135 1.1.2.2 skrll static void 136 1.1.2.2 skrll hlcd_putchar(id, row, col, c, attr) 137 1.1.2.2 skrll void *id; 138 1.1.2.2 skrll int row, col; 139 1.1.2.2 skrll u_int c; 140 1.1.2.2 skrll long attr; 141 1.1.2.2 skrll { 142 1.1.2.2 skrll struct hlcd_screen *hdscr = id; 143 1.1.2.2 skrll 144 1.1.2.2 skrll c &= 0xff; 145 1.1.2.2 skrll if (row > 0 && (hdscr->hlcd_sc->sc_flags & HD_MULTILINE)) 146 1.1.2.2 skrll hdscr->image[hdscr->hlcd_sc->sc_cols * row + col] = c; 147 1.1.2.2 skrll else 148 1.1.2.2 skrll hdscr->image[col] = c; 149 1.1.2.2 skrll } 150 1.1.2.2 skrll 151 1.1.2.2 skrll /* 152 1.1.2.2 skrll * copies columns inside a row. 153 1.1.2.2 skrll */ 154 1.1.2.2 skrll static void 155 1.1.2.2 skrll hlcd_copycols(id, row, srccol, dstcol, ncols) 156 1.1.2.2 skrll void *id; 157 1.1.2.2 skrll int row, srccol, dstcol, ncols; 158 1.1.2.2 skrll { 159 1.1.2.2 skrll struct hlcd_screen *hdscr = id; 160 1.1.2.2 skrll 161 1.1.2.2 skrll if ((dstcol + ncols - 1) > hdscr->hlcd_sc->sc_cols) 162 1.1.2.2 skrll ncols = hdscr->hlcd_sc->sc_cols - srccol; 163 1.1.2.2 skrll 164 1.1.2.2 skrll if (row > 0 && (hdscr->hlcd_sc->sc_flags & HD_MULTILINE)) 165 1.1.2.2 skrll bcopy(&hdscr->image[hdscr->hlcd_sc->sc_cols * row + srccol], 166 1.1.2.2 skrll &hdscr->image[hdscr->hlcd_sc->sc_cols * row + dstcol], ncols); 167 1.1.2.2 skrll else 168 1.1.2.2 skrll bcopy(&hdscr->image[srccol], &hdscr->image[dstcol], ncols); 169 1.1.2.2 skrll } 170 1.1.2.2 skrll 171 1.1.2.2 skrll 172 1.1.2.2 skrll /* 173 1.1.2.2 skrll * Erases a bunch of chars inside one row. 174 1.1.2.2 skrll */ 175 1.1.2.2 skrll static void 176 1.1.2.2 skrll hlcd_erasecols(id, row, startcol, ncols, fillattr) 177 1.1.2.2 skrll void *id; 178 1.1.2.2 skrll int row, startcol, ncols; 179 1.1.2.2 skrll long fillattr; 180 1.1.2.2 skrll { 181 1.1.2.2 skrll struct hlcd_screen *hdscr = id; 182 1.1.2.2 skrll 183 1.1.2.2 skrll if ((startcol + ncols) > hdscr->hlcd_sc->sc_cols) 184 1.1.2.2 skrll ncols = hdscr->hlcd_sc->sc_cols - startcol; 185 1.1.2.2 skrll 186 1.1.2.2 skrll if (row > 0 && (hdscr->hlcd_sc->sc_flags & HD_MULTILINE)) 187 1.1.2.2 skrll memset(&hdscr->image[hdscr->hlcd_sc->sc_cols * row + startcol], 188 1.1.2.2 skrll ' ', ncols); 189 1.1.2.2 skrll else 190 1.1.2.2 skrll memset(&hdscr->image[startcol], ' ', ncols); 191 1.1.2.2 skrll } 192 1.1.2.2 skrll 193 1.1.2.2 skrll 194 1.1.2.2 skrll static void 195 1.1.2.2 skrll hlcd_copyrows(id, srcrow, dstrow, nrows) 196 1.1.2.2 skrll void *id; 197 1.1.2.2 skrll int srcrow, dstrow, nrows; 198 1.1.2.2 skrll { 199 1.1.2.2 skrll struct hlcd_screen *hdscr = id; 200 1.1.2.2 skrll int ncols = hdscr->hlcd_sc->sc_cols; 201 1.1.2.2 skrll 202 1.1.2.2 skrll if (!(hdscr->hlcd_sc->sc_flags & HD_MULTILINE)) 203 1.1.2.2 skrll return; 204 1.1.2.2 skrll bcopy(&hdscr->image[srcrow * ncols], &hdscr->image[dstrow * ncols], 205 1.1.2.2 skrll nrows * ncols); 206 1.1.2.2 skrll } 207 1.1.2.2 skrll 208 1.1.2.2 skrll static void 209 1.1.2.2 skrll hlcd_eraserows(id, startrow, nrows, fillattr) 210 1.1.2.2 skrll void *id; 211 1.1.2.2 skrll int startrow, nrows; 212 1.1.2.2 skrll long fillattr; 213 1.1.2.2 skrll { 214 1.1.2.2 skrll struct hlcd_screen *hdscr = id; 215 1.1.2.2 skrll int ncols = hdscr->hlcd_sc->sc_cols; 216 1.1.2.2 skrll 217 1.1.2.2 skrll memset(&hdscr->image[startrow * ncols], ' ', ncols * nrows); 218 1.1.2.2 skrll } 219 1.1.2.2 skrll 220 1.1.2.2 skrll 221 1.1.2.2 skrll static int 222 1.1.2.2 skrll hlcd_allocattr(id, fg, bg, flags, attrp) 223 1.1.2.2 skrll void *id; 224 1.1.2.2 skrll int fg, bg, flags; 225 1.1.2.2 skrll long *attrp; 226 1.1.2.2 skrll { 227 1.1.2.2 skrll *attrp = flags; 228 1.1.2.2 skrll return 0; 229 1.1.2.2 skrll } 230 1.1.2.2 skrll 231 1.1.2.2 skrll static int 232 1.1.2.3 skrll hlcd_ioctl(v, cmd, data, flag, l) 233 1.1.2.2 skrll void *v; 234 1.1.2.2 skrll u_long cmd; 235 1.1.2.2 skrll caddr_t data; 236 1.1.2.2 skrll int flag; 237 1.1.2.3 skrll struct lwp *l; 238 1.1.2.2 skrll { 239 1.1.2.2 skrll 240 1.1.2.2 skrll switch (cmd) { 241 1.1.2.2 skrll case WSDISPLAYIO_GTYPE: 242 1.1.2.2 skrll *(u_int *)data = WSDISPLAY_TYPE_HDLCD; 243 1.1.2.2 skrll break; 244 1.1.2.2 skrll 245 1.1.2.2 skrll case WSDISPLAYIO_SVIDEO: 246 1.1.2.2 skrll break; 247 1.1.2.2 skrll 248 1.1.2.2 skrll case WSDISPLAYIO_GVIDEO: 249 1.1.2.2 skrll *(u_int *)data = WSDISPLAYIO_VIDEO_ON; 250 1.1.2.2 skrll break; 251 1.1.2.2 skrll 252 1.1.2.2 skrll default: 253 1.1.2.2 skrll return EPASSTHROUGH; 254 1.1.2.2 skrll } 255 1.1.2.2 skrll return 0; 256 1.1.2.2 skrll } 257 1.1.2.2 skrll 258 1.1.2.2 skrll static paddr_t 259 1.1.2.2 skrll hlcd_mmap(v, offset, prot) 260 1.1.2.2 skrll void *v; 261 1.1.2.2 skrll off_t offset; 262 1.1.2.2 skrll int prot; 263 1.1.2.2 skrll { 264 1.1.2.2 skrll return -1; 265 1.1.2.2 skrll } 266 1.1.2.2 skrll 267 1.1.2.2 skrll static int 268 1.1.2.2 skrll hlcd_alloc_screen(v, type, cookiep, curxp, curyp, defattrp) 269 1.1.2.2 skrll void *v; 270 1.1.2.2 skrll const struct wsscreen_descr *type; 271 1.1.2.2 skrll void **cookiep; 272 1.1.2.2 skrll int *curxp, *curyp; 273 1.1.2.2 skrll long *defattrp; 274 1.1.2.2 skrll { 275 1.1.2.2 skrll struct hlcd_screen *hdscr = v, *new; 276 1.1.2.2 skrll 277 1.1.2.2 skrll new = *cookiep = malloc(sizeof(struct hlcd_screen), M_DEVBUF, M_WAITOK); 278 1.1.2.2 skrll bzero(*cookiep, sizeof(struct hlcd_screen)); 279 1.1.2.2 skrll new->hlcd_sc = hdscr->hlcd_sc; 280 1.1.2.2 skrll new->image = malloc(PAGE_SIZE, M_DEVBUF, M_WAITOK); 281 1.1.2.2 skrll memset(new->image, ' ', PAGE_SIZE); 282 1.1.2.2 skrll *curxp = *curyp = *defattrp = 0; 283 1.1.2.2 skrll return 0; 284 1.1.2.2 skrll } 285 1.1.2.2 skrll 286 1.1.2.2 skrll static void 287 1.1.2.2 skrll hlcd_free_screen(v, cookie) 288 1.1.2.2 skrll void *v, *cookie; 289 1.1.2.2 skrll { 290 1.1.2.2 skrll } 291 1.1.2.2 skrll 292 1.1.2.2 skrll static int 293 1.1.2.2 skrll hlcd_show_screen(v, cookie, waitok, cb, cbarg) 294 1.1.2.2 skrll void *v, *cookie, *cbarg; 295 1.1.2.2 skrll int waitok; 296 1.1.2.2 skrll void (*cb)(void *, int, int); 297 1.1.2.2 skrll { 298 1.1.2.2 skrll struct hlcd_screen *hdscr = v; 299 1.1.2.2 skrll 300 1.1.2.2 skrll hdscr->hlcd_sc->sc_curscr = cookie; 301 1.1.2.2 skrll callout_schedule(&hdscr->hlcd_sc->redraw, 1); 302 1.1.2.2 skrll return (0); 303 1.1.2.2 skrll } 304 1.1.2.2 skrll 305 1.1.2.2 skrll static void 306 1.1.2.2 skrll hlcd_updatechar(sc, daddr, c) 307 1.1.2.2 skrll struct hd44780_chip *sc; 308 1.1.2.2 skrll int daddr, c; 309 1.1.2.2 skrll { 310 1.1.2.2 skrll int curdaddr; 311 1.1.2.2 skrll 312 1.1.2.2 skrll curdaddr = COORD_TO_DADDR(sc->sc_screen.hlcd_curx, 313 1.1.2.2 skrll sc->sc_screen.hlcd_cury); 314 1.1.2.2 skrll if (daddr != curdaddr) 315 1.1.2.2 skrll hd44780_ir_write(sc, cmd_ddramset(daddr)); 316 1.1.2.2 skrll 317 1.1.2.2 skrll hd44780_dr_write(sc, c); 318 1.1.2.2 skrll 319 1.1.2.2 skrll daddr++; 320 1.1.2.2 skrll sc->sc_screen.hlcd_curx = DADDR_TO_COL(daddr); 321 1.1.2.2 skrll sc->sc_screen.hlcd_cury = DADDR_TO_ROW(daddr); 322 1.1.2.2 skrll } 323 1.1.2.2 skrll 324 1.1.2.2 skrll static void 325 1.1.2.2 skrll hlcd_redraw(arg) 326 1.1.2.2 skrll void *arg; 327 1.1.2.2 skrll { 328 1.1.2.2 skrll struct hd44780_chip *sc = arg; 329 1.1.2.2 skrll int len, crsridx, startidx, x, y; 330 1.1.2.2 skrll u_char *img, *curimg; 331 1.1.2.2 skrll 332 1.1.2.2 skrll if (sc->sc_curscr == NULL) 333 1.1.2.2 skrll return; 334 1.1.2.2 skrll 335 1.1.2.2 skrll if (sc->sc_flags & HD_MULTILINE) 336 1.1.2.2 skrll len = 2 * sc->sc_cols; 337 1.1.2.2 skrll else 338 1.1.2.2 skrll len = sc->sc_cols; 339 1.1.2.2 skrll 340 1.1.2.2 skrll img = sc->sc_screen.image; 341 1.1.2.2 skrll curimg = sc->sc_curscr->image; 342 1.1.2.2 skrll startidx = crsridx = 343 1.1.2.2 skrll COORD_TO_IDX(sc->sc_screen.hlcd_curx, sc->sc_screen.hlcd_cury); 344 1.1.2.2 skrll do { 345 1.1.2.2 skrll if (img[crsridx] != curimg[crsridx]) { 346 1.1.2.2 skrll hlcd_updatechar(sc, IDX_TO_DDADDR(crsridx), 347 1.1.2.2 skrll curimg[crsridx]); 348 1.1.2.2 skrll img[crsridx] = curimg[crsridx]; 349 1.1.2.2 skrll } 350 1.1.2.2 skrll crsridx++; 351 1.1.2.2 skrll if (crsridx == len) 352 1.1.2.2 skrll crsridx = 0; 353 1.1.2.2 skrll } while (crsridx != startidx); 354 1.1.2.2 skrll 355 1.1.2.2 skrll if (sc->sc_screen.hlcd_curx != sc->sc_curscr->hlcd_curx || 356 1.1.2.2 skrll sc->sc_screen.hlcd_cury != sc->sc_curscr->hlcd_cury) { 357 1.1.2.2 skrll x = sc->sc_screen.hlcd_curx = sc->sc_curscr->hlcd_curx; 358 1.1.2.2 skrll y = sc->sc_screen.hlcd_cury = sc->sc_curscr->hlcd_cury; 359 1.1.2.2 skrll hd44780_ir_write(sc, cmd_ddramset(COORD_TO_DADDR(x, y))); 360 1.1.2.2 skrll } 361 1.1.2.2 skrll 362 1.1.2.2 skrll if (sc->sc_screen.hlcd_curon != sc->sc_curscr->hlcd_curon) { 363 1.1.2.2 skrll sc->sc_screen.hlcd_curon = sc->sc_curscr->hlcd_curon; 364 1.1.2.2 skrll if (sc->sc_screen.hlcd_curon) 365 1.1.2.2 skrll hd44780_ir_write(sc, cmd_dispctl(1, 1, 1)); 366 1.1.2.2 skrll else 367 1.1.2.2 skrll hd44780_ir_write(sc, cmd_dispctl(1, 0, 0)); 368 1.1.2.2 skrll } 369 1.1.2.2 skrll 370 1.1.2.2 skrll callout_schedule(&sc->redraw, 1); 371 1.1.2.2 skrll } 372 1.1.2.2 skrll 373 1.1.2.2 skrll 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.1.2.1 skrll int err = 0; 383 1.1 soren /* Putc/getc are supposed to be set by platform-dependent code. */ 384 1.1.2.1 skrll 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.1.2.2 skrll if ((sc->sc_flags & HD_MULTILINE) && (2 * sc->sc_cols > HD_MAX_CHARS)) 389 1.1 soren sc->sc_dev_ok = 0; 390 1.1.2.2 skrll 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.1.2.1 skrll if ((sc->sc_flags & HD_UP) == 0) 395 1.1.2.1 skrll err = hd44780_init(sc); 396 1.1.2.1 skrll if (err != 0) 397 1.1.2.1 skrll printf("%s: LCD not responding or unconnected\n", sc->sc_dev->dv_xname); 398 1.1 soren 399 1.1 soren } 400 1.1.2.2 skrll 401 1.1.2.2 skrll sc->sc_screen.hlcd_sc = sc; 402 1.1.2.2 skrll 403 1.1.2.2 skrll sc->sc_screen.image = malloc(PAGE_SIZE, M_DEVBUF, M_WAITOK); 404 1.1.2.2 skrll memset(sc->sc_screen.image, ' ', PAGE_SIZE); 405 1.1.2.2 skrll sc->sc_curscr = NULL; 406 1.1.2.2 skrll callout_init(&sc->redraw); 407 1.1.2.2 skrll 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.1.2.1 skrll int 414 1.1 soren hd44780_init(sc) 415 1.1 soren struct hd44780_chip *sc; 416 1.1 soren { 417 1.1.2.1 skrll u_int8_t cmd, dat; 418 1.1 soren 419 1.1.2.1 skrll sc->sc_flags &= ~(HD_TIMEDOUT|HD_UP); 420 1.1.2.1 skrll sc->sc_dev_ok = 1; 421 1.1 soren cmd = cmd_init(sc->sc_flags & HD_8BIT); 422 1.1.2.1 skrll hd44780_ir_write(sc, cmd); 423 1.1.2.1 skrll delay(HD_TIMEOUT_LONG); 424 1.1.2.1 skrll hd44780_ir_write(sc, cmd); 425 1.1.2.1 skrll 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.1.2.1 skrll hd44780_ir_write(sc, cmd); 434 1.1.2.1 skrll 435 1.1.2.1 skrll sc->sc_flags |= HD_UP; 436 1.1 soren 437 1.1.2.1 skrll hd44780_ir_write(sc, cmd); 438 1.1.2.1 skrll hd44780_ir_write(sc, cmd_dispctl(0, 0, 0)); 439 1.1.2.1 skrll hd44780_ir_write(sc, cmd_clear()); 440 1.1.2.1 skrll hd44780_ir_write(sc, cmd_modset(1, 0)); 441 1.1.2.1 skrll 442 1.1.2.1 skrll if (sc->sc_flags & HD_TIMEDOUT) { 443 1.1.2.1 skrll sc->sc_flags &= ~HD_UP; 444 1.1.2.1 skrll return EIO; 445 1.1.2.1 skrll } 446 1.1.2.1 skrll 447 1.1.2.1 skrll /* Turn display on and clear it. */ 448 1.1.2.1 skrll hd44780_ir_write(sc, cmd_clear()); 449 1.1.2.1 skrll hd44780_ir_write(sc, cmd_dispctl(1, 0, 0)); 450 1.1.2.1 skrll 451 1.1.2.1 skrll /* Attempt a simple probe for presence */ 452 1.1.2.1 skrll hd44780_ir_write(sc, cmd_ddramset(0x5)); 453 1.1.2.1 skrll hd44780_ir_write(sc, cmd_shift(0, 1)); 454 1.1.2.1 skrll hd44780_busy_wait(sc); 455 1.1.2.1 skrll if ((dat = hd44780_ir_read(sc) & 0x7f) != 0x6) { 456 1.1.2.1 skrll sc->sc_dev_ok = 0; 457 1.1.2.1 skrll sc->sc_flags &= ~HD_UP; 458 1.1.2.1 skrll return EIO; 459 1.1.2.1 skrll } 460 1.1.2.1 skrll hd44780_ir_write(sc, cmd_ddramset(0)); 461 1.1.2.1 skrll 462 1.1.2.1 skrll 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.1 soren 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.1.2.2 skrll hd44780_info()->phys_rows = sc->sc_cols; 510 1.1.2.2 skrll 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.1.2.1 skrll 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.1 soren 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.1.2.1 skrll if (sc->sc_flags & HD_TIMEDOUT) 589 1.1.2.1 skrll error = EIO; 590 1.1.2.1 skrll 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.1.2.2 skrll if (io->dat < sc->sc_vcols) { 610 1.1.2.2 skrll 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.1.2.2 skrll if (io->dat < 2 * sc->sc_vcols) { 621 1.1.2.2 skrll hi = HD_ROW2_ADDR + sc->sc_vcols; 622 1.1.2.2 skrll if (io->dat >= sc->sc_vcols) 623 1.1.2.2 skrll 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.1.2.2 skrll 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.1.2.1 skrll void 662 1.1.2.1 skrll hd44780_busy_wait(sc) 663 1.1.2.1 skrll struct hd44780_chip *sc; 664 1.1.2.1 skrll { 665 1.1.2.1 skrll int nloops = 100; 666 1.1.2.1 skrll 667 1.1.2.1 skrll if (sc->sc_flags & HD_TIMEDOUT) 668 1.1.2.1 skrll return; 669 1.1.2.1 skrll 670 1.1.2.1 skrll while(nloops-- && (hd44780_ir_read(sc) & BUSY_FLAG) == BUSY_FLAG); 671 1.1.2.1 skrll 672 1.1.2.1 skrll if (nloops == 0) { 673 1.1.2.1 skrll sc->sc_flags |= HD_TIMEDOUT; 674 1.1.2.1 skrll sc->sc_dev_ok = 0; 675 1.1.2.1 skrll } 676 1.1.2.1 skrll } 677 1.1.2.1 skrll 678 1.1 soren #if defined(HD44780_STD_WIDE) 679 1.1 soren /* 680 1.1.2.1 skrll * Standard 8-bit version of 'sc_writereg' (8-bit port, 8-bit access) 681 1.1 soren */ 682 1.1 soren void 683 1.1.2.1 skrll hd44780_writereg(sc, reg, cmd) 684 1.1.2.1 skrll struct hd44780_chip *sc; 685 1.1.2.1 skrll u_int32_t reg; 686 1.1 soren u_int8_t cmd; 687 1.1 soren { 688 1.1.2.1 skrll bus_space_tag_t iot = sc->sc_iot; 689 1.1.2.1 skrll bus_space_handle_t ioh; 690 1.1.2.1 skrll 691 1.1.2.1 skrll if (sc->sc_dev_ok == 0) 692 1.1.2.1 skrll return; 693 1.1.2.1 skrll 694 1.1.2.1 skrll if (reg == 0) 695 1.1.2.1 skrll ioh = sc->sc_ioir; 696 1.1.2.1 skrll else 697 1.1.2.1 skrll ioh = sc->sc_iodr; 698 1.1.2.1 skrll 699 1.1 soren bus_space_write_1(iot, ioh, 0x00, cmd); 700 1.1.2.1 skrll delay(HD_TIMEOUT_NORMAL); 701 1.1 soren } 702 1.1 soren 703 1.1 soren /* 704 1.1.2.1 skrll * 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.1.2.1 skrll hd44780_readreg(sc, reg) 708 1.1.2.1 skrll struct hd44780_chip *sc; 709 1.1.2.1 skrll u_int32_t reg; 710 1.1 soren { 711 1.1.2.1 skrll bus_space_tag_t iot = sc->sc_iot; 712 1.1.2.1 skrll bus_space_handle_t ioh; 713 1.1.2.1 skrll 714 1.1.2.1 skrll if (sc->sc_dev_ok == 0) 715 1.1.2.1 skrll return; 716 1.1.2.1 skrll 717 1.1.2.1 skrll if (reg == 0) 718 1.1.2.1 skrll ioh = sc->sc_ioir; 719 1.1.2.1 skrll else 720 1.1.2.1 skrll ioh = sc->sc_iodr; 721 1.1.2.1 skrll 722 1.1.2.1 skrll 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.1.2.1 skrll * Standard 4-bit version of 'sc_writereg' (4-bit port, 8-bit access) 728 1.1 soren */ 729 1.1 soren void 730 1.1.2.1 skrll hd44780_writereg(sc, reg, cmd) 731 1.1.2.1 skrll struct hd44780_chip *sc; 732 1.1.2.1 skrll u_int32_t reg; 733 1.1 soren u_int8_t cmd; 734 1.1 soren { 735 1.1.2.1 skrll bus_space_tag_t iot = sc->sc_iot; 736 1.1 soren bus_space_handle_t ioh; 737 1.1.2.1 skrll 738 1.1.2.1 skrll if (sc->sc_dev_ok == 0) 739 1.1.2.1 skrll return; 740 1.1.2.1 skrll 741 1.1.2.1 skrll if (reg == 0) 742 1.1.2.1 skrll ioh = sc->sc_ioir; 743 1.1.2.1 skrll else 744 1.1.2.1 skrll ioh = sc->sc_iodr; 745 1.1.2.1 skrll 746 1.1 soren bus_space_write_1(iot, ioh, 0x00, hi_bits(cmd)); 747 1.1.2.1 skrll if (sc->sc_flags & HD_UP) 748 1.1.2.1 skrll bus_space_write_1(iot, ioh, 0x00, lo_bits(cmd)); 749 1.1.2.1 skrll delay(HD_TIMEOUT_NORMAL); 750 1.1 soren } 751 1.1 soren 752 1.1 soren /* 753 1.1.2.1 skrll * 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.1.2.1 skrll hd44780_readreg(sc, reg) 757 1.1.2.1 skrll struct hd44780_chip *sc; 758 1.1.2.1 skrll u_int32_t reg; 759 1.1 soren { 760 1.1.2.1 skrll bus_space_tag_t iot = sc->sc_iot; 761 1.1.2.1 skrll bus_space_handle_t ioh; 762 1.1.2.1 skrll u_int8_t rd, dat; 763 1.1.2.1 skrll 764 1.1.2.1 skrll if (sc->sc_dev_ok == 0) 765 1.1.2.1 skrll return; 766 1.1.2.1 skrll 767 1.1.2.1 skrll if (reg == 0) 768 1.1.2.1 skrll ioh = sc->sc_ioir; 769 1.1.2.1 skrll else 770 1.1.2.1 skrll 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
Indexes created Thu Oct 23 22:10:10 GMT 2025