udl.c revision 1.2.2.2
1 1.2.2.2 yamt /* $NetBSD: udl.c,v 1.2.2.2 2010/03/11 15:04:06 yamt Exp $ */ 2 1.2.2.2 yamt 3 1.2.2.2 yamt /*- 4 1.2.2.2 yamt * Copyright (c) 2009 FUKAUMI Naoki. 5 1.2.2.2 yamt * All rights reserved. 6 1.2.2.2 yamt * 7 1.2.2.2 yamt * Redistribution and use in source and binary forms, with or without 8 1.2.2.2 yamt * modification, are permitted provided that the following conditions 9 1.2.2.2 yamt * are met: 10 1.2.2.2 yamt * 1. Redistributions of source code must retain the above copyright 11 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer. 12 1.2.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 13 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer in the 14 1.2.2.2 yamt * documentation and/or other materials provided with the distribution. 15 1.2.2.2 yamt * 16 1.2.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.2.2.2 yamt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.2.2.2 yamt * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.2.2.2 yamt * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.2.2.2 yamt * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 21 1.2.2.2 yamt * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 22 1.2.2.2 yamt * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 23 1.2.2.2 yamt * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 24 1.2.2.2 yamt * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 25 1.2.2.2 yamt * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26 1.2.2.2 yamt */ 27 1.2.2.2 yamt 28 1.2.2.2 yamt /* 29 1.2.2.2 yamt * Copyright (c) 2009 Marcus Glocker <mglocker (at) openbsd.org> 30 1.2.2.2 yamt * 31 1.2.2.2 yamt * Permission to use, copy, modify, and distribute this software for any 32 1.2.2.2 yamt * purpose with or without fee is hereby granted, provided that the above 33 1.2.2.2 yamt * copyright notice and this permission notice appear in all copies. 34 1.2.2.2 yamt * 35 1.2.2.2 yamt * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 36 1.2.2.2 yamt * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 37 1.2.2.2 yamt * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 38 1.2.2.2 yamt * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 39 1.2.2.2 yamt * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 40 1.2.2.2 yamt * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 41 1.2.2.2 yamt * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 42 1.2.2.2 yamt */ 43 1.2.2.2 yamt 44 1.2.2.2 yamt /* 45 1.2.2.2 yamt * Driver for the ``DisplayLink DL-1x0 / DL-1x5'' graphic chips based 46 1.2.2.2 yamt * on the reversed engineered specifications of Florian Echtler 47 1.2.2.2 yamt * <floe at butterbrot dot org>: 48 1.2.2.2 yamt * 49 1.2.2.2 yamt * http://floe.butterbrot.org/displaylink/doku.php 50 1.2.2.2 yamt * 51 1.2.2.2 yamt * This driver was written by Marcus Glocker for OpenBSD and ported to 52 1.2.2.2 yamt * NetBSD by FUKAUMI Naoki with many modification. 53 1.2.2.2 yamt */ 54 1.2.2.2 yamt 55 1.2.2.2 yamt #include <sys/cdefs.h> 56 1.2.2.2 yamt __KERNEL_RCSID(0, "$NetBSD: udl.c,v 1.2.2.2 2010/03/11 15:04:06 yamt Exp $"); 57 1.2.2.2 yamt 58 1.2.2.2 yamt #include <sys/param.h> 59 1.2.2.2 yamt #include <sys/device.h> 60 1.2.2.2 yamt #include <sys/kernel.h> 61 1.2.2.2 yamt #include <sys/proc.h> 62 1.2.2.2 yamt #include <sys/systm.h> 63 1.2.2.2 yamt #include <sys/kmem.h> 64 1.2.2.2 yamt #include <uvm/uvm.h> 65 1.2.2.2 yamt 66 1.2.2.2 yamt #include <sys/bus.h> 67 1.2.2.2 yamt #include <sys/endian.h> 68 1.2.2.2 yamt 69 1.2.2.2 yamt #include <dev/usb/usb.h> 70 1.2.2.2 yamt #include <dev/usb/usbdi.h> 71 1.2.2.2 yamt #include <dev/usb/usbdivar.h> 72 1.2.2.2 yamt #include <dev/usb/usbdi_util.h> 73 1.2.2.2 yamt #include <dev/usb/usb_mem.h> 74 1.2.2.2 yamt #include <dev/usb/usbdevs.h> 75 1.2.2.2 yamt 76 1.2.2.2 yamt #include <dev/firmload.h> 77 1.2.2.2 yamt 78 1.2.2.2 yamt #include <dev/videomode/videomode.h> 79 1.2.2.2 yamt #include <dev/videomode/edidvar.h> 80 1.2.2.2 yamt 81 1.2.2.2 yamt #include <dev/wscons/wsconsio.h> 82 1.2.2.2 yamt #include <dev/wscons/wsdisplayvar.h> 83 1.2.2.2 yamt #include <dev/rasops/rasops.h> 84 1.2.2.2 yamt 85 1.2.2.2 yamt #include <dev/usb/udl.h> 86 1.2.2.2 yamt #ifdef notyet 87 1.2.2.2 yamt #include <dev/usb/udlio.h> 88 1.2.2.2 yamt #endif 89 1.2.2.2 yamt 90 1.2.2.2 yamt /* 91 1.2.2.2 yamt * Defines. 92 1.2.2.2 yamt */ 93 1.2.2.2 yamt #ifdef UDL_DEBUG 94 1.2.2.2 yamt #define DPRINTF(x) do { if (udl_debug) printf x; } while (0) 95 1.2.2.2 yamt #define DPRINTFN(n, x) do { if (udl_debug >= (n)) printf x; } while (0) 96 1.2.2.2 yamt int udl_debug = 1; 97 1.2.2.2 yamt #else 98 1.2.2.2 yamt #define DPRINTF(x) do {} while (0) 99 1.2.2.2 yamt #define DPRINTFN(n, x) do {} while (0) 100 1.2.2.2 yamt #endif 101 1.2.2.2 yamt 102 1.2.2.2 yamt /* 103 1.2.2.2 yamt * Prototypes. 104 1.2.2.2 yamt */ 105 1.2.2.2 yamt static int udl_match(device_t, cfdata_t, void *); 106 1.2.2.2 yamt static void udl_attach(device_t, device_t, void *); 107 1.2.2.2 yamt static int udl_detach(device_t, int); 108 1.2.2.2 yamt 109 1.2.2.2 yamt static int udl_ioctl(void *, void *, u_long, void *, int, 110 1.2.2.2 yamt struct lwp *); 111 1.2.2.2 yamt static paddr_t udl_mmap(void *, void *, off_t, int); 112 1.2.2.2 yamt static int udl_alloc_screen(void *, const struct wsscreen_descr *, 113 1.2.2.2 yamt void **, int *, int *, long *); 114 1.2.2.2 yamt static void udl_free_screen(void *, void *); 115 1.2.2.2 yamt static int udl_show_screen(void *, void *, int, 116 1.2.2.2 yamt void (*)(void *, int, int), void *); 117 1.2.2.2 yamt 118 1.2.2.2 yamt static void udl_comp_load(struct udl_softc *); 119 1.2.2.2 yamt static void udl_comp_unload(struct udl_softc *); 120 1.2.2.2 yamt static int udl_fbmem_alloc(struct udl_softc *); 121 1.2.2.2 yamt static void udl_fbmem_free(struct udl_softc *); 122 1.2.2.2 yamt static int udl_cmdq_alloc(struct udl_softc *); 123 1.2.2.2 yamt static void udl_cmdq_free(struct udl_softc *); 124 1.2.2.2 yamt static struct udl_cmdq *udl_cmdq_get(struct udl_softc *sc); 125 1.2.2.2 yamt static void udl_cmdq_put(struct udl_softc *sc, 126 1.2.2.2 yamt struct udl_cmdq *cmdq); 127 1.2.2.2 yamt static void udl_cmdq_flush(struct udl_softc *); 128 1.2.2.2 yamt 129 1.2.2.2 yamt static void udl_cursor(void *, int, int, int); 130 1.2.2.2 yamt static void udl_putchar(void *, int, int, u_int, long); 131 1.2.2.2 yamt static void udl_copycols(void *, int, int, int, int); 132 1.2.2.2 yamt static void udl_erasecols(void *, int, int, int, long); 133 1.2.2.2 yamt static void udl_copyrows(void *, int, int, int); 134 1.2.2.2 yamt static void udl_eraserows(void *, int, int, long); 135 1.2.2.2 yamt 136 1.2.2.2 yamt static void udl_restore_char(struct rasops_info *); 137 1.2.2.2 yamt static void udl_draw_char(struct rasops_info *, uint16_t *, u_int, 138 1.2.2.2 yamt int, int); 139 1.2.2.2 yamt static void udl_copy_rect(struct udl_softc *, int, int, int, int, 140 1.2.2.2 yamt int, int); 141 1.2.2.2 yamt static void udl_fill_rect(struct udl_softc *, uint16_t, int, int, 142 1.2.2.2 yamt int, int); 143 1.2.2.2 yamt #ifdef notyet 144 1.2.2.2 yamt static void udl_draw_rect(struct udl_softc *, 145 1.2.2.2 yamt struct udl_ioctl_damage *); 146 1.2.2.2 yamt static void udl_draw_rect_comp(struct udl_softc *, 147 1.2.2.2 yamt struct udl_ioctl_damage *); 148 1.2.2.2 yamt #endif 149 1.2.2.2 yamt 150 1.2.2.2 yamt static inline void udl_copy_line(struct udl_softc *, int, int, int); 151 1.2.2.2 yamt static inline void udl_fill_line(struct udl_softc *, uint16_t, int, int); 152 1.2.2.2 yamt static inline void udl_draw_line(struct udl_softc *, uint16_t *, int, 153 1.2.2.2 yamt int); 154 1.2.2.2 yamt static inline void udl_draw_line_comp(struct udl_softc *, uint16_t *, int, 155 1.2.2.2 yamt int); 156 1.2.2.2 yamt 157 1.2.2.2 yamt static int udl_cmd_send(struct udl_softc *); 158 1.2.2.2 yamt static void udl_cmd_send_async(struct udl_softc *); 159 1.2.2.2 yamt static void udl_cmd_send_async_cb(usbd_xfer_handle, 160 1.2.2.2 yamt usbd_private_handle, usbd_status); 161 1.2.2.2 yamt 162 1.2.2.2 yamt static int udl_ctrl_msg(struct udl_softc *, uint8_t, uint8_t, 163 1.2.2.2 yamt uint16_t, uint16_t, uint8_t *, uint16_t); 164 1.2.2.2 yamt static int udl_init(struct udl_softc *); 165 1.2.2.2 yamt static void udl_read_edid(struct udl_softc *); 166 1.2.2.2 yamt static void udl_set_address(struct udl_softc *, int, int, int, 167 1.2.2.2 yamt int); 168 1.2.2.2 yamt static void udl_blank(struct udl_softc *, int); 169 1.2.2.2 yamt static uint16_t udl_lfsr(uint16_t); 170 1.2.2.2 yamt static int udl_set_resolution(struct udl_softc *, 171 1.2.2.2 yamt const struct videomode *); 172 1.2.2.2 yamt static const struct videomode *udl_videomode_lookup(const char *); 173 1.2.2.2 yamt 174 1.2.2.2 yamt static inline void 175 1.2.2.2 yamt udl_cmd_add_1(struct udl_softc *sc, uint8_t val) 176 1.2.2.2 yamt { 177 1.2.2.2 yamt 178 1.2.2.2 yamt *sc->sc_cmd_buf++ = val; 179 1.2.2.2 yamt } 180 1.2.2.2 yamt 181 1.2.2.2 yamt static inline void 182 1.2.2.2 yamt udl_cmd_add_2(struct udl_softc *sc, uint16_t val) 183 1.2.2.2 yamt { 184 1.2.2.2 yamt 185 1.2.2.2 yamt be16enc(sc->sc_cmd_buf, val); 186 1.2.2.2 yamt sc->sc_cmd_buf += 2; 187 1.2.2.2 yamt } 188 1.2.2.2 yamt 189 1.2.2.2 yamt static inline void 190 1.2.2.2 yamt udl_cmd_add_3(struct udl_softc *sc, uint32_t val) 191 1.2.2.2 yamt { 192 1.2.2.2 yamt 193 1.2.2.2 yamt udl_cmd_add_2(sc, val >> 8); 194 1.2.2.2 yamt udl_cmd_add_1(sc, val); 195 1.2.2.2 yamt } 196 1.2.2.2 yamt 197 1.2.2.2 yamt static inline void 198 1.2.2.2 yamt udl_cmd_add_4(struct udl_softc *sc, uint32_t val) 199 1.2.2.2 yamt { 200 1.2.2.2 yamt 201 1.2.2.2 yamt be32enc(sc->sc_cmd_buf, val); 202 1.2.2.2 yamt sc->sc_cmd_buf += 4; 203 1.2.2.2 yamt } 204 1.2.2.2 yamt 205 1.2.2.2 yamt static inline void 206 1.2.2.2 yamt udl_cmd_add_buf(struct udl_softc *sc, uint16_t *buf, int width) 207 1.2.2.2 yamt { 208 1.2.2.2 yamt #if BYTE_ORDER == BIG_ENDIAN 209 1.2.2.2 yamt memcpy(sc->sc_cmd_buf, buf, width * 2); 210 1.2.2.2 yamt sc->sc_cmd_buf += width * 2; 211 1.2.2.2 yamt #else 212 1.2.2.2 yamt uint16_t *endp; 213 1.2.2.2 yamt 214 1.2.2.2 yamt endp = buf + width; 215 1.2.2.2 yamt 216 1.2.2.2 yamt if (((uintptr_t)sc->sc_cmd_buf & 1) == 0) { 217 1.2.2.2 yamt while (buf < endp) { 218 1.2.2.2 yamt *(uint16_t *)sc->sc_cmd_buf = htobe16(*buf++); 219 1.2.2.2 yamt sc->sc_cmd_buf += 2; 220 1.2.2.2 yamt } 221 1.2.2.2 yamt } else { 222 1.2.2.2 yamt while (buf < endp) { 223 1.2.2.2 yamt be16enc(sc->sc_cmd_buf, *buf++); 224 1.2.2.2 yamt sc->sc_cmd_buf += 2; 225 1.2.2.2 yamt } 226 1.2.2.2 yamt } 227 1.2.2.2 yamt #endif 228 1.2.2.2 yamt } 229 1.2.2.2 yamt 230 1.2.2.2 yamt static inline void 231 1.2.2.2 yamt udl_reg_write_1(struct udl_softc *sc, uint8_t reg, uint8_t val) 232 1.2.2.2 yamt { 233 1.2.2.2 yamt 234 1.2.2.2 yamt udl_cmd_add_4(sc, (UDL_BULK_SOC << 24) | 235 1.2.2.2 yamt (UDL_BULK_CMD_REG_WRITE_1 << 16) | (reg << 8) | val); 236 1.2.2.2 yamt } 237 1.2.2.2 yamt 238 1.2.2.2 yamt static inline void 239 1.2.2.2 yamt udl_reg_write_2(struct udl_softc *sc, uint8_t reg, uint16_t val) 240 1.2.2.2 yamt { 241 1.2.2.2 yamt 242 1.2.2.2 yamt udl_reg_write_1(sc, reg++, val >> 8); 243 1.2.2.2 yamt udl_reg_write_1(sc, reg, val); 244 1.2.2.2 yamt } 245 1.2.2.2 yamt 246 1.2.2.2 yamt static inline void 247 1.2.2.2 yamt udl_reg_write_3(struct udl_softc *sc, uint8_t reg, uint32_t val) 248 1.2.2.2 yamt { 249 1.2.2.2 yamt 250 1.2.2.2 yamt udl_reg_write_1(sc, reg++, val >> 16); 251 1.2.2.2 yamt udl_reg_write_1(sc, reg++, val >> 8); 252 1.2.2.2 yamt udl_reg_write_1(sc, reg, val); 253 1.2.2.2 yamt } 254 1.2.2.2 yamt 255 1.2.2.2 yamt /* XXX */ 256 1.2.2.2 yamt static int 257 1.2.2.2 yamt firmware_load(const char *dname, const char *iname, uint8_t **ucodep, 258 1.2.2.2 yamt size_t *sizep) 259 1.2.2.2 yamt { 260 1.2.2.2 yamt firmware_handle_t fh; 261 1.2.2.2 yamt int error; 262 1.2.2.2 yamt 263 1.2.2.2 yamt if ((error = firmware_open(dname, iname, &fh)) != 0) 264 1.2.2.2 yamt return error; 265 1.2.2.2 yamt *sizep = firmware_get_size(fh); 266 1.2.2.2 yamt if ((*ucodep = firmware_malloc(*sizep)) == NULL) { 267 1.2.2.2 yamt firmware_close(fh); 268 1.2.2.2 yamt return ENOMEM; 269 1.2.2.2 yamt } 270 1.2.2.2 yamt if ((error = firmware_read(fh, 0, *ucodep, *sizep)) != 0) 271 1.2.2.2 yamt firmware_free(*ucodep, *sizep); 272 1.2.2.2 yamt firmware_close(fh); 273 1.2.2.2 yamt 274 1.2.2.2 yamt return error; 275 1.2.2.2 yamt } 276 1.2.2.2 yamt 277 1.2.2.2 yamt /* 278 1.2.2.2 yamt * Driver glue. 279 1.2.2.2 yamt */ 280 1.2.2.2 yamt CFATTACH_DECL_NEW(udl, sizeof(struct udl_softc), 281 1.2.2.2 yamt udl_match, udl_attach, udl_detach, NULL); 282 1.2.2.2 yamt 283 1.2.2.2 yamt /* 284 1.2.2.2 yamt * wsdisplay glue. 285 1.2.2.2 yamt */ 286 1.2.2.2 yamt static struct wsdisplay_accessops udl_accessops = { 287 1.2.2.2 yamt udl_ioctl, 288 1.2.2.2 yamt udl_mmap, 289 1.2.2.2 yamt udl_alloc_screen, 290 1.2.2.2 yamt udl_free_screen, 291 1.2.2.2 yamt udl_show_screen, 292 1.2.2.2 yamt NULL, 293 1.2.2.2 yamt NULL, 294 1.2.2.2 yamt NULL, 295 1.2.2.2 yamt }; 296 1.2.2.2 yamt 297 1.2.2.2 yamt /* 298 1.2.2.2 yamt * Matching devices. 299 1.2.2.2 yamt */ 300 1.2.2.2 yamt static const struct usb_devno udl_devs[] = { 301 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_LD220 }, 302 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_U70 }, 303 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_VCUD60 }, 304 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_DLDVI }, 305 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_USBRGB }, 306 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_LCDUSB7X }, 307 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_VGA10 }, 308 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_WSDVI }, 309 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_EC008 }, 310 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_GXDVIU2 }, 311 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_LCD4300U }, 312 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_LCD8000U }, 313 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_HPDOCK }, 314 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_M01061 }, 315 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_SWDVI }, 316 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_LDEWX015U }, 317 1.2.2.2 yamt { USB_VENDOR_DISPLAYLINK, USB_PRODUCT_DISPLAYLINK_UM7X0 } 318 1.2.2.2 yamt }; 319 1.2.2.2 yamt 320 1.2.2.2 yamt static int 321 1.2.2.2 yamt udl_match(device_t parent, cfdata_t match, void *aux) 322 1.2.2.2 yamt { 323 1.2.2.2 yamt struct usb_attach_arg *uaa = aux; 324 1.2.2.2 yamt 325 1.2.2.2 yamt if (usb_lookup(udl_devs, uaa->vendor, uaa->product) != NULL) 326 1.2.2.2 yamt return UMATCH_VENDOR_PRODUCT; 327 1.2.2.2 yamt 328 1.2.2.2 yamt return UMATCH_NONE; 329 1.2.2.2 yamt } 330 1.2.2.2 yamt 331 1.2.2.2 yamt static void 332 1.2.2.2 yamt udl_attach(device_t parent, device_t self, void *aux) 333 1.2.2.2 yamt { 334 1.2.2.2 yamt struct udl_softc *sc = device_private(self); 335 1.2.2.2 yamt struct usb_attach_arg *uaa = aux; 336 1.2.2.2 yamt struct wsemuldisplaydev_attach_args aa; 337 1.2.2.2 yamt const struct videomode *vmp; 338 1.2.2.2 yamt usbd_status error; 339 1.2.2.2 yamt char *devinfop; 340 1.2.2.2 yamt 341 1.2.2.2 yamt aprint_naive("\n"); 342 1.2.2.2 yamt aprint_normal("\n"); 343 1.2.2.2 yamt 344 1.2.2.2 yamt sc->sc_dev = self; 345 1.2.2.2 yamt sc->sc_udev = uaa->device; 346 1.2.2.2 yamt 347 1.2.2.2 yamt devinfop = usbd_devinfo_alloc(sc->sc_udev, 0); 348 1.2.2.2 yamt aprint_normal_dev(sc->sc_dev, "%s\n", devinfop); 349 1.2.2.2 yamt usbd_devinfo_free(devinfop); 350 1.2.2.2 yamt 351 1.2.2.2 yamt /* 352 1.2.2.2 yamt * Set device configuration descriptor number. 353 1.2.2.2 yamt */ 354 1.2.2.2 yamt error = usbd_set_config_no(sc->sc_udev, 1, 0); 355 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION) 356 1.2.2.2 yamt return; 357 1.2.2.2 yamt 358 1.2.2.2 yamt /* 359 1.2.2.2 yamt * Create device handle to interface descriptor. 360 1.2.2.2 yamt */ 361 1.2.2.2 yamt error = usbd_device2interface_handle(sc->sc_udev, 0, &sc->sc_iface); 362 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION) 363 1.2.2.2 yamt return; 364 1.2.2.2 yamt 365 1.2.2.2 yamt /* 366 1.2.2.2 yamt * Open bulk TX pipe. 367 1.2.2.2 yamt */ 368 1.2.2.2 yamt error = usbd_open_pipe(sc->sc_iface, 1, USBD_EXCLUSIVE_USE, 369 1.2.2.2 yamt &sc->sc_tx_pipeh); 370 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION) 371 1.2.2.2 yamt return; 372 1.2.2.2 yamt 373 1.2.2.2 yamt /* 374 1.2.2.2 yamt * Allocate bulk command queue. 375 1.2.2.2 yamt */ 376 1.2.2.2 yamt #ifdef UDL_EVENT_COUNTERS 377 1.2.2.2 yamt evcnt_attach_dynamic(&sc->sc_ev_cmdq_get, EVCNT_TYPE_MISC, NULL, 378 1.2.2.2 yamt device_xname(sc->sc_dev), "udl_cmdq_get"); 379 1.2.2.2 yamt evcnt_attach_dynamic(&sc->sc_ev_cmdq_put, EVCNT_TYPE_MISC, NULL, 380 1.2.2.2 yamt device_xname(sc->sc_dev), "udl_cmdq_put"); 381 1.2.2.2 yamt evcnt_attach_dynamic(&sc->sc_ev_cmdq_wait, EVCNT_TYPE_MISC, NULL, 382 1.2.2.2 yamt device_xname(sc->sc_dev), "udl_cmdq_wait"); 383 1.2.2.2 yamt evcnt_attach_dynamic(&sc->sc_ev_cmdq_timeout, EVCNT_TYPE_MISC, NULL, 384 1.2.2.2 yamt device_xname(sc->sc_dev), "udl_cmdq_timeout"); 385 1.2.2.2 yamt #endif 386 1.2.2.2 yamt 387 1.2.2.2 yamt if (udl_cmdq_alloc(sc) != 0) 388 1.2.2.2 yamt return; 389 1.2.2.2 yamt 390 1.2.2.2 yamt cv_init(&sc->sc_cv, device_xname(sc->sc_dev)); 391 1.2.2.2 yamt mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_TTY); /* XXX for tty_lock */ 392 1.2.2.2 yamt 393 1.2.2.2 yamt if ((sc->sc_cmd_cur = udl_cmdq_get(sc)) == NULL) 394 1.2.2.2 yamt return; 395 1.2.2.2 yamt UDL_CMD_BUFINIT(sc); 396 1.2.2.2 yamt 397 1.2.2.2 yamt /* 398 1.2.2.2 yamt * Initialize chip. 399 1.2.2.2 yamt */ 400 1.2.2.2 yamt if (udl_init(sc) != 0) 401 1.2.2.2 yamt return; 402 1.2.2.2 yamt 403 1.2.2.2 yamt udl_read_edid(sc); 404 1.2.2.2 yamt 405 1.2.2.2 yamt /* 406 1.2.2.2 yamt * Initialize resolution. 407 1.2.2.2 yamt */ 408 1.2.2.2 yamt #ifndef UDL_VIDEOMODE 409 1.2.2.2 yamt if (sc->sc_ei.edid_nmodes != 0 && 410 1.2.2.2 yamt sc->sc_ei.edid_preferred_mode != NULL) 411 1.2.2.2 yamt vmp = sc->sc_ei.edid_preferred_mode; 412 1.2.2.2 yamt else 413 1.2.2.2 yamt #define UDL_VIDEOMODE "640x480x60" 414 1.2.2.2 yamt #endif 415 1.2.2.2 yamt vmp = udl_videomode_lookup(UDL_VIDEOMODE); 416 1.2.2.2 yamt 417 1.2.2.2 yamt if (vmp == NULL) 418 1.2.2.2 yamt return; 419 1.2.2.2 yamt 420 1.2.2.2 yamt sc->sc_width = vmp->hdisplay; 421 1.2.2.2 yamt sc->sc_height = vmp->vdisplay; 422 1.2.2.2 yamt sc->sc_offscreen = sc->sc_height * 3 / 2; 423 1.2.2.2 yamt sc->sc_depth = 16; 424 1.2.2.2 yamt 425 1.2.2.2 yamt if (udl_set_resolution(sc, vmp) != 0) 426 1.2.2.2 yamt return; 427 1.2.2.2 yamt 428 1.2.2.2 yamt sc->sc_defaultscreen.name = "default"; 429 1.2.2.2 yamt sc->sc_screens[0] = &sc->sc_defaultscreen; 430 1.2.2.2 yamt sc->sc_screenlist.nscreens = 1; 431 1.2.2.2 yamt sc->sc_screenlist.screens = sc->sc_screens; 432 1.2.2.2 yamt 433 1.2.2.2 yamt /* 434 1.2.2.2 yamt * Set initial wsdisplay emulation mode. 435 1.2.2.2 yamt */ 436 1.2.2.2 yamt sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 437 1.2.2.2 yamt 438 1.2.2.2 yamt /* 439 1.2.2.2 yamt * Attach wsdisplay. 440 1.2.2.2 yamt */ 441 1.2.2.2 yamt aa.console = 0; 442 1.2.2.2 yamt aa.scrdata = &sc->sc_screenlist; 443 1.2.2.2 yamt aa.accessops = &udl_accessops; 444 1.2.2.2 yamt aa.accesscookie = sc; 445 1.2.2.2 yamt 446 1.2.2.2 yamt sc->sc_wsdisplay = 447 1.2.2.2 yamt config_found(sc->sc_dev, &aa, wsemuldisplaydevprint); 448 1.2.2.2 yamt 449 1.2.2.2 yamt usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev); 450 1.2.2.2 yamt } 451 1.2.2.2 yamt 452 1.2.2.2 yamt static int 453 1.2.2.2 yamt udl_detach(device_t self, int flags) 454 1.2.2.2 yamt { 455 1.2.2.2 yamt struct udl_softc *sc = device_private(self); 456 1.2.2.2 yamt 457 1.2.2.2 yamt /* 458 1.2.2.2 yamt * Close bulk TX pipe. 459 1.2.2.2 yamt */ 460 1.2.2.2 yamt if (sc->sc_tx_pipeh != NULL) { 461 1.2.2.2 yamt usbd_abort_pipe(sc->sc_tx_pipeh); 462 1.2.2.2 yamt usbd_close_pipe(sc->sc_tx_pipeh); 463 1.2.2.2 yamt } 464 1.2.2.2 yamt 465 1.2.2.2 yamt /* 466 1.2.2.2 yamt * Free command xfer buffers. 467 1.2.2.2 yamt */ 468 1.2.2.2 yamt udl_cmdq_flush(sc); 469 1.2.2.2 yamt udl_cmdq_free(sc); 470 1.2.2.2 yamt 471 1.2.2.2 yamt cv_destroy(&sc->sc_cv); 472 1.2.2.2 yamt mutex_destroy(&sc->sc_mtx); 473 1.2.2.2 yamt 474 1.2.2.2 yamt /* 475 1.2.2.2 yamt * Free Huffman table. 476 1.2.2.2 yamt */ 477 1.2.2.2 yamt udl_comp_unload(sc); 478 1.2.2.2 yamt 479 1.2.2.2 yamt /* 480 1.2.2.2 yamt * Free framebuffer memory. 481 1.2.2.2 yamt */ 482 1.2.2.2 yamt udl_fbmem_free(sc); 483 1.2.2.2 yamt 484 1.2.2.2 yamt /* 485 1.2.2.2 yamt * Detach wsdisplay. 486 1.2.2.2 yamt */ 487 1.2.2.2 yamt if (sc->sc_wsdisplay != NULL) 488 1.2.2.2 yamt config_detach(sc->sc_wsdisplay, DETACH_FORCE); 489 1.2.2.2 yamt 490 1.2.2.2 yamt usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev); 491 1.2.2.2 yamt 492 1.2.2.2 yamt #ifdef UDL_EVENT_COUNTERS 493 1.2.2.2 yamt evcnt_detach(&sc->sc_ev_cmdq_get); 494 1.2.2.2 yamt evcnt_detach(&sc->sc_ev_cmdq_put); 495 1.2.2.2 yamt evcnt_detach(&sc->sc_ev_cmdq_wait); 496 1.2.2.2 yamt evcnt_detach(&sc->sc_ev_cmdq_timeout); 497 1.2.2.2 yamt #endif 498 1.2.2.2 yamt 499 1.2.2.2 yamt return 0; 500 1.2.2.2 yamt } 501 1.2.2.2 yamt 502 1.2.2.2 yamt static int 503 1.2.2.2 yamt udl_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l) 504 1.2.2.2 yamt { 505 1.2.2.2 yamt struct udl_softc *sc = v; 506 1.2.2.2 yamt #ifdef notyet 507 1.2.2.2 yamt struct udl_ioctl_damage *d; 508 1.2.2.2 yamt #endif 509 1.2.2.2 yamt struct wsdisplay_fbinfo *wdf; 510 1.2.2.2 yamt u_int mode; 511 1.2.2.2 yamt 512 1.2.2.2 yamt switch (cmd) { 513 1.2.2.2 yamt case WSDISPLAYIO_GTYPE: 514 1.2.2.2 yamt *(u_int *)data = WSDISPLAY_TYPE_DL; 515 1.2.2.2 yamt return 0; 516 1.2.2.2 yamt 517 1.2.2.2 yamt case WSDISPLAYIO_GINFO: 518 1.2.2.2 yamt wdf = (struct wsdisplay_fbinfo *)data; 519 1.2.2.2 yamt wdf->height = sc->sc_height; 520 1.2.2.2 yamt wdf->width = sc->sc_width; 521 1.2.2.2 yamt wdf->depth = sc->sc_depth; 522 1.2.2.2 yamt wdf->cmsize = 0; 523 1.2.2.2 yamt return 0; 524 1.2.2.2 yamt 525 1.2.2.2 yamt case WSDISPLAYIO_GVIDEO: 526 1.2.2.2 yamt *(u_int *)data = sc->sc_blank; 527 1.2.2.2 yamt return 0; 528 1.2.2.2 yamt 529 1.2.2.2 yamt case WSDISPLAYIO_SVIDEO: 530 1.2.2.2 yamt mode = *(u_int *)data; 531 1.2.2.2 yamt if (mode == sc->sc_blank) 532 1.2.2.2 yamt return 0; 533 1.2.2.2 yamt switch (mode) { 534 1.2.2.2 yamt case WSDISPLAYIO_VIDEO_OFF: 535 1.2.2.2 yamt udl_blank(sc, 1); 536 1.2.2.2 yamt break; 537 1.2.2.2 yamt case WSDISPLAYIO_VIDEO_ON: 538 1.2.2.2 yamt udl_blank(sc, 0); 539 1.2.2.2 yamt break; 540 1.2.2.2 yamt default: 541 1.2.2.2 yamt return EINVAL; 542 1.2.2.2 yamt } 543 1.2.2.2 yamt udl_cmd_send_async(sc); 544 1.2.2.2 yamt udl_cmdq_flush(sc); 545 1.2.2.2 yamt sc->sc_blank = mode; 546 1.2.2.2 yamt return 0; 547 1.2.2.2 yamt 548 1.2.2.2 yamt case WSDISPLAYIO_SMODE: 549 1.2.2.2 yamt mode = *(u_int *)data; 550 1.2.2.2 yamt if (mode == sc->sc_mode) 551 1.2.2.2 yamt return 0; 552 1.2.2.2 yamt switch (mode) { 553 1.2.2.2 yamt case WSDISPLAYIO_MODE_EMUL: 554 1.2.2.2 yamt /* clear screen */ 555 1.2.2.2 yamt udl_fill_rect(sc, 0, 0, 0, sc->sc_width, 556 1.2.2.2 yamt sc->sc_height); 557 1.2.2.2 yamt udl_cmd_send_async(sc); 558 1.2.2.2 yamt udl_cmdq_flush(sc); 559 1.2.2.2 yamt udl_comp_unload(sc); 560 1.2.2.2 yamt break; 561 1.2.2.2 yamt case WSDISPLAYIO_MODE_DUMBFB: 562 1.2.2.2 yamt if (UDL_CMD_BUFSIZE(sc) > 0) 563 1.2.2.2 yamt udl_cmd_send_async(sc); 564 1.2.2.2 yamt udl_cmdq_flush(sc); 565 1.2.2.2 yamt udl_comp_load(sc); 566 1.2.2.2 yamt break; 567 1.2.2.2 yamt default: 568 1.2.2.2 yamt return EINVAL; 569 1.2.2.2 yamt } 570 1.2.2.2 yamt sc->sc_mode = mode; 571 1.2.2.2 yamt return 0; 572 1.2.2.2 yamt 573 1.2.2.2 yamt case WSDISPLAYIO_LINEBYTES: 574 1.2.2.2 yamt *(u_int *)data = sc->sc_width * (sc->sc_depth / 8); 575 1.2.2.2 yamt return 0; 576 1.2.2.2 yamt 577 1.2.2.2 yamt #ifdef notyet 578 1.2.2.2 yamt /* 579 1.2.2.2 yamt * XXX 580 1.2.2.2 yamt * OpenBSD allows device specific ioctl()s and use this 581 1.2.2.2 yamt * UDLIO_DAMAGE for the damage extension ops of X servers. 582 1.2.2.2 yamt * Before blindly pulling such interfaces, probably we should 583 1.2.2.2 yamt * discuss how such devices should be handled which have 584 1.2.2.2 yamt * in-direct framebuffer memories that should be transfered 585 1.2.2.2 yamt * per updated rectangle regions via MI wscons APIs. 586 1.2.2.2 yamt */ 587 1.2.2.2 yamt case UDLIO_DAMAGE: 588 1.2.2.2 yamt d = (struct udl_ioctl_damage *)data; 589 1.2.2.2 yamt d->status = UDLIO_STATUS_OK; 590 1.2.2.2 yamt if (sc->sc_flags & UDL_COMPRDY) 591 1.2.2.2 yamt udl_draw_rect_comp(sc, d); 592 1.2.2.2 yamt else 593 1.2.2.2 yamt udl_draw_rect(sc, d); 594 1.2.2.2 yamt return 0; 595 1.2.2.2 yamt #endif 596 1.2.2.2 yamt } 597 1.2.2.2 yamt 598 1.2.2.2 yamt return EPASSTHROUGH; 599 1.2.2.2 yamt } 600 1.2.2.2 yamt 601 1.2.2.2 yamt static paddr_t 602 1.2.2.2 yamt udl_mmap(void *v, void *vs, off_t off, int prot) 603 1.2.2.2 yamt { 604 1.2.2.2 yamt struct udl_softc *sc = v; 605 1.2.2.2 yamt vaddr_t vaddr; 606 1.2.2.2 yamt paddr_t paddr; 607 1.2.2.2 yamt bool rv; 608 1.2.2.2 yamt 609 1.2.2.2 yamt if (off < 0 || off > roundup2(UDL_FBMEM_SIZE(sc), PAGE_SIZE)) 610 1.2.2.2 yamt return -1; 611 1.2.2.2 yamt 612 1.2.2.2 yamt /* allocate framebuffer memory */ 613 1.2.2.2 yamt if (udl_fbmem_alloc(sc) != 0) 614 1.2.2.2 yamt return -1; 615 1.2.2.2 yamt 616 1.2.2.2 yamt vaddr = (vaddr_t)sc->sc_fbmem + off; 617 1.2.2.2 yamt rv = pmap_extract(pmap_kernel(), vaddr, &paddr); 618 1.2.2.2 yamt KASSERT(rv); 619 1.2.2.2 yamt paddr += vaddr & PGOFSET; 620 1.2.2.2 yamt 621 1.2.2.2 yamt /* XXX we need MI paddr_t -> mmap cookie API */ 622 1.2.2.2 yamt #if defined(__alpha__) 623 1.2.2.2 yamt #define PTOMMAP(paddr) alpha_btop((char *)paddr) 624 1.2.2.2 yamt #elif defined(__arm__) 625 1.2.2.2 yamt #define PTOMMAP(paddr) arm_btop((u_long)paddr) 626 1.2.2.2 yamt #elif defined(__hppa__) 627 1.2.2.2 yamt #define PTOMMAP(paddr) btop((u_long)paddr) 628 1.2.2.2 yamt #elif defined(__i386__) || defined(__x86_64__) 629 1.2.2.2 yamt #define PTOMMAP(paddr) x86_btop(paddr) 630 1.2.2.2 yamt #elif defined(__m68k__) 631 1.2.2.2 yamt #define PTOMMAP(paddr) m68k_btop((char *)paddr) 632 1.2.2.2 yamt #elif defined(__mips__) 633 1.2.2.2 yamt #define PTOMMAP(paddr) mips_btop(paddr) 634 1.2.2.2 yamt #elif defined(__powerpc__) 635 1.2.2.2 yamt #define PTOMMAP(paddr) (paddr) 636 1.2.2.2 yamt #elif defined(__sh__) 637 1.2.2.2 yamt #define PTOMMAP(paddr) sh3_btop(paddr) 638 1.2.2.2 yamt #elif defined(__sparc__) 639 1.2.2.2 yamt #define PTOMMAP(paddr) (paddr) 640 1.2.2.2 yamt #elif defined(__sparc64__) 641 1.2.2.2 yamt #define PTOMMAP(paddr) atop(paddr) 642 1.2.2.2 yamt #elif defined(__vax__) 643 1.2.2.2 yamt #define PTOMMAP(paddr) btop((u_int)paddr) 644 1.2.2.2 yamt #endif 645 1.2.2.2 yamt 646 1.2.2.2 yamt return PTOMMAP(paddr); 647 1.2.2.2 yamt } 648 1.2.2.2 yamt 649 1.2.2.2 yamt static int 650 1.2.2.2 yamt udl_alloc_screen(void *v, const struct wsscreen_descr *type, 651 1.2.2.2 yamt void **cookiep, int *curxp, int *curyp, long *attrp) 652 1.2.2.2 yamt { 653 1.2.2.2 yamt struct udl_softc *sc = v; 654 1.2.2.2 yamt 655 1.2.2.2 yamt if (sc->sc_nscreens > 0) 656 1.2.2.2 yamt return ENOMEM; 657 1.2.2.2 yamt 658 1.2.2.2 yamt /* 659 1.2.2.2 yamt * Initialize rasops. 660 1.2.2.2 yamt */ 661 1.2.2.2 yamt sc->sc_ri.ri_depth = sc->sc_depth; 662 1.2.2.2 yamt sc->sc_ri.ri_bits = NULL; 663 1.2.2.2 yamt sc->sc_ri.ri_width = sc->sc_width; 664 1.2.2.2 yamt sc->sc_ri.ri_height = sc->sc_height; 665 1.2.2.2 yamt sc->sc_ri.ri_stride = sc->sc_width * (sc->sc_depth / 8); 666 1.2.2.2 yamt sc->sc_ri.ri_hw = sc; 667 1.2.2.2 yamt sc->sc_ri.ri_flg = 0; 668 1.2.2.2 yamt 669 1.2.2.2 yamt if (sc->sc_depth == 16) { 670 1.2.2.2 yamt sc->sc_ri.ri_rnum = 5; 671 1.2.2.2 yamt sc->sc_ri.ri_gnum = 6; 672 1.2.2.2 yamt sc->sc_ri.ri_bnum = 5; 673 1.2.2.2 yamt sc->sc_ri.ri_rpos = 11; 674 1.2.2.2 yamt sc->sc_ri.ri_gpos = 5; 675 1.2.2.2 yamt sc->sc_ri.ri_bpos = 0; 676 1.2.2.2 yamt } 677 1.2.2.2 yamt 678 1.2.2.2 yamt rasops_init(&sc->sc_ri, sc->sc_height / 8, sc->sc_width / 8); 679 1.2.2.2 yamt 680 1.2.2.2 yamt sc->sc_ri.ri_ops.cursor = udl_cursor; 681 1.2.2.2 yamt sc->sc_ri.ri_ops.putchar = udl_putchar; 682 1.2.2.2 yamt sc->sc_ri.ri_ops.copycols = udl_copycols; 683 1.2.2.2 yamt sc->sc_ri.ri_ops.erasecols = udl_erasecols; 684 1.2.2.2 yamt sc->sc_ri.ri_ops.copyrows = udl_copyrows; 685 1.2.2.2 yamt sc->sc_ri.ri_ops.eraserows = udl_eraserows; 686 1.2.2.2 yamt 687 1.2.2.2 yamt sc->sc_ri.ri_ops.allocattr(&sc->sc_ri, 0, 0, 0, attrp); 688 1.2.2.2 yamt 689 1.2.2.2 yamt sc->sc_defaultscreen.ncols = sc->sc_ri.ri_cols; 690 1.2.2.2 yamt sc->sc_defaultscreen.nrows = sc->sc_ri.ri_rows; 691 1.2.2.2 yamt sc->sc_defaultscreen.textops = &sc->sc_ri.ri_ops; 692 1.2.2.2 yamt sc->sc_defaultscreen.fontwidth = sc->sc_ri.ri_font->fontwidth; 693 1.2.2.2 yamt sc->sc_defaultscreen.fontheight = sc->sc_ri.ri_font->fontheight; 694 1.2.2.2 yamt sc->sc_defaultscreen.capabilities = sc->sc_ri.ri_caps; 695 1.2.2.2 yamt 696 1.2.2.2 yamt *cookiep = &sc->sc_ri; 697 1.2.2.2 yamt *curxp = 0; 698 1.2.2.2 yamt *curyp = 0; 699 1.2.2.2 yamt 700 1.2.2.2 yamt sc->sc_nscreens++; 701 1.2.2.2 yamt 702 1.2.2.2 yamt return 0; 703 1.2.2.2 yamt } 704 1.2.2.2 yamt 705 1.2.2.2 yamt static void 706 1.2.2.2 yamt udl_free_screen(void *v, void *cookie) 707 1.2.2.2 yamt { 708 1.2.2.2 yamt struct udl_softc *sc = v; 709 1.2.2.2 yamt 710 1.2.2.2 yamt sc->sc_nscreens--; 711 1.2.2.2 yamt } 712 1.2.2.2 yamt 713 1.2.2.2 yamt static int 714 1.2.2.2 yamt udl_show_screen(void *v, void *cookie, int waitok, 715 1.2.2.2 yamt void (*cb)(void *, int, int), void *cbarg) 716 1.2.2.2 yamt { 717 1.2.2.2 yamt 718 1.2.2.2 yamt return 0; 719 1.2.2.2 yamt } 720 1.2.2.2 yamt 721 1.2.2.2 yamt static inline void 722 1.2.2.2 yamt udl_cmd_add_decomptable(struct udl_softc *sc, uint8_t *buf, int len) 723 1.2.2.2 yamt { 724 1.2.2.2 yamt 725 1.2.2.2 yamt udl_cmd_add_2(sc, (UDL_BULK_SOC << 8) | UDL_BULK_CMD_DECOMP); 726 1.2.2.2 yamt udl_cmd_add_4(sc, 0x263871cd); /* magic number */ 727 1.2.2.2 yamt udl_cmd_add_4(sc, 0x00000200); /* 512 byte chunks */ 728 1.2.2.2 yamt memcpy(sc->sc_cmd_buf, buf, len); 729 1.2.2.2 yamt sc->sc_cmd_buf += len; 730 1.2.2.2 yamt } 731 1.2.2.2 yamt 732 1.2.2.2 yamt static void 733 1.2.2.2 yamt udl_comp_load(struct udl_softc *sc) 734 1.2.2.2 yamt { 735 1.2.2.2 yamt struct udl_huffman *h; 736 1.2.2.2 yamt uint8_t *decomp; 737 1.2.2.2 yamt size_t decomp_size; 738 1.2.2.2 yamt int error, i; 739 1.2.2.2 yamt 740 1.2.2.2 yamt if (!(sc->sc_flags & UDL_DECOMPRDY)) { 741 1.2.2.2 yamt error = firmware_load("udl", "udl-decomp", &decomp, 742 1.2.2.2 yamt &decomp_size); 743 1.2.2.2 yamt if (error != 0) { 744 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 745 1.2.2.2 yamt "error %d, could not read decomp table %s!\n", 746 1.2.2.2 yamt error, "udl-decomp"); 747 1.2.2.2 yamt return; 748 1.2.2.2 yamt } 749 1.2.2.2 yamt udl_cmd_add_decomptable(sc, decomp, decomp_size); 750 1.2.2.2 yamt firmware_free(decomp, decomp_size); 751 1.2.2.2 yamt if (udl_cmd_send(sc) != 0) 752 1.2.2.2 yamt return; 753 1.2.2.2 yamt sc->sc_flags |= UDL_DECOMPRDY; 754 1.2.2.2 yamt } 755 1.2.2.2 yamt 756 1.2.2.2 yamt if (!(sc->sc_flags & UDL_COMPRDY)) { 757 1.2.2.2 yamt error = firmware_load("udl", "udl-comp", &sc->sc_huffman, 758 1.2.2.2 yamt &sc->sc_huffman_size); 759 1.2.2.2 yamt if (error != 0) { 760 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 761 1.2.2.2 yamt "error %d, could not read huffman table %s!\n", 762 1.2.2.2 yamt error, "udl-comp"); 763 1.2.2.2 yamt return; 764 1.2.2.2 yamt } 765 1.2.2.2 yamt h = (struct udl_huffman *)sc->sc_huffman; 766 1.2.2.2 yamt for (i = 0; i < UDL_HUFFMAN_RECORDS; i++) 767 1.2.2.2 yamt h[i].bit_pattern = be32toh(h[i].bit_pattern); 768 1.2.2.2 yamt sc->sc_huffman_base = sc->sc_huffman + UDL_HUFFMAN_BASE; 769 1.2.2.2 yamt sc->sc_flags |= UDL_COMPRDY; 770 1.2.2.2 yamt } 771 1.2.2.2 yamt } 772 1.2.2.2 yamt 773 1.2.2.2 yamt static void 774 1.2.2.2 yamt udl_comp_unload(struct udl_softc *sc) 775 1.2.2.2 yamt { 776 1.2.2.2 yamt 777 1.2.2.2 yamt if (sc->sc_flags & UDL_COMPRDY) { 778 1.2.2.2 yamt firmware_free(sc->sc_huffman, sc->sc_huffman_size); 779 1.2.2.2 yamt sc->sc_huffman = NULL; 780 1.2.2.2 yamt sc->sc_huffman_size = 0; 781 1.2.2.2 yamt sc->sc_flags &= ~UDL_COMPRDY; 782 1.2.2.2 yamt } 783 1.2.2.2 yamt } 784 1.2.2.2 yamt 785 1.2.2.2 yamt static int 786 1.2.2.2 yamt udl_fbmem_alloc(struct udl_softc *sc) 787 1.2.2.2 yamt { 788 1.2.2.2 yamt 789 1.2.2.2 yamt if (sc->sc_fbmem == NULL) { 790 1.2.2.2 yamt sc->sc_fbmem = kmem_alloc(UDL_FBMEM_SIZE(sc), KM_SLEEP); 791 1.2.2.2 yamt if (sc->sc_fbmem == NULL) 792 1.2.2.2 yamt return -1; 793 1.2.2.2 yamt } 794 1.2.2.2 yamt 795 1.2.2.2 yamt return 0; 796 1.2.2.2 yamt } 797 1.2.2.2 yamt 798 1.2.2.2 yamt static void 799 1.2.2.2 yamt udl_fbmem_free(struct udl_softc *sc) 800 1.2.2.2 yamt { 801 1.2.2.2 yamt 802 1.2.2.2 yamt if (sc->sc_fbmem != NULL) { 803 1.2.2.2 yamt kmem_free(sc->sc_fbmem, UDL_FBMEM_SIZE(sc)); 804 1.2.2.2 yamt sc->sc_fbmem = NULL; 805 1.2.2.2 yamt } 806 1.2.2.2 yamt } 807 1.2.2.2 yamt 808 1.2.2.2 yamt static int 809 1.2.2.2 yamt udl_cmdq_alloc(struct udl_softc *sc) 810 1.2.2.2 yamt { 811 1.2.2.2 yamt struct udl_cmdq *cmdq; 812 1.2.2.2 yamt int i; 813 1.2.2.2 yamt 814 1.2.2.2 yamt TAILQ_INIT(&sc->sc_freecmd); 815 1.2.2.2 yamt TAILQ_INIT(&sc->sc_xfercmd); 816 1.2.2.2 yamt 817 1.2.2.2 yamt for (i = 0; i < UDL_NCMDQ; i++) { 818 1.2.2.2 yamt cmdq = &sc->sc_cmdq[i]; 819 1.2.2.2 yamt 820 1.2.2.2 yamt cmdq->cq_sc = sc; 821 1.2.2.2 yamt 822 1.2.2.2 yamt cmdq->cq_xfer = usbd_alloc_xfer(sc->sc_udev); 823 1.2.2.2 yamt if (cmdq->cq_xfer == NULL) { 824 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 825 1.2.2.2 yamt "%s: can't allocate xfer handle!\n", __func__); 826 1.2.2.2 yamt goto error; 827 1.2.2.2 yamt } 828 1.2.2.2 yamt 829 1.2.2.2 yamt cmdq->cq_buf = 830 1.2.2.2 yamt usbd_alloc_buffer(cmdq->cq_xfer, UDL_CMD_BUFFER_SIZE); 831 1.2.2.2 yamt if (cmdq->cq_buf == NULL) { 832 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, 833 1.2.2.2 yamt "%s: can't allocate xfer buffer!\n", __func__); 834 1.2.2.2 yamt goto error; 835 1.2.2.2 yamt } 836 1.2.2.2 yamt 837 1.2.2.2 yamt TAILQ_INSERT_TAIL(&sc->sc_freecmd, cmdq, cq_chain); 838 1.2.2.2 yamt } 839 1.2.2.2 yamt 840 1.2.2.2 yamt return 0; 841 1.2.2.2 yamt 842 1.2.2.2 yamt error: 843 1.2.2.2 yamt udl_cmdq_free(sc); 844 1.2.2.2 yamt return -1; 845 1.2.2.2 yamt } 846 1.2.2.2 yamt 847 1.2.2.2 yamt static void 848 1.2.2.2 yamt udl_cmdq_free(struct udl_softc *sc) 849 1.2.2.2 yamt { 850 1.2.2.2 yamt struct udl_cmdq *cmdq; 851 1.2.2.2 yamt int i; 852 1.2.2.2 yamt 853 1.2.2.2 yamt for (i = 0; i < UDL_NCMDQ; i++) { 854 1.2.2.2 yamt cmdq = &sc->sc_cmdq[i]; 855 1.2.2.2 yamt 856 1.2.2.2 yamt if (cmdq->cq_xfer != NULL) { 857 1.2.2.2 yamt usbd_free_xfer(cmdq->cq_xfer); 858 1.2.2.2 yamt cmdq->cq_xfer = NULL; 859 1.2.2.2 yamt cmdq->cq_buf = NULL; 860 1.2.2.2 yamt } 861 1.2.2.2 yamt } 862 1.2.2.2 yamt } 863 1.2.2.2 yamt 864 1.2.2.2 yamt static struct udl_cmdq * 865 1.2.2.2 yamt udl_cmdq_get(struct udl_softc *sc) 866 1.2.2.2 yamt { 867 1.2.2.2 yamt struct udl_cmdq *cmdq; 868 1.2.2.2 yamt 869 1.2.2.2 yamt cmdq = TAILQ_FIRST(&sc->sc_freecmd); 870 1.2.2.2 yamt if (cmdq != NULL) { 871 1.2.2.2 yamt TAILQ_REMOVE(&sc->sc_freecmd, cmdq, cq_chain); 872 1.2.2.2 yamt UDL_EVCNT_INCR(&sc->sc_ev_cmdq_get); 873 1.2.2.2 yamt } 874 1.2.2.2 yamt 875 1.2.2.2 yamt return cmdq; 876 1.2.2.2 yamt } 877 1.2.2.2 yamt 878 1.2.2.2 yamt static void 879 1.2.2.2 yamt udl_cmdq_put(struct udl_softc *sc, struct udl_cmdq *cmdq) 880 1.2.2.2 yamt { 881 1.2.2.2 yamt 882 1.2.2.2 yamt TAILQ_INSERT_TAIL(&sc->sc_freecmd, cmdq, cq_chain); 883 1.2.2.2 yamt UDL_EVCNT_INCR(&sc->sc_ev_cmdq_put); 884 1.2.2.2 yamt } 885 1.2.2.2 yamt 886 1.2.2.2 yamt static void 887 1.2.2.2 yamt udl_cmdq_flush(struct udl_softc *sc) 888 1.2.2.2 yamt { 889 1.2.2.2 yamt 890 1.2.2.2 yamt mutex_enter(&sc->sc_mtx); 891 1.2.2.2 yamt while (TAILQ_FIRST(&sc->sc_xfercmd) != NULL) 892 1.2.2.2 yamt cv_wait(&sc->sc_cv, &sc->sc_mtx); 893 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 894 1.2.2.2 yamt } 895 1.2.2.2 yamt 896 1.2.2.2 yamt static void 897 1.2.2.2 yamt udl_cursor(void *cookie, int on, int row, int col) 898 1.2.2.2 yamt { 899 1.2.2.2 yamt struct rasops_info *ri = cookie; 900 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 901 1.2.2.2 yamt int x, y, width, height; 902 1.2.2.2 yamt 903 1.2.2.2 yamt if (ri->ri_flg & RI_CURSOR) 904 1.2.2.2 yamt udl_restore_char(ri); 905 1.2.2.2 yamt 906 1.2.2.2 yamt ri->ri_crow = row; 907 1.2.2.2 yamt ri->ri_ccol = col; 908 1.2.2.2 yamt 909 1.2.2.2 yamt if (on != 0) { 910 1.2.2.2 yamt ri->ri_flg |= RI_CURSOR; 911 1.2.2.2 yamt 912 1.2.2.2 yamt x = col * ri->ri_font->fontwidth; 913 1.2.2.2 yamt y = row * ri->ri_font->fontheight; 914 1.2.2.2 yamt width = ri->ri_font->fontwidth; 915 1.2.2.2 yamt height = ri->ri_font->fontheight; 916 1.2.2.2 yamt 917 1.2.2.2 yamt /* save the last character block to off-screen */ 918 1.2.2.2 yamt udl_copy_rect(sc, x, y, 0, sc->sc_offscreen, width, height); 919 1.2.2.2 yamt 920 1.2.2.2 yamt /* draw cursor */ 921 1.2.2.2 yamt udl_fill_rect(sc, 0xffff, x, y, width, 1); 922 1.2.2.2 yamt udl_fill_rect(sc, 0xffff, x, y + 1, 1, height - 2); 923 1.2.2.2 yamt udl_fill_rect(sc, 0xffff, x + width - 1, y + 1, 1, height - 2); 924 1.2.2.2 yamt udl_fill_rect(sc, 0xffff, x, y + height - 1, width, 1); 925 1.2.2.2 yamt 926 1.2.2.2 yamt udl_cmd_send_async(sc); 927 1.2.2.2 yamt } else 928 1.2.2.2 yamt ri->ri_flg &= ~RI_CURSOR; 929 1.2.2.2 yamt } 930 1.2.2.2 yamt 931 1.2.2.2 yamt static void 932 1.2.2.2 yamt udl_putchar(void *cookie, int row, int col, u_int uc, long attr) 933 1.2.2.2 yamt { 934 1.2.2.2 yamt struct rasops_info *ri = cookie; 935 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 936 1.2.2.2 yamt uint16_t rgb16[2]; 937 1.2.2.2 yamt int fg, bg, underline, x, y, width, height; 938 1.2.2.2 yamt 939 1.2.2.2 yamt rasops_unpack_attr(attr, &fg, &bg, &underline); 940 1.2.2.2 yamt rgb16[1] = (uint16_t)ri->ri_devcmap[fg]; 941 1.2.2.2 yamt rgb16[0] = (uint16_t)ri->ri_devcmap[bg]; 942 1.2.2.2 yamt 943 1.2.2.2 yamt x = col * ri->ri_font->fontwidth; 944 1.2.2.2 yamt y = row * ri->ri_font->fontheight; 945 1.2.2.2 yamt width = ri->ri_font->fontwidth; 946 1.2.2.2 yamt height = ri->ri_font->fontheight; 947 1.2.2.2 yamt 948 1.2.2.2 yamt if (uc == ' ') { 949 1.2.2.2 yamt /* 950 1.2.2.2 yamt * Writting a block for the space character instead rendering 951 1.2.2.2 yamt * it from font bits is more slim. 952 1.2.2.2 yamt */ 953 1.2.2.2 yamt udl_fill_rect(sc, rgb16[0], x, y, width, height); 954 1.2.2.2 yamt } else { 955 1.2.2.2 yamt /* render a character from font bits */ 956 1.2.2.2 yamt udl_draw_char(ri, rgb16, uc, x, y); 957 1.2.2.2 yamt } 958 1.2.2.2 yamt 959 1.2.2.2 yamt if (underline != 0) 960 1.2.2.2 yamt udl_fill_rect(sc, rgb16[1], x, y + height - 1, width, 1); 961 1.2.2.2 yamt 962 1.2.2.2 yamt #if 0 963 1.2.2.2 yamt udl_cmd_send_async(sc); 964 1.2.2.2 yamt #endif 965 1.2.2.2 yamt } 966 1.2.2.2 yamt 967 1.2.2.2 yamt static void 968 1.2.2.2 yamt udl_copycols(void *cookie, int row, int src, int dst, int num) 969 1.2.2.2 yamt { 970 1.2.2.2 yamt struct rasops_info *ri = cookie; 971 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 972 1.2.2.2 yamt int sx, dx, y, width, height; 973 1.2.2.2 yamt 974 1.2.2.2 yamt sx = src * ri->ri_font->fontwidth; 975 1.2.2.2 yamt dx = dst * ri->ri_font->fontwidth; 976 1.2.2.2 yamt y = row * ri->ri_font->fontheight; 977 1.2.2.2 yamt width = num * ri->ri_font->fontwidth; 978 1.2.2.2 yamt height = ri->ri_font->fontheight; 979 1.2.2.2 yamt 980 1.2.2.2 yamt /* copy row block to off-screen first to fix overlay-copy problem */ 981 1.2.2.2 yamt udl_copy_rect(sc, sx, y, 0, sc->sc_offscreen, width, height); 982 1.2.2.2 yamt 983 1.2.2.2 yamt /* copy row block back from off-screen now */ 984 1.2.2.2 yamt udl_copy_rect(sc, 0, sc->sc_offscreen, dx, y, width, height); 985 1.2.2.2 yamt #if 0 986 1.2.2.2 yamt udl_cmd_send_async(sc); 987 1.2.2.2 yamt #endif 988 1.2.2.2 yamt } 989 1.2.2.2 yamt 990 1.2.2.2 yamt static void 991 1.2.2.2 yamt udl_erasecols(void *cookie, int row, int col, int num, long attr) 992 1.2.2.2 yamt { 993 1.2.2.2 yamt struct rasops_info *ri = cookie; 994 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 995 1.2.2.2 yamt uint16_t rgb16; 996 1.2.2.2 yamt int fg, bg, x, y, width, height; 997 1.2.2.2 yamt 998 1.2.2.2 yamt rasops_unpack_attr(attr, &fg, &bg, NULL); 999 1.2.2.2 yamt rgb16 = (uint16_t)ri->ri_devcmap[bg]; 1000 1.2.2.2 yamt 1001 1.2.2.2 yamt x = col * ri->ri_font->fontwidth; 1002 1.2.2.2 yamt y = row * ri->ri_font->fontheight; 1003 1.2.2.2 yamt width = num * ri->ri_font->fontwidth; 1004 1.2.2.2 yamt height = ri->ri_font->fontheight; 1005 1.2.2.2 yamt 1006 1.2.2.2 yamt udl_fill_rect(sc, rgb16, x, y, width, height); 1007 1.2.2.2 yamt #if 0 1008 1.2.2.2 yamt udl_cmd_send_async(sc); 1009 1.2.2.2 yamt #endif 1010 1.2.2.2 yamt } 1011 1.2.2.2 yamt 1012 1.2.2.2 yamt static void 1013 1.2.2.2 yamt udl_copyrows(void *cookie, int src, int dst, int num) 1014 1.2.2.2 yamt { 1015 1.2.2.2 yamt struct rasops_info *ri = cookie; 1016 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 1017 1.2.2.2 yamt int sy, ey, dy, width, height; 1018 1.2.2.2 yamt 1019 1.2.2.2 yamt width = ri->ri_emuwidth; 1020 1.2.2.2 yamt height = ri->ri_font->fontheight; 1021 1.2.2.2 yamt 1022 1.2.2.2 yamt if (dst < src) { 1023 1.2.2.2 yamt sy = src * height; 1024 1.2.2.2 yamt ey = (src + num) * height; 1025 1.2.2.2 yamt dy = dst * height; 1026 1.2.2.2 yamt 1027 1.2.2.2 yamt while (sy < ey) { 1028 1.2.2.2 yamt udl_copy_rect(sc, 0, sy, 0, dy, width, height); 1029 1.2.2.2 yamt sy += height; 1030 1.2.2.2 yamt dy += height; 1031 1.2.2.2 yamt } 1032 1.2.2.2 yamt } else { 1033 1.2.2.2 yamt sy = (src + num) * height; 1034 1.2.2.2 yamt ey = src * height; 1035 1.2.2.2 yamt dy = (dst + num) * height; 1036 1.2.2.2 yamt 1037 1.2.2.2 yamt while (sy > ey) { 1038 1.2.2.2 yamt sy -= height; 1039 1.2.2.2 yamt dy -= height; 1040 1.2.2.2 yamt udl_copy_rect(sc, 0, sy, 0, dy, width, height); 1041 1.2.2.2 yamt } 1042 1.2.2.2 yamt } 1043 1.2.2.2 yamt #if 0 1044 1.2.2.2 yamt udl_cmd_send_async(sc); 1045 1.2.2.2 yamt #endif 1046 1.2.2.2 yamt } 1047 1.2.2.2 yamt 1048 1.2.2.2 yamt static void 1049 1.2.2.2 yamt udl_eraserows(void *cookie, int row, int num, long attr) 1050 1.2.2.2 yamt { 1051 1.2.2.2 yamt struct rasops_info *ri = cookie; 1052 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 1053 1.2.2.2 yamt uint16_t rgb16; 1054 1.2.2.2 yamt int fg, bg, y, width, height; 1055 1.2.2.2 yamt 1056 1.2.2.2 yamt rasops_unpack_attr(attr, &fg, &bg, NULL); 1057 1.2.2.2 yamt rgb16 = (uint16_t)ri->ri_devcmap[bg]; 1058 1.2.2.2 yamt 1059 1.2.2.2 yamt y = row * ri->ri_font->fontheight; 1060 1.2.2.2 yamt width = ri->ri_emuwidth; 1061 1.2.2.2 yamt height = num * ri->ri_font->fontheight; 1062 1.2.2.2 yamt 1063 1.2.2.2 yamt udl_fill_rect(sc, rgb16, 0, y, width, height); 1064 1.2.2.2 yamt #if 0 1065 1.2.2.2 yamt udl_cmd_send_async(sc); 1066 1.2.2.2 yamt #endif 1067 1.2.2.2 yamt } 1068 1.2.2.2 yamt 1069 1.2.2.2 yamt static void 1070 1.2.2.2 yamt udl_restore_char(struct rasops_info *ri) 1071 1.2.2.2 yamt { 1072 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 1073 1.2.2.2 yamt int x, y, width, height; 1074 1.2.2.2 yamt 1075 1.2.2.2 yamt x = ri->ri_ccol * ri->ri_font->fontwidth; 1076 1.2.2.2 yamt y = ri->ri_crow * ri->ri_font->fontheight; 1077 1.2.2.2 yamt width = ri->ri_font->fontwidth; 1078 1.2.2.2 yamt height = ri->ri_font->fontheight; 1079 1.2.2.2 yamt 1080 1.2.2.2 yamt /* restore the last saved character from off-screen */ 1081 1.2.2.2 yamt udl_copy_rect(sc, 0, sc->sc_offscreen, x, y, width, height); 1082 1.2.2.2 yamt } 1083 1.2.2.2 yamt 1084 1.2.2.2 yamt static void 1085 1.2.2.2 yamt udl_draw_char(struct rasops_info *ri, uint16_t *rgb16, u_int uc, int x, int y) 1086 1.2.2.2 yamt { 1087 1.2.2.2 yamt struct udl_softc *sc = ri->ri_hw; 1088 1.2.2.2 yamt struct wsdisplay_font *font = ri->ri_font; 1089 1.2.2.2 yamt uint32_t fontbits; 1090 1.2.2.2 yamt uint16_t pixels[32]; 1091 1.2.2.2 yamt uint8_t *fontbase; 1092 1.2.2.2 yamt int i, soff, eoff; 1093 1.2.2.2 yamt 1094 1.2.2.2 yamt soff = y * sc->sc_width + x; 1095 1.2.2.2 yamt eoff = (y + font->fontheight) * sc->sc_width + x; 1096 1.2.2.2 yamt fontbase = (uint8_t *)font->data + (uc - font->firstchar) * 1097 1.2.2.2 yamt ri->ri_fontscale; 1098 1.2.2.2 yamt 1099 1.2.2.2 yamt while (soff < eoff) { 1100 1.2.2.2 yamt fontbits = 0; 1101 1.2.2.2 yamt switch (font->stride) { 1102 1.2.2.2 yamt case 4: 1103 1.2.2.2 yamt fontbits |= fontbase[3]; 1104 1.2.2.2 yamt /* FALLTHROUGH */ 1105 1.2.2.2 yamt case 3: 1106 1.2.2.2 yamt fontbits |= fontbase[2] << 8; 1107 1.2.2.2 yamt /* FALLTHROUGH */ 1108 1.2.2.2 yamt case 2: 1109 1.2.2.2 yamt fontbits |= fontbase[1] << 16; 1110 1.2.2.2 yamt /* FALLTHROUGH */ 1111 1.2.2.2 yamt case 1: 1112 1.2.2.2 yamt fontbits |= fontbase[0] << 24; 1113 1.2.2.2 yamt } 1114 1.2.2.2 yamt fontbase += font->stride; 1115 1.2.2.2 yamt 1116 1.2.2.2 yamt for (i = 0; i < font->fontwidth; i++) { 1117 1.2.2.2 yamt pixels[i] = rgb16[(fontbits >> 31) & 1]; 1118 1.2.2.2 yamt fontbits <<= 1; 1119 1.2.2.2 yamt } 1120 1.2.2.2 yamt 1121 1.2.2.2 yamt udl_draw_line(sc, pixels, soff, font->fontwidth); 1122 1.2.2.2 yamt soff += sc->sc_width; 1123 1.2.2.2 yamt } 1124 1.2.2.2 yamt } 1125 1.2.2.2 yamt 1126 1.2.2.2 yamt static void 1127 1.2.2.2 yamt udl_copy_rect(struct udl_softc *sc, int sx, int sy, int dx, int dy, int width, 1128 1.2.2.2 yamt int height) 1129 1.2.2.2 yamt { 1130 1.2.2.2 yamt int sbase, soff, ebase, eoff, dbase, doff, width_cur; 1131 1.2.2.2 yamt 1132 1.2.2.2 yamt sbase = sy * sc->sc_width; 1133 1.2.2.2 yamt ebase = (sy + height) * sc->sc_width; 1134 1.2.2.2 yamt dbase = dy * sc->sc_width; 1135 1.2.2.2 yamt 1136 1.2.2.2 yamt while (width > 0) { 1137 1.2.2.2 yamt soff = sbase + sx; 1138 1.2.2.2 yamt eoff = ebase + sx; 1139 1.2.2.2 yamt doff = dbase + dx; 1140 1.2.2.2 yamt 1141 1.2.2.2 yamt if (width >= UDL_CMD_WIDTH_MAX) 1142 1.2.2.2 yamt width_cur = UDL_CMD_WIDTH_MAX; 1143 1.2.2.2 yamt else 1144 1.2.2.2 yamt width_cur = width; 1145 1.2.2.2 yamt 1146 1.2.2.2 yamt while (soff < eoff) { 1147 1.2.2.2 yamt udl_copy_line(sc, soff, doff, width_cur); 1148 1.2.2.2 yamt soff += sc->sc_width; 1149 1.2.2.2 yamt doff += sc->sc_width; 1150 1.2.2.2 yamt } 1151 1.2.2.2 yamt 1152 1.2.2.2 yamt sx += width_cur; 1153 1.2.2.2 yamt dx += width_cur; 1154 1.2.2.2 yamt width -= width_cur; 1155 1.2.2.2 yamt } 1156 1.2.2.2 yamt } 1157 1.2.2.2 yamt 1158 1.2.2.2 yamt static void 1159 1.2.2.2 yamt udl_fill_rect(struct udl_softc *sc, uint16_t rgb16, int x, int y, int width, 1160 1.2.2.2 yamt int height) 1161 1.2.2.2 yamt { 1162 1.2.2.2 yamt int sbase, soff, ebase, eoff, width_cur; 1163 1.2.2.2 yamt 1164 1.2.2.2 yamt sbase = y * sc->sc_width; 1165 1.2.2.2 yamt ebase = (y + height) * sc->sc_width; 1166 1.2.2.2 yamt 1167 1.2.2.2 yamt while (width > 0) { 1168 1.2.2.2 yamt soff = sbase + x; 1169 1.2.2.2 yamt eoff = ebase + x; 1170 1.2.2.2 yamt 1171 1.2.2.2 yamt if (width >= UDL_CMD_WIDTH_MAX) 1172 1.2.2.2 yamt width_cur = UDL_CMD_WIDTH_MAX; 1173 1.2.2.2 yamt else 1174 1.2.2.2 yamt width_cur = width; 1175 1.2.2.2 yamt 1176 1.2.2.2 yamt while (soff < eoff) { 1177 1.2.2.2 yamt udl_fill_line(sc, rgb16, soff, width_cur); 1178 1.2.2.2 yamt soff += sc->sc_width; 1179 1.2.2.2 yamt } 1180 1.2.2.2 yamt 1181 1.2.2.2 yamt x += width_cur; 1182 1.2.2.2 yamt width -= width_cur; 1183 1.2.2.2 yamt } 1184 1.2.2.2 yamt } 1185 1.2.2.2 yamt 1186 1.2.2.2 yamt #ifdef notyet 1187 1.2.2.2 yamt static void 1188 1.2.2.2 yamt udl_draw_rect(struct udl_softc *sc, struct udl_ioctl_damage *d) 1189 1.2.2.2 yamt { 1190 1.2.2.2 yamt int sbase, soff, ebase, eoff, x, y, width, width_cur, height; 1191 1.2.2.2 yamt 1192 1.2.2.2 yamt x = d->x1; 1193 1.2.2.2 yamt y = d->y1; 1194 1.2.2.2 yamt width = d->x2 - d->x1; 1195 1.2.2.2 yamt height = d->y2 - d->y1; 1196 1.2.2.2 yamt sbase = y * sc->sc_width; 1197 1.2.2.2 yamt ebase = (y + height) * sc->sc_width; 1198 1.2.2.2 yamt 1199 1.2.2.2 yamt while (width > 0) { 1200 1.2.2.2 yamt soff = sbase + x; 1201 1.2.2.2 yamt eoff = ebase + x; 1202 1.2.2.2 yamt 1203 1.2.2.2 yamt if (width >= UDL_CMD_WIDTH_MAX) 1204 1.2.2.2 yamt width_cur = UDL_CMD_WIDTH_MAX; 1205 1.2.2.2 yamt else 1206 1.2.2.2 yamt width_cur = width; 1207 1.2.2.2 yamt 1208 1.2.2.2 yamt while (soff < eoff) { 1209 1.2.2.2 yamt udl_draw_line(sc, (uint16_t *)sc->sc_fbmem + soff, 1210 1.2.2.2 yamt soff, width_cur); 1211 1.2.2.2 yamt soff += sc->sc_width; 1212 1.2.2.2 yamt } 1213 1.2.2.2 yamt 1214 1.2.2.2 yamt x += width_cur; 1215 1.2.2.2 yamt width -= width_cur; 1216 1.2.2.2 yamt } 1217 1.2.2.2 yamt 1218 1.2.2.2 yamt udl_cmd_send_async(sc); 1219 1.2.2.2 yamt } 1220 1.2.2.2 yamt 1221 1.2.2.2 yamt static void 1222 1.2.2.2 yamt udl_draw_rect_comp(struct udl_softc *sc, struct udl_ioctl_damage *d) 1223 1.2.2.2 yamt { 1224 1.2.2.2 yamt int soff, eoff, x, y, width, height; 1225 1.2.2.2 yamt 1226 1.2.2.2 yamt x = d->x1; 1227 1.2.2.2 yamt y = d->y1; 1228 1.2.2.2 yamt width = d->x2 - d->x1; 1229 1.2.2.2 yamt height = d->y2 - d->y1; 1230 1.2.2.2 yamt soff = y * sc->sc_width + x; 1231 1.2.2.2 yamt eoff = (y + height) * sc->sc_width + x; 1232 1.2.2.2 yamt 1233 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_SYNC, 0xff); 1234 1.2.2.2 yamt sc->sc_cmd_cblen = 4; 1235 1.2.2.2 yamt 1236 1.2.2.2 yamt while (soff < eoff) { 1237 1.2.2.2 yamt udl_draw_line_comp(sc, (uint16_t *)sc->sc_fbmem + soff, soff, 1238 1.2.2.2 yamt width); 1239 1.2.2.2 yamt soff += sc->sc_width; 1240 1.2.2.2 yamt } 1241 1.2.2.2 yamt 1242 1.2.2.2 yamt udl_cmd_send_async(sc); 1243 1.2.2.2 yamt } 1244 1.2.2.2 yamt #endif 1245 1.2.2.2 yamt 1246 1.2.2.2 yamt static inline void 1247 1.2.2.2 yamt udl_copy_line(struct udl_softc *sc, int soff, int doff, int width) 1248 1.2.2.2 yamt { 1249 1.2.2.2 yamt 1250 1.2.2.2 yamt if (__predict_false((UDL_CMD_BUFSIZE(sc) + UDL_CMD_COPY_SIZE + 2) > 1251 1.2.2.2 yamt UDL_CMD_BUFFER_SIZE)) 1252 1.2.2.2 yamt udl_cmd_send_async(sc); 1253 1.2.2.2 yamt 1254 1.2.2.2 yamt udl_cmd_add_2(sc, (UDL_BULK_SOC << 8) | UDL_BULK_CMD_FB_COPY16); 1255 1.2.2.2 yamt udl_cmd_add_4(sc, ((doff * 2) << 8) | (width & 0xff)); 1256 1.2.2.2 yamt 1257 1.2.2.2 yamt udl_cmd_add_3(sc, soff * 2); 1258 1.2.2.2 yamt } 1259 1.2.2.2 yamt 1260 1.2.2.2 yamt static inline void 1261 1.2.2.2 yamt udl_fill_line(struct udl_softc *sc, uint16_t rgb16, int off, int width) 1262 1.2.2.2 yamt { 1263 1.2.2.2 yamt 1264 1.2.2.2 yamt if (__predict_false((UDL_CMD_BUFSIZE(sc) + UDL_CMD_FILL_SIZE + 2) > 1265 1.2.2.2 yamt UDL_CMD_BUFFER_SIZE)) 1266 1.2.2.2 yamt udl_cmd_send_async(sc); 1267 1.2.2.2 yamt 1268 1.2.2.2 yamt udl_cmd_add_2(sc, (UDL_BULK_SOC << 8) | UDL_BULK_CMD_FB_RLE16); 1269 1.2.2.2 yamt udl_cmd_add_4(sc, ((off * 2) << 8) | (width & 0xff)); 1270 1.2.2.2 yamt 1271 1.2.2.2 yamt udl_cmd_add_1(sc, width); 1272 1.2.2.2 yamt udl_cmd_add_2(sc, rgb16); 1273 1.2.2.2 yamt } 1274 1.2.2.2 yamt 1275 1.2.2.2 yamt static inline void 1276 1.2.2.2 yamt udl_draw_line(struct udl_softc *sc, uint16_t *buf, int off, int width) 1277 1.2.2.2 yamt { 1278 1.2.2.2 yamt 1279 1.2.2.2 yamt if (__predict_false( 1280 1.2.2.2 yamt (UDL_CMD_BUFSIZE(sc) + UDL_CMD_DRAW_SIZE(width) + 2) > 1281 1.2.2.2 yamt UDL_CMD_BUFFER_SIZE)) 1282 1.2.2.2 yamt udl_cmd_send_async(sc); 1283 1.2.2.2 yamt 1284 1.2.2.2 yamt udl_cmd_add_2(sc, (UDL_BULK_SOC << 8) | UDL_BULK_CMD_FB_WRITE16); 1285 1.2.2.2 yamt udl_cmd_add_4(sc, ((off * 2) << 8) | (width & 0xff)); 1286 1.2.2.2 yamt 1287 1.2.2.2 yamt udl_cmd_add_buf(sc, buf, width); 1288 1.2.2.2 yamt } 1289 1.2.2.2 yamt 1290 1.2.2.2 yamt static inline int 1291 1.2.2.2 yamt udl_cmd_add_buf_comp(struct udl_softc *sc, uint16_t *buf, int width) 1292 1.2.2.2 yamt { 1293 1.2.2.2 yamt struct udl_huffman *h; 1294 1.2.2.2 yamt uint16_t *startp, *endp; 1295 1.2.2.2 yamt uint32_t bit_pattern; 1296 1.2.2.2 yamt uint16_t prev; 1297 1.2.2.2 yamt int16_t diff; 1298 1.2.2.2 yamt uint8_t bit_count, bit_pos, bit_rem, curlen; 1299 1.2.2.2 yamt 1300 1.2.2.2 yamt startp = buf; 1301 1.2.2.2 yamt if (width >= UDL_CMD_WIDTH_MAX) 1302 1.2.2.2 yamt endp = buf + UDL_CMD_WIDTH_MAX; 1303 1.2.2.2 yamt else 1304 1.2.2.2 yamt endp = buf + width; 1305 1.2.2.2 yamt 1306 1.2.2.2 yamt prev = bit_pos = *sc->sc_cmd_buf = 0; 1307 1.2.2.2 yamt bit_rem = 8; 1308 1.2.2.2 yamt 1309 1.2.2.2 yamt /* 1310 1.2.2.2 yamt * Generate a sub-block with maximal 256 pixels compressed data. 1311 1.2.2.2 yamt */ 1312 1.2.2.2 yamt while (buf < endp) { 1313 1.2.2.2 yamt /* get difference between current and previous pixel */ 1314 1.2.2.2 yamt diff = *buf - prev; 1315 1.2.2.2 yamt 1316 1.2.2.2 yamt /* get the huffman difference bit sequence */ 1317 1.2.2.2 yamt h = (struct udl_huffman *)sc->sc_huffman_base + diff; 1318 1.2.2.2 yamt bit_count = h->bit_count; 1319 1.2.2.2 yamt bit_pattern = h->bit_pattern; 1320 1.2.2.2 yamt 1321 1.2.2.2 yamt curlen = (bit_pos + bit_count + 7) / 8; 1322 1.2.2.2 yamt if (__predict_false((sc->sc_cmd_cblen + curlen + 1) > 1323 1.2.2.2 yamt UDL_CMD_COMP_BLOCK_SIZE)) 1324 1.2.2.2 yamt break; 1325 1.2.2.2 yamt 1326 1.2.2.2 yamt /* generate one pixel compressed data */ 1327 1.2.2.2 yamt while (bit_count >= bit_rem) { 1328 1.2.2.2 yamt *sc->sc_cmd_buf++ |= 1329 1.2.2.2 yamt (bit_pattern & ((1 << bit_rem) - 1)) << bit_pos; 1330 1.2.2.2 yamt *sc->sc_cmd_buf = 0; 1331 1.2.2.2 yamt sc->sc_cmd_cblen++; 1332 1.2.2.2 yamt bit_count -= bit_rem; 1333 1.2.2.2 yamt bit_pattern >>= bit_rem; 1334 1.2.2.2 yamt bit_pos = 0; 1335 1.2.2.2 yamt bit_rem = 8; 1336 1.2.2.2 yamt } 1337 1.2.2.2 yamt 1338 1.2.2.2 yamt if (bit_count > 0) { 1339 1.2.2.2 yamt *sc->sc_cmd_buf |= 1340 1.2.2.2 yamt (bit_pattern & ((1 << bit_count) - 1)) << bit_pos; 1341 1.2.2.2 yamt bit_pos += bit_count; 1342 1.2.2.2 yamt bit_rem -= bit_count; 1343 1.2.2.2 yamt } 1344 1.2.2.2 yamt 1345 1.2.2.2 yamt prev = *buf++; 1346 1.2.2.2 yamt } 1347 1.2.2.2 yamt 1348 1.2.2.2 yamt /* 1349 1.2.2.2 yamt * If we have bits left in our last byte, round up to the next 1350 1.2.2.2 yamt * byte, so we don't overwrite them. 1351 1.2.2.2 yamt */ 1352 1.2.2.2 yamt if (bit_pos > 0) { 1353 1.2.2.2 yamt sc->sc_cmd_buf++; 1354 1.2.2.2 yamt sc->sc_cmd_cblen++; 1355 1.2.2.2 yamt } 1356 1.2.2.2 yamt 1357 1.2.2.2 yamt /* return how many pixels we have compressed */ 1358 1.2.2.2 yamt return buf - startp; 1359 1.2.2.2 yamt } 1360 1.2.2.2 yamt 1361 1.2.2.2 yamt static inline void 1362 1.2.2.2 yamt udl_draw_line_comp(struct udl_softc *sc, uint16_t *buf, int off, int width) 1363 1.2.2.2 yamt { 1364 1.2.2.2 yamt uint8_t *widthp; 1365 1.2.2.2 yamt int width_cur; 1366 1.2.2.2 yamt 1367 1.2.2.2 yamt while (width > 0) { 1368 1.2.2.2 yamt if (__predict_false( 1369 1.2.2.2 yamt (sc->sc_cmd_cblen + UDL_CMD_COMP_MIN_SIZE + 1) > 1370 1.2.2.2 yamt UDL_CMD_COMP_BLOCK_SIZE)) { 1371 1.2.2.2 yamt if (UDL_CMD_BUFSIZE(sc) < UDL_CMD_COMP_THRESHOLD) { 1372 1.2.2.2 yamt while (sc->sc_cmd_cblen < 1373 1.2.2.2 yamt UDL_CMD_COMP_BLOCK_SIZE) { 1374 1.2.2.2 yamt *sc->sc_cmd_buf++ = 0; 1375 1.2.2.2 yamt sc->sc_cmd_cblen++; 1376 1.2.2.2 yamt } 1377 1.2.2.2 yamt } else 1378 1.2.2.2 yamt udl_cmd_send_async(sc); 1379 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_SYNC, 0xff); 1380 1.2.2.2 yamt sc->sc_cmd_cblen = 4; 1381 1.2.2.2 yamt } 1382 1.2.2.2 yamt 1383 1.2.2.2 yamt udl_cmd_add_2(sc, (UDL_BULK_SOC << 8) | 1384 1.2.2.2 yamt (UDL_BULK_CMD_FB_WRITE16 | UDL_BULK_CMD_FB_COMP)); 1385 1.2.2.2 yamt udl_cmd_add_4(sc, (off * 2) << 8); 1386 1.2.2.2 yamt 1387 1.2.2.2 yamt widthp = sc->sc_cmd_buf - 1; 1388 1.2.2.2 yamt 1389 1.2.2.2 yamt sc->sc_cmd_cblen += UDL_CMD_HEADER_SIZE; 1390 1.2.2.2 yamt 1391 1.2.2.2 yamt width_cur = udl_cmd_add_buf_comp(sc, buf, width); 1392 1.2.2.2 yamt 1393 1.2.2.2 yamt *widthp = width_cur; 1394 1.2.2.2 yamt buf += width_cur; 1395 1.2.2.2 yamt off += width_cur; 1396 1.2.2.2 yamt width -= width_cur; 1397 1.2.2.2 yamt } 1398 1.2.2.2 yamt } 1399 1.2.2.2 yamt 1400 1.2.2.2 yamt static int 1401 1.2.2.2 yamt udl_cmd_send(struct udl_softc *sc) 1402 1.2.2.2 yamt { 1403 1.2.2.2 yamt struct udl_cmdq *cmdq; 1404 1.2.2.2 yamt usbd_status error; 1405 1.2.2.2 yamt uint32_t len; 1406 1.2.2.2 yamt 1407 1.2.2.2 yamt cmdq = sc->sc_cmd_cur; 1408 1.2.2.2 yamt 1409 1.2.2.2 yamt /* mark end of command stack */ 1410 1.2.2.2 yamt udl_cmd_add_2(sc, (UDL_BULK_SOC << 8) | UDL_BULK_CMD_EOC); 1411 1.2.2.2 yamt 1412 1.2.2.2 yamt len = UDL_CMD_BUFSIZE(sc); 1413 1.2.2.2 yamt 1414 1.2.2.2 yamt /* do xfer */ 1415 1.2.2.2 yamt error = usbd_bulk_transfer(cmdq->cq_xfer, sc->sc_tx_pipeh, 1416 1.2.2.2 yamt USBD_NO_COPY, USBD_NO_TIMEOUT, cmdq->cq_buf, &len, "udlcmds"); 1417 1.2.2.2 yamt 1418 1.2.2.2 yamt UDL_CMD_BUFINIT(sc); 1419 1.2.2.2 yamt 1420 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION) { 1421 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "%s: %s!\n", __func__, 1422 1.2.2.2 yamt usbd_errstr(error)); 1423 1.2.2.2 yamt return -1; 1424 1.2.2.2 yamt } 1425 1.2.2.2 yamt 1426 1.2.2.2 yamt return 0; 1427 1.2.2.2 yamt } 1428 1.2.2.2 yamt 1429 1.2.2.2 yamt static void 1430 1.2.2.2 yamt udl_cmd_send_async(struct udl_softc *sc) 1431 1.2.2.2 yamt { 1432 1.2.2.2 yamt struct udl_cmdq *cmdq; 1433 1.2.2.2 yamt usbd_status error; 1434 1.2.2.2 yamt uint32_t len; 1435 1.2.2.2 yamt 1436 1.2.2.2 yamt #if 1 1437 1.2.2.2 yamt /* 1438 1.2.2.2 yamt * XXX 1439 1.2.2.2 yamt * All tty ops for wsemul are called with tty_lock spin mutex held, 1440 1.2.2.2 yamt * so we can't call cv_wait(9) here to acquire a free buffer. 1441 1.2.2.2 yamt * For now, all commands and data for wsemul ops are discarded 1442 1.2.2.2 yamt * if there is no free command buffer, and then screen text might 1443 1.2.2.2 yamt * be corrupted on large scroll ops etc. 1444 1.2.2.2 yamt * 1445 1.2.2.2 yamt * Probably we have to reorganize the giant tty_lock mutex, or 1446 1.2.2.2 yamt * change wsdisplay APIs (especially wsdisplaystart()) to return 1447 1.2.2.2 yamt * a number of actually handled characters as OpenBSD does, but 1448 1.2.2.2 yamt * the latter one requires whole API changes around rasops(9) etc. 1449 1.2.2.2 yamt */ 1450 1.2.2.2 yamt if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) { 1451 1.2.2.2 yamt if (TAILQ_FIRST(&sc->sc_freecmd) == NULL) { 1452 1.2.2.2 yamt UDL_CMD_BUFINIT(sc); 1453 1.2.2.2 yamt return; 1454 1.2.2.2 yamt } 1455 1.2.2.2 yamt } 1456 1.2.2.2 yamt #endif 1457 1.2.2.2 yamt 1458 1.2.2.2 yamt cmdq = sc->sc_cmd_cur; 1459 1.2.2.2 yamt 1460 1.2.2.2 yamt /* mark end of command stack */ 1461 1.2.2.2 yamt udl_cmd_add_2(sc, (UDL_BULK_SOC << 8) | UDL_BULK_CMD_EOC); 1462 1.2.2.2 yamt 1463 1.2.2.2 yamt len = UDL_CMD_BUFSIZE(sc); 1464 1.2.2.2 yamt 1465 1.2.2.2 yamt /* do xfer */ 1466 1.2.2.2 yamt mutex_enter(&sc->sc_mtx); 1467 1.2.2.2 yamt usbd_setup_xfer(cmdq->cq_xfer, sc->sc_tx_pipeh, cmdq, cmdq->cq_buf, 1468 1.2.2.2 yamt len, USBD_NO_COPY, USBD_NO_TIMEOUT, udl_cmd_send_async_cb); 1469 1.2.2.2 yamt error = usbd_transfer(cmdq->cq_xfer); 1470 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION && error != USBD_IN_PROGRESS) { 1471 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "%s: %s!\n", __func__, 1472 1.2.2.2 yamt usbd_errstr(error)); 1473 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 1474 1.2.2.2 yamt goto end; 1475 1.2.2.2 yamt } 1476 1.2.2.2 yamt 1477 1.2.2.2 yamt TAILQ_INSERT_TAIL(&sc->sc_xfercmd, cmdq, cq_chain); 1478 1.2.2.2 yamt cmdq = udl_cmdq_get(sc); 1479 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 1480 1.2.2.2 yamt while (cmdq == NULL) { 1481 1.2.2.2 yamt int err; 1482 1.2.2.2 yamt UDL_EVCNT_INCR(&sc->sc_ev_cmdq_wait); 1483 1.2.2.2 yamt mutex_enter(&sc->sc_mtx); 1484 1.2.2.2 yamt err = cv_timedwait(&sc->sc_cv, &sc->sc_mtx, 1485 1.2.2.2 yamt mstohz(100) /* XXX is this needed? */); 1486 1.2.2.2 yamt if (err != 0) { 1487 1.2.2.2 yamt DPRINTF(("%s: %s: cv timeout (error = %d)\n", 1488 1.2.2.2 yamt device_xname(sc->sc_dev), __func__, err)); 1489 1.2.2.2 yamt UDL_EVCNT_INCR(&sc->sc_ev_cmdq_timeout); 1490 1.2.2.2 yamt } 1491 1.2.2.2 yamt cmdq = udl_cmdq_get(sc); 1492 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 1493 1.2.2.2 yamt } 1494 1.2.2.2 yamt sc->sc_cmd_cur = cmdq; 1495 1.2.2.2 yamt end: 1496 1.2.2.2 yamt UDL_CMD_BUFINIT(sc); 1497 1.2.2.2 yamt } 1498 1.2.2.2 yamt 1499 1.2.2.2 yamt static void 1500 1.2.2.2 yamt udl_cmd_send_async_cb(usbd_xfer_handle xfer, usbd_private_handle priv, 1501 1.2.2.2 yamt usbd_status status) 1502 1.2.2.2 yamt { 1503 1.2.2.2 yamt struct udl_cmdq *cmdq = priv; 1504 1.2.2.2 yamt struct udl_softc *sc = cmdq->cq_sc; 1505 1.2.2.2 yamt 1506 1.2.2.2 yamt if (status != USBD_NORMAL_COMPLETION) { 1507 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "%s: %s!\n", __func__, 1508 1.2.2.2 yamt usbd_errstr(status)); 1509 1.2.2.2 yamt 1510 1.2.2.2 yamt if (status == USBD_NOT_STARTED || status == USBD_CANCELLED) 1511 1.2.2.2 yamt return; 1512 1.2.2.2 yamt if (status == USBD_STALLED) 1513 1.2.2.2 yamt usbd_clear_endpoint_stall_async(sc->sc_tx_pipeh); 1514 1.2.2.2 yamt } 1515 1.2.2.2 yamt 1516 1.2.2.2 yamt mutex_enter(&sc->sc_mtx); 1517 1.2.2.2 yamt TAILQ_REMOVE(&sc->sc_xfercmd, cmdq, cq_chain); 1518 1.2.2.2 yamt udl_cmdq_put(sc, cmdq); 1519 1.2.2.2 yamt 1520 1.2.2.2 yamt /* wakeup xfer op that sleeps for a free xfer buffer */ 1521 1.2.2.2 yamt cv_signal(&sc->sc_cv); 1522 1.2.2.2 yamt mutex_exit(&sc->sc_mtx); 1523 1.2.2.2 yamt } 1524 1.2.2.2 yamt 1525 1.2.2.2 yamt static int 1526 1.2.2.2 yamt udl_ctrl_msg(struct udl_softc *sc, uint8_t rt, uint8_t r, uint16_t index, 1527 1.2.2.2 yamt uint16_t value, uint8_t *buf, uint16_t len) 1528 1.2.2.2 yamt { 1529 1.2.2.2 yamt usb_device_request_t req; 1530 1.2.2.2 yamt usbd_status error; 1531 1.2.2.2 yamt 1532 1.2.2.2 yamt req.bmRequestType = rt; 1533 1.2.2.2 yamt req.bRequest = r; 1534 1.2.2.2 yamt USETW(req.wIndex, index); 1535 1.2.2.2 yamt USETW(req.wValue, value); 1536 1.2.2.2 yamt USETW(req.wLength, len); 1537 1.2.2.2 yamt 1538 1.2.2.2 yamt error = usbd_do_request(sc->sc_udev, &req, buf); 1539 1.2.2.2 yamt if (error != USBD_NORMAL_COMPLETION) { 1540 1.2.2.2 yamt aprint_error_dev(sc->sc_dev, "%s: %s!\n", __func__, 1541 1.2.2.2 yamt usbd_errstr(error)); 1542 1.2.2.2 yamt return -1; 1543 1.2.2.2 yamt } 1544 1.2.2.2 yamt 1545 1.2.2.2 yamt return 0; 1546 1.2.2.2 yamt } 1547 1.2.2.2 yamt 1548 1.2.2.2 yamt static int 1549 1.2.2.2 yamt udl_init(struct udl_softc *sc) 1550 1.2.2.2 yamt { 1551 1.2.2.2 yamt static uint8_t key[16] = { 1552 1.2.2.2 yamt 0x57, 0xcd, 0xdc, 0xa7, 0x1c, 0x88, 0x5e, 0x15, 1553 1.2.2.2 yamt 0x60, 0xfe, 0xc6, 0x97, 0x16, 0x3d, 0x47, 0xf2 1554 1.2.2.2 yamt }; 1555 1.2.2.2 yamt uint8_t status[4], val; 1556 1.2.2.2 yamt 1557 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_READ_VENDOR_DEVICE, UDL_CTRL_CMD_READ_STATUS, 1558 1.2.2.2 yamt 0x0000, 0x0000, status, sizeof(status)) != 0) 1559 1.2.2.2 yamt return -1; 1560 1.2.2.2 yamt 1561 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_READ_VENDOR_DEVICE, UDL_CTRL_CMD_READ_1, 1562 1.2.2.2 yamt 0xc484, 0x0000, &val, 1) != 0) 1563 1.2.2.2 yamt return -1; 1564 1.2.2.2 yamt 1565 1.2.2.2 yamt val = 1; 1566 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_WRITE_VENDOR_DEVICE, UDL_CTRL_CMD_WRITE_1, 1567 1.2.2.2 yamt 0xc41f, 0x0000, &val, 1) != 0) 1568 1.2.2.2 yamt return -1; 1569 1.2.2.2 yamt 1570 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_WRITE_VENDOR_DEVICE, UDL_CTRL_CMD_SET_KEY, 1571 1.2.2.2 yamt 0x0000, 0x0000, key, sizeof(key)) != 0) 1572 1.2.2.2 yamt return -1; 1573 1.2.2.2 yamt 1574 1.2.2.2 yamt val = 0; 1575 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_WRITE_VENDOR_DEVICE, UDL_CTRL_CMD_WRITE_1, 1576 1.2.2.2 yamt 0xc40b, 0x0000, &val, 1) != 0) 1577 1.2.2.2 yamt return -1; 1578 1.2.2.2 yamt 1579 1.2.2.2 yamt return 0; 1580 1.2.2.2 yamt } 1581 1.2.2.2 yamt 1582 1.2.2.2 yamt static void 1583 1.2.2.2 yamt udl_read_edid(struct udl_softc *sc) 1584 1.2.2.2 yamt { 1585 1.2.2.2 yamt uint8_t buf[64], edid[128]; 1586 1.2.2.2 yamt int offset; 1587 1.2.2.2 yamt 1588 1.2.2.2 yamt memset(&sc->sc_ei, 0, sizeof(struct edid_info)); 1589 1.2.2.2 yamt 1590 1.2.2.2 yamt offset = 0; 1591 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_READ_VENDOR_DEVICE, UDL_CTRL_CMD_READ_EDID, 1592 1.2.2.2 yamt 0x00a1, (offset << 8), buf, 64) != 0) 1593 1.2.2.2 yamt return; 1594 1.2.2.2 yamt if (buf[0] != 0) 1595 1.2.2.2 yamt return; 1596 1.2.2.2 yamt memcpy(&edid[offset], &buf[1], 63); 1597 1.2.2.2 yamt offset += 63; 1598 1.2.2.2 yamt 1599 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_READ_VENDOR_DEVICE, UDL_CTRL_CMD_READ_EDID, 1600 1.2.2.2 yamt 0x00a1, (offset << 8), buf, 64) != 0) 1601 1.2.2.2 yamt return; 1602 1.2.2.2 yamt if (buf[0] != 0) 1603 1.2.2.2 yamt return; 1604 1.2.2.2 yamt memcpy(&edid[offset], &buf[1], 63); 1605 1.2.2.2 yamt offset += 63; 1606 1.2.2.2 yamt 1607 1.2.2.2 yamt if (udl_ctrl_msg(sc, UT_READ_VENDOR_DEVICE, UDL_CTRL_CMD_READ_EDID, 1608 1.2.2.2 yamt 0x00a1, (offset << 8), buf, 3) != 0) 1609 1.2.2.2 yamt return; 1610 1.2.2.2 yamt if (buf[0] != 0) 1611 1.2.2.2 yamt return; 1612 1.2.2.2 yamt memcpy(&edid[offset], &buf[1], 2); 1613 1.2.2.2 yamt 1614 1.2.2.2 yamt if (edid_parse(edid, &sc->sc_ei) == 0) { 1615 1.2.2.2 yamt #ifdef UDL_DEBUG 1616 1.2.2.2 yamt edid_print(&sc->sc_ei); 1617 1.2.2.2 yamt #endif 1618 1.2.2.2 yamt } 1619 1.2.2.2 yamt } 1620 1.2.2.2 yamt 1621 1.2.2.2 yamt static void 1622 1.2.2.2 yamt udl_set_address(struct udl_softc *sc, int start16, int stride16, int start8, 1623 1.2.2.2 yamt int stride8) 1624 1.2.2.2 yamt { 1625 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_SYNC, 0x00); 1626 1.2.2.2 yamt udl_reg_write_3(sc, UDL_REG_ADDR_START16, start16); 1627 1.2.2.2 yamt udl_reg_write_3(sc, UDL_REG_ADDR_STRIDE16, stride16); 1628 1.2.2.2 yamt udl_reg_write_3(sc, UDL_REG_ADDR_START8, start8); 1629 1.2.2.2 yamt udl_reg_write_3(sc, UDL_REG_ADDR_STRIDE8, stride8); 1630 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_SYNC, 0xff); 1631 1.2.2.2 yamt } 1632 1.2.2.2 yamt 1633 1.2.2.2 yamt static void 1634 1.2.2.2 yamt udl_blank(struct udl_softc *sc, int blank) 1635 1.2.2.2 yamt { 1636 1.2.2.2 yamt 1637 1.2.2.2 yamt if (blank != 0) 1638 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_BLANK, UDL_REG_BLANK_ON); 1639 1.2.2.2 yamt else 1640 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_BLANK, UDL_REG_BLANK_OFF); 1641 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_SYNC, 0xff); 1642 1.2.2.2 yamt } 1643 1.2.2.2 yamt 1644 1.2.2.2 yamt static uint16_t 1645 1.2.2.2 yamt udl_lfsr(uint16_t count) 1646 1.2.2.2 yamt { 1647 1.2.2.2 yamt uint16_t val = 0xffff; 1648 1.2.2.2 yamt 1649 1.2.2.2 yamt while (count > 0) { 1650 1.2.2.2 yamt val = (uint16_t)(val << 1) | ((uint16_t)( 1651 1.2.2.2 yamt (uint16_t)(val << 0) ^ 1652 1.2.2.2 yamt (uint16_t)(val << 11) ^ 1653 1.2.2.2 yamt (uint16_t)(val << 13) ^ 1654 1.2.2.2 yamt (uint16_t)(val << 14) 1655 1.2.2.2 yamt ) >> 15); 1656 1.2.2.2 yamt count--; 1657 1.2.2.2 yamt } 1658 1.2.2.2 yamt 1659 1.2.2.2 yamt return val; 1660 1.2.2.2 yamt } 1661 1.2.2.2 yamt 1662 1.2.2.2 yamt static int 1663 1.2.2.2 yamt udl_set_resolution(struct udl_softc *sc, const struct videomode *vmp) 1664 1.2.2.2 yamt { 1665 1.2.2.2 yamt uint16_t val; 1666 1.2.2.2 yamt int start16, stride16, start8, stride8; 1667 1.2.2.2 yamt 1668 1.2.2.2 yamt /* set video memory offsets */ 1669 1.2.2.2 yamt start16 = 0; 1670 1.2.2.2 yamt stride16 = sc->sc_width * 2; 1671 1.2.2.2 yamt start8 = stride16 * sc->sc_height; 1672 1.2.2.2 yamt stride8 = sc->sc_width; 1673 1.2.2.2 yamt udl_set_address(sc, start16, stride16, start8, stride8); 1674 1.2.2.2 yamt 1675 1.2.2.2 yamt /* write resolution values */ 1676 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_SYNC, 0x00); 1677 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_COLORDEPTH, UDL_REG_COLORDEPTH_16); 1678 1.2.2.2 yamt val = vmp->htotal - vmp->hsync_start; 1679 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_XDISPLAYSTART, udl_lfsr(val)); 1680 1.2.2.2 yamt val += vmp->hdisplay; 1681 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_XDISPLAYEND, udl_lfsr(val)); 1682 1.2.2.2 yamt val = vmp->vtotal - vmp->vsync_start; 1683 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_YDISPLAYSTART, udl_lfsr(val)); 1684 1.2.2.2 yamt val += vmp->vdisplay; 1685 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_YDISPLAYEND, udl_lfsr(val)); 1686 1.2.2.2 yamt val = vmp->htotal - 1; 1687 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_XENDCOUNT, udl_lfsr(val)); 1688 1.2.2.2 yamt val = vmp->hsync_end - vmp->hsync_start + 1; 1689 1.2.2.2 yamt if (vmp->flags & VID_PHSYNC) { 1690 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_HSYNCSTART, udl_lfsr(1)); 1691 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_HSYNCEND, udl_lfsr(val)); 1692 1.2.2.2 yamt } else { 1693 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_HSYNCSTART, udl_lfsr(val)); 1694 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_HSYNCEND, udl_lfsr(1)); 1695 1.2.2.2 yamt } 1696 1.2.2.2 yamt val = vmp->hdisplay; 1697 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_HPIXELS, val); 1698 1.2.2.2 yamt val = vmp->vtotal; 1699 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_YENDCOUNT, udl_lfsr(val)); 1700 1.2.2.2 yamt val = vmp->vsync_end - vmp->vsync_start; 1701 1.2.2.2 yamt if (vmp->flags & VID_PVSYNC) { 1702 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_VSYNCSTART, udl_lfsr(0)); 1703 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_VSYNCEND, udl_lfsr(val)); 1704 1.2.2.2 yamt } else { 1705 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_VSYNCSTART, udl_lfsr(val)); 1706 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_VSYNCEND, udl_lfsr(0)); 1707 1.2.2.2 yamt } 1708 1.2.2.2 yamt val = vmp->vdisplay; 1709 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_VPIXELS, val); 1710 1.2.2.2 yamt val = vmp->dot_clock / 5; 1711 1.2.2.2 yamt udl_reg_write_2(sc, UDL_REG_PIXELCLOCK5KHZ, bswap16(val)); 1712 1.2.2.2 yamt udl_reg_write_1(sc, UDL_REG_SYNC, 0xff); 1713 1.2.2.2 yamt 1714 1.2.2.2 yamt if (udl_cmd_send(sc) != 0) 1715 1.2.2.2 yamt return -1; 1716 1.2.2.2 yamt 1717 1.2.2.2 yamt /* clear screen */ 1718 1.2.2.2 yamt udl_fill_rect(sc, 0, 0, 0, sc->sc_width, sc->sc_height); 1719 1.2.2.2 yamt 1720 1.2.2.2 yamt if (udl_cmd_send(sc) != 0) 1721 1.2.2.2 yamt return -1; 1722 1.2.2.2 yamt 1723 1.2.2.2 yamt /* show framebuffer content */ 1724 1.2.2.2 yamt udl_blank(sc, 0); 1725 1.2.2.2 yamt 1726 1.2.2.2 yamt if (udl_cmd_send(sc) != 0) 1727 1.2.2.2 yamt return -1; 1728 1.2.2.2 yamt 1729 1.2.2.2 yamt sc->sc_blank = WSDISPLAYIO_VIDEO_ON; 1730 1.2.2.2 yamt 1731 1.2.2.2 yamt return 0; 1732 1.2.2.2 yamt } 1733 1.2.2.2 yamt 1734 1.2.2.2 yamt static const struct videomode * 1735 1.2.2.2 yamt udl_videomode_lookup(const char *name) 1736 1.2.2.2 yamt { 1737 1.2.2.2 yamt int i; 1738 1.2.2.2 yamt 1739 1.2.2.2 yamt for (i = 0; i < videomode_count; i++) 1740 1.2.2.2 yamt if (strcmp(name, videomode_list[i].name) == 0) 1741 1.2.2.2 yamt return &videomode_list[i]; 1742 1.2.2.2 yamt 1743 1.2.2.2 yamt return NULL; 1744 1.2.2.2 yamt } 1745
Indexes created Wed Oct 01 19:09:53 GMT 2025