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