pseye.c revision 1.9.2.2
1 1.9.2.2 mjf /* $NetBSD: pseye.c,v 1.9.2.2 2008/09/28 10:40:33 mjf Exp $ */ 2 1.9.2.2 mjf 3 1.9.2.2 mjf /*- 4 1.9.2.2 mjf * Copyright (c) 2008 Jared D. McNeill <jmcneill (at) invisible.ca> 5 1.9.2.2 mjf * All rights reserved. 6 1.9.2.2 mjf * 7 1.9.2.2 mjf * Redistribution and use in source and binary forms, with or without 8 1.9.2.2 mjf * modification, are permitted provided that the following conditions 9 1.9.2.2 mjf * are met: 10 1.9.2.2 mjf * 1. Redistributions of source code must retain the above copyright 11 1.9.2.2 mjf * notice, this list of conditions and the following disclaimer. 12 1.9.2.2 mjf * 2. Redistributions in binary form must reproduce the above copyright 13 1.9.2.2 mjf * notice, this list of conditions and the following disclaimer in the 14 1.9.2.2 mjf * documentation and/or other materials provided with the distribution. 15 1.9.2.2 mjf * 16 1.9.2.2 mjf * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 1.9.2.2 mjf * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 1.9.2.2 mjf * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 1.9.2.2 mjf * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 1.9.2.2 mjf * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 1.9.2.2 mjf * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 1.9.2.2 mjf * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 1.9.2.2 mjf * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 1.9.2.2 mjf * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 1.9.2.2 mjf * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.9.2.2 mjf * POSSIBILITY OF SUCH DAMAGE. 27 1.9.2.2 mjf */ 28 1.9.2.2 mjf 29 1.9.2.2 mjf /* 30 1.9.2.2 mjf * Sony PLAYSTATION(R) Eye Driver 31 1.9.2.2 mjf * 32 1.9.2.2 mjf * The only documentation we have for this part is based on a series 33 1.9.2.2 mjf * of forum postings by Jim Paris on ps2dev.org. Many thanks for 34 1.9.2.2 mjf * figuring this one out. 35 1.9.2.2 mjf * 36 1.9.2.2 mjf * URL: http://forums.ps2dev.org/viewtopic.php?t=9238 37 1.9.2.2 mjf */ 38 1.9.2.2 mjf 39 1.9.2.2 mjf #include <sys/cdefs.h> 40 1.9.2.2 mjf __KERNEL_RCSID(0, "$NetBSD: pseye.c,v 1.9.2.2 2008/09/28 10:40:33 mjf Exp $"); 41 1.9.2.2 mjf 42 1.9.2.2 mjf #include <sys/param.h> 43 1.9.2.2 mjf #include <sys/systm.h> 44 1.9.2.2 mjf #include <sys/device.h> 45 1.9.2.2 mjf #include <sys/malloc.h> 46 1.9.2.2 mjf #include <sys/fcntl.h> 47 1.9.2.2 mjf #include <sys/conf.h> 48 1.9.2.2 mjf #include <sys/poll.h> 49 1.9.2.2 mjf #include <sys/bus.h> 50 1.9.2.2 mjf #include <sys/mutex.h> 51 1.9.2.2 mjf #include <sys/kthread.h> 52 1.9.2.2 mjf #include <sys/condvar.h> 53 1.9.2.2 mjf 54 1.9.2.2 mjf #include <uvm/uvm_extern.h> 55 1.9.2.2 mjf 56 1.9.2.2 mjf #include <dev/usb/usb.h> 57 1.9.2.2 mjf #include <dev/usb/usbdi.h> 58 1.9.2.2 mjf #include <dev/usb/usbdi_util.h> 59 1.9.2.2 mjf #include <dev/usb/usbdevs.h> 60 1.9.2.2 mjf 61 1.9.2.2 mjf #include <dev/video_if.h> 62 1.9.2.2 mjf 63 1.9.2.2 mjf #define PRI_PSEYE PRI_BIO 64 1.9.2.2 mjf 65 1.9.2.2 mjf /* Bulk-in buffer length */ 66 1.9.2.2 mjf #define PSEYE_BULKIN_BUFLEN (640 * 480 * 2) 67 1.9.2.2 mjf 68 1.9.2.2 mjf /* SCCB/sensor interface */ 69 1.9.2.2 mjf #define PSEYE_SCCB_ADDRESS 0xf1 70 1.9.2.2 mjf #define PSEYE_SCCB_SUBADDR 0xf2 71 1.9.2.2 mjf #define PSEYE_SCCB_WRITE 0xf3 72 1.9.2.2 mjf #define PSEYE_SCCB_READ 0xf4 73 1.9.2.2 mjf #define PSEYE_SCCB_OPERATION 0xf5 74 1.9.2.2 mjf #define PSEYE_SCCB_STATUS 0xf6 75 1.9.2.2 mjf 76 1.9.2.2 mjf #define PSEYE_SCCB_OP_WRITE_3 0x37 77 1.9.2.2 mjf #define PSEYE_SCCB_OP_WRITE_2 0x33 78 1.9.2.2 mjf #define PSEYE_SCCB_OP_READ_2 0xf9 79 1.9.2.2 mjf 80 1.9.2.2 mjf struct pseye_softc { 81 1.9.2.2 mjf USBBASEDEVICE sc_dev; 82 1.9.2.2 mjf 83 1.9.2.2 mjf usbd_device_handle sc_udev; 84 1.9.2.2 mjf usbd_interface_handle sc_iface; 85 1.9.2.2 mjf 86 1.9.2.2 mjf device_t sc_videodev; 87 1.9.2.2 mjf char sc_running; 88 1.9.2.2 mjf 89 1.9.2.2 mjf kcondvar_t sc_cv; 90 1.9.2.2 mjf kmutex_t sc_mtx; 91 1.9.2.2 mjf 92 1.9.2.2 mjf usbd_pipe_handle sc_bulkin_pipe; 93 1.9.2.2 mjf usbd_xfer_handle sc_bulkin_xfer; 94 1.9.2.2 mjf int sc_bulkin; 95 1.9.2.2 mjf uint8_t *sc_bulkin_buffer; 96 1.9.2.2 mjf int sc_bulkin_bufferlen; 97 1.9.2.2 mjf 98 1.9.2.2 mjf char sc_dying; 99 1.9.2.2 mjf }; 100 1.9.2.2 mjf 101 1.9.2.2 mjf static int pseye_match(device_t, cfdata_t, void *); 102 1.9.2.2 mjf static void pseye_attach(device_t, device_t, void *); 103 1.9.2.2 mjf static int pseye_detach(device_t, int); 104 1.9.2.2 mjf static void pseye_childdet(device_t, device_t); 105 1.9.2.2 mjf static int pseye_activate(device_t, enum devact); 106 1.9.2.2 mjf 107 1.9.2.2 mjf static void pseye_init(struct pseye_softc *); 108 1.9.2.2 mjf static void pseye_sccb_init(struct pseye_softc *); 109 1.9.2.2 mjf static void pseye_stop(struct pseye_softc *); 110 1.9.2.2 mjf static void pseye_start(struct pseye_softc *); 111 1.9.2.2 mjf static void pseye_led(struct pseye_softc *, bool); 112 1.9.2.2 mjf static uint8_t pseye_getreg(struct pseye_softc *, uint16_t); 113 1.9.2.2 mjf static void pseye_setreg(struct pseye_softc *, uint16_t, uint8_t); 114 1.9.2.2 mjf static void pseye_setregv(struct pseye_softc *, uint16_t, uint8_t); 115 1.9.2.2 mjf static void pseye_sccb_setreg(struct pseye_softc *, uint8_t, uint8_t); 116 1.9.2.2 mjf static bool pseye_sccb_status(struct pseye_softc *); 117 1.9.2.2 mjf 118 1.9.2.2 mjf static int pseye_init_pipes(struct pseye_softc *); 119 1.9.2.2 mjf static int pseye_close_pipes(struct pseye_softc *); 120 1.9.2.2 mjf 121 1.9.2.2 mjf static usbd_status pseye_get_frame(struct pseye_softc *); 122 1.9.2.2 mjf 123 1.9.2.2 mjf /* video(9) API */ 124 1.9.2.2 mjf static int pseye_open(void *, int); 125 1.9.2.2 mjf static void pseye_close(void *); 126 1.9.2.2 mjf static const char * pseye_get_devname(void *); 127 1.9.2.2 mjf static int pseye_enum_format(void *, uint32_t, 128 1.9.2.2 mjf struct video_format *); 129 1.9.2.2 mjf static int pseye_get_format(void *, struct video_format *); 130 1.9.2.2 mjf static int pseye_set_format(void *, struct video_format *); 131 1.9.2.2 mjf static int pseye_try_format(void *, struct video_format *); 132 1.9.2.2 mjf static int pseye_start_transfer(void *); 133 1.9.2.2 mjf static int pseye_stop_transfer(void *); 134 1.9.2.2 mjf 135 1.9.2.2 mjf CFATTACH_DECL2_NEW(pseye, sizeof(struct pseye_softc), 136 1.9.2.2 mjf pseye_match, pseye_attach, pseye_detach, pseye_activate, 137 1.9.2.2 mjf NULL, pseye_childdet); 138 1.9.2.2 mjf 139 1.9.2.2 mjf static const struct video_hw_if pseye_hw_if = { 140 1.9.2.2 mjf .open = pseye_open, 141 1.9.2.2 mjf .close = pseye_close, 142 1.9.2.2 mjf .get_devname = pseye_get_devname, 143 1.9.2.2 mjf .enum_format = pseye_enum_format, 144 1.9.2.2 mjf .get_format = pseye_get_format, 145 1.9.2.2 mjf .set_format = pseye_set_format, 146 1.9.2.2 mjf .try_format = pseye_try_format, 147 1.9.2.2 mjf .start_transfer = pseye_start_transfer, 148 1.9.2.2 mjf .stop_transfer = pseye_stop_transfer, 149 1.9.2.2 mjf .control_iter_init = NULL, 150 1.9.2.2 mjf .control_iter_next = NULL, 151 1.9.2.2 mjf .get_control_desc_group = NULL, 152 1.9.2.2 mjf .get_control_group = NULL, 153 1.9.2.2 mjf .set_control_group = NULL, 154 1.9.2.2 mjf }; 155 1.9.2.2 mjf 156 1.9.2.2 mjf USB_MATCH(pseye) 157 1.9.2.2 mjf { 158 1.9.2.2 mjf USB_IFMATCH_START(pseye, uaa); 159 1.9.2.2 mjf 160 1.9.2.2 mjf if (uaa->class != UICLASS_VENDOR) 161 1.9.2.2 mjf return UMATCH_NONE; 162 1.9.2.2 mjf 163 1.9.2.2 mjf if (uaa->vendor == USB_VENDOR_OMNIVISION2) { 164 1.9.2.2 mjf switch (uaa->product) { 165 1.9.2.2 mjf case USB_PRODUCT_OMNIVISION2_PSEYE: 166 1.9.2.2 mjf if (uaa->ifaceno != 0) 167 1.9.2.2 mjf return UMATCH_NONE; 168 1.9.2.2 mjf return UMATCH_VENDOR_PRODUCT; 169 1.9.2.2 mjf } 170 1.9.2.2 mjf } 171 1.9.2.2 mjf 172 1.9.2.2 mjf return UMATCH_NONE; 173 1.9.2.2 mjf } 174 1.9.2.2 mjf 175 1.9.2.2 mjf USB_ATTACH(pseye) 176 1.9.2.2 mjf { 177 1.9.2.2 mjf USB_IFATTACH_START(pseye, sc, uaa); 178 1.9.2.2 mjf usbd_device_handle dev = uaa->device; 179 1.9.2.2 mjf usb_interface_descriptor_t *id = NULL; 180 1.9.2.2 mjf usb_endpoint_descriptor_t *ed = NULL, *ed_bulkin = NULL; 181 1.9.2.2 mjf char *devinfo; 182 1.9.2.2 mjf int i; 183 1.9.2.2 mjf 184 1.9.2.2 mjf USB_ATTACH_SETUP; 185 1.9.2.2 mjf devinfo = usbd_devinfo_alloc(dev, 0); 186 1.9.2.2 mjf aprint_normal_dev(self, "%s\n", devinfo); 187 1.9.2.2 mjf usbd_devinfo_free(devinfo); 188 1.9.2.2 mjf 189 1.9.2.2 mjf sc->sc_dev = self; 190 1.9.2.2 mjf sc->sc_udev = dev; 191 1.9.2.2 mjf sc->sc_iface = uaa->iface; 192 1.9.2.2 mjf sc->sc_bulkin_bufferlen = PSEYE_BULKIN_BUFLEN; 193 1.9.2.2 mjf 194 1.9.2.2 mjf sc->sc_dying = sc->sc_running = 0; 195 1.9.2.2 mjf cv_init(&sc->sc_cv, device_xname(self)); 196 1.9.2.2 mjf mutex_init(&sc->sc_mtx, MUTEX_DEFAULT, IPL_NONE); 197 1.9.2.2 mjf 198 1.9.2.2 mjf id = usbd_get_interface_descriptor(sc->sc_iface); 199 1.9.2.2 mjf if (id == NULL) { 200 1.9.2.2 mjf aprint_error_dev(self, "failed to get interface descriptor\n"); 201 1.9.2.2 mjf sc->sc_dying = 1; 202 1.9.2.2 mjf USB_ATTACH_ERROR_RETURN; 203 1.9.2.2 mjf } 204 1.9.2.2 mjf 205 1.9.2.2 mjf for (i = 0; i < id->bNumEndpoints; i++) { 206 1.9.2.2 mjf ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i); 207 1.9.2.2 mjf if (ed == NULL) { 208 1.9.2.2 mjf aprint_error_dev(self, "couldn't get ep %d\n", i); 209 1.9.2.2 mjf sc->sc_dying = 1; 210 1.9.2.2 mjf USB_ATTACH_ERROR_RETURN; 211 1.9.2.2 mjf } 212 1.9.2.2 mjf 213 1.9.2.2 mjf if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN && 214 1.9.2.2 mjf UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) { 215 1.9.2.2 mjf ed_bulkin = ed; 216 1.9.2.2 mjf break; 217 1.9.2.2 mjf } 218 1.9.2.2 mjf } 219 1.9.2.2 mjf 220 1.9.2.2 mjf if (ed_bulkin == NULL) { 221 1.9.2.2 mjf aprint_error_dev(self, "no bulk-in endpoint found\n"); 222 1.9.2.2 mjf sc->sc_dying = 1; 223 1.9.2.2 mjf USB_ATTACH_ERROR_RETURN; 224 1.9.2.2 mjf } 225 1.9.2.2 mjf 226 1.9.2.2 mjf sc->sc_bulkin = ed_bulkin->bEndpointAddress; 227 1.9.2.2 mjf 228 1.9.2.2 mjf sc->sc_bulkin_xfer = usbd_alloc_xfer(sc->sc_udev); 229 1.9.2.2 mjf if (sc->sc_bulkin_xfer == NULL) { 230 1.9.2.2 mjf sc->sc_dying = 1; 231 1.9.2.2 mjf USB_ATTACH_ERROR_RETURN; 232 1.9.2.2 mjf } 233 1.9.2.2 mjf sc->sc_bulkin_buffer = usbd_alloc_buffer(sc->sc_bulkin_xfer, 234 1.9.2.2 mjf sc->sc_bulkin_bufferlen); 235 1.9.2.2 mjf if (sc->sc_bulkin_buffer == NULL) { 236 1.9.2.2 mjf usbd_free_xfer(sc->sc_bulkin_xfer); 237 1.9.2.2 mjf sc->sc_bulkin_xfer = NULL; 238 1.9.2.2 mjf sc->sc_dying = 1; 239 1.9.2.2 mjf USB_ATTACH_ERROR_RETURN; 240 1.9.2.2 mjf } 241 1.9.2.2 mjf 242 1.9.2.2 mjf pseye_init(sc); 243 1.9.2.2 mjf 244 1.9.2.2 mjf if (!pmf_device_register(self, NULL, NULL)) 245 1.9.2.2 mjf aprint_error_dev(self, "couldn't establish power handler\n"); 246 1.9.2.2 mjf 247 1.9.2.2 mjf sc->sc_videodev = video_attach_mi(&pseye_hw_if, self); 248 1.9.2.2 mjf if (sc->sc_videodev == NULL) { 249 1.9.2.2 mjf aprint_error_dev(self, "couldn't attach video layer\n"); 250 1.9.2.2 mjf sc->sc_dying = 1; 251 1.9.2.2 mjf USB_ATTACH_ERROR_RETURN; 252 1.9.2.2 mjf } 253 1.9.2.2 mjf 254 1.9.2.2 mjf usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, 255 1.9.2.2 mjf USBDEV(self)); 256 1.9.2.2 mjf 257 1.9.2.2 mjf USB_ATTACH_SUCCESS_RETURN; 258 1.9.2.2 mjf } 259 1.9.2.2 mjf 260 1.9.2.2 mjf USB_DETACH(pseye) 261 1.9.2.2 mjf { 262 1.9.2.2 mjf USB_DETACH_START(pseye, sc); 263 1.9.2.2 mjf 264 1.9.2.2 mjf sc->sc_dying = 1; 265 1.9.2.2 mjf 266 1.9.2.2 mjf pmf_device_deregister(self); 267 1.9.2.2 mjf 268 1.9.2.2 mjf if (sc->sc_videodev != NULL) { 269 1.9.2.2 mjf config_detach(sc->sc_videodev, flags); 270 1.9.2.2 mjf sc->sc_videodev = NULL; 271 1.9.2.2 mjf } 272 1.9.2.2 mjf 273 1.9.2.2 mjf if (sc->sc_bulkin_xfer != NULL) { 274 1.9.2.2 mjf usbd_free_xfer(sc->sc_bulkin_xfer); 275 1.9.2.2 mjf sc->sc_bulkin_xfer = NULL; 276 1.9.2.2 mjf } 277 1.9.2.2 mjf 278 1.9.2.2 mjf if (sc->sc_bulkin_pipe != NULL) { 279 1.9.2.2 mjf usbd_abort_pipe(sc->sc_bulkin_pipe); 280 1.9.2.2 mjf sc->sc_bulkin_pipe = NULL; 281 1.9.2.2 mjf } 282 1.9.2.2 mjf 283 1.9.2.2 mjf mutex_enter(&sc->sc_mtx); 284 1.9.2.2 mjf if (sc->sc_running) { 285 1.9.2.2 mjf sc->sc_running = 0; 286 1.9.2.2 mjf cv_wait_sig(&sc->sc_cv, &sc->sc_mtx); 287 1.9.2.2 mjf } 288 1.9.2.2 mjf mutex_exit(&sc->sc_mtx); 289 1.9.2.2 mjf 290 1.9.2.2 mjf cv_destroy(&sc->sc_cv); 291 1.9.2.2 mjf mutex_destroy(&sc->sc_mtx); 292 1.9.2.2 mjf 293 1.9.2.2 mjf usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, 294 1.9.2.2 mjf USBDEV(sc->sc_dev)); 295 1.9.2.2 mjf 296 1.9.2.2 mjf return 0; 297 1.9.2.2 mjf } 298 1.9.2.2 mjf 299 1.9.2.2 mjf int 300 1.9.2.2 mjf pseye_activate(device_ptr_t self, enum devact act) 301 1.9.2.2 mjf { 302 1.9.2.2 mjf struct pseye_softc *sc = device_private(self); 303 1.9.2.2 mjf int rv; 304 1.9.2.2 mjf 305 1.9.2.2 mjf rv = 0; 306 1.9.2.2 mjf 307 1.9.2.2 mjf switch (act) { 308 1.9.2.2 mjf case DVACT_ACTIVATE: 309 1.9.2.2 mjf break; 310 1.9.2.2 mjf case DVACT_DEACTIVATE: 311 1.9.2.2 mjf sc->sc_dying = 1; 312 1.9.2.2 mjf break; 313 1.9.2.2 mjf } 314 1.9.2.2 mjf 315 1.9.2.2 mjf return rv; 316 1.9.2.2 mjf } 317 1.9.2.2 mjf 318 1.9.2.2 mjf static void 319 1.9.2.2 mjf pseye_childdet(device_t self, device_t child) 320 1.9.2.2 mjf { 321 1.9.2.2 mjf struct pseye_softc *sc = device_private(self); 322 1.9.2.2 mjf 323 1.9.2.2 mjf if (sc->sc_videodev) { 324 1.9.2.2 mjf KASSERT(sc->sc_videodev == child); 325 1.9.2.2 mjf sc->sc_videodev = NULL; 326 1.9.2.2 mjf } 327 1.9.2.2 mjf } 328 1.9.2.2 mjf 329 1.9.2.2 mjf /* 330 1.9.2.2 mjf * Device access 331 1.9.2.2 mjf */ 332 1.9.2.2 mjf 333 1.9.2.2 mjf static void 334 1.9.2.2 mjf pseye_init(struct pseye_softc *sc) 335 1.9.2.2 mjf { 336 1.9.2.2 mjf pseye_sccb_init(sc); 337 1.9.2.2 mjf 338 1.9.2.2 mjf pseye_setregv(sc, 0xc2, 0x0c); 339 1.9.2.2 mjf pseye_setregv(sc, 0x88, 0xf8); 340 1.9.2.2 mjf pseye_setregv(sc, 0xc3, 0x69); 341 1.9.2.2 mjf pseye_setregv(sc, 0x89, 0xff); 342 1.9.2.2 mjf pseye_setregv(sc, 0x76, 0x03); 343 1.9.2.2 mjf pseye_setregv(sc, 0x92, 0x01); 344 1.9.2.2 mjf pseye_setregv(sc, 0x93, 0x18); 345 1.9.2.2 mjf pseye_setregv(sc, 0x94, 0x10); 346 1.9.2.2 mjf pseye_setregv(sc, 0x95, 0x10); 347 1.9.2.2 mjf pseye_setregv(sc, 0xe2, 0x00); 348 1.9.2.2 mjf pseye_setregv(sc, 0xe7, 0x3e); 349 1.9.2.2 mjf 350 1.9.2.2 mjf pseye_setreg(sc, 0x1c, 0x0a); 351 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0x22); 352 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0x06); 353 1.9.2.2 mjf pseye_setregv(sc, 0x96, 0x00); 354 1.9.2.2 mjf 355 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x20); 356 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x20); 357 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x20); 358 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x0a); 359 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x3f); 360 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x4a); 361 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x20); 362 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x15); 363 1.9.2.2 mjf pseye_setreg(sc, 0x97, 0x0b); 364 1.9.2.2 mjf 365 1.9.2.2 mjf pseye_setregv(sc, 0x8e, 0x40); 366 1.9.2.2 mjf pseye_setregv(sc, 0x1f, 0x81); 367 1.9.2.2 mjf pseye_setregv(sc, 0x34, 0x05); 368 1.9.2.2 mjf pseye_setregv(sc, 0xe3, 0x04); 369 1.9.2.2 mjf pseye_setregv(sc, 0x88, 0x00); 370 1.9.2.2 mjf pseye_setregv(sc, 0x89, 0x00); 371 1.9.2.2 mjf pseye_setregv(sc, 0x76, 0x00); 372 1.9.2.2 mjf pseye_setregv(sc, 0xe7, 0x2e); 373 1.9.2.2 mjf pseye_setregv(sc, 0x31, 0xf9); 374 1.9.2.2 mjf pseye_setregv(sc, 0x25, 0x42); 375 1.9.2.2 mjf pseye_setregv(sc, 0x21, 0xf0); 376 1.9.2.2 mjf 377 1.9.2.2 mjf pseye_setreg(sc, 0x1c, 0x00); 378 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0x40); 379 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0x02); 380 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0x00); 381 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0x02); 382 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0x57); 383 1.9.2.2 mjf pseye_setreg(sc, 0x1d, 0xff); 384 1.9.2.2 mjf 385 1.9.2.2 mjf pseye_setregv(sc, 0x8d, 0x1c); 386 1.9.2.2 mjf pseye_setregv(sc, 0x8e, 0x80); 387 1.9.2.2 mjf pseye_setregv(sc, 0xe5, 0x04); 388 1.9.2.2 mjf 389 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x12, 0x80); 390 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 391 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 392 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 393 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 394 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 395 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 396 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 397 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 398 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 399 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 400 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 401 1.9.2.2 mjf 402 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x3d, 0x03); 403 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x17, 0x26); 404 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x18, 0xa0); 405 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x19, 0x07); 406 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x1a, 0xf0); 407 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x32, 0x00); 408 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x29, 0xa0); 409 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x2c, 0xf0); 410 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x65, 0x20); 411 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 412 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x42, 0x7f); 413 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x63, 0xe0); 414 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x64, 0xff); 415 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x66, 0x00); 416 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x13, 0xf0); 417 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x0d, 0x41); 418 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x0f, 0xc5); 419 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x14, 0x11); 420 1.9.2.2 mjf 421 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x22, 0x7f); 422 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x23, 0x03); 423 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x24, 0x40); 424 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x25, 0x30); 425 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x26, 0xa1); 426 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x2a, 0x00); 427 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x2b, 0x00); 428 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x6b, 0xaa); 429 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x13, 0xff); 430 1.9.2.2 mjf 431 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x90, 0x05); 432 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x91, 0x01); 433 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x92, 0x03); 434 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x93, 0x00); 435 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x94, 0x60); 436 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x95, 0x3c); 437 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x96, 0x24); 438 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x97, 0x1e); 439 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x98, 0x62); 440 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x99, 0x80); 441 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x9a, 0x1e); 442 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x9b, 0x08); 443 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x9c, 0x20); 444 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x9e, 0x81); 445 1.9.2.2 mjf 446 1.9.2.2 mjf pseye_sccb_setreg(sc, 0xa6, 0x04); 447 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x7e, 0x0c); 448 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x7f, 0x16); 449 1.9.2.2 mjf 450 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x80, 0x2a); 451 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x81, 0x4e); 452 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x82, 0x61); 453 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x83, 0x6f); 454 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x84, 0x7b); 455 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x85, 0x86); 456 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x86, 0x8e); 457 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x87, 0x97); 458 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x88, 0xa4); 459 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x89, 0xaf); 460 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x8a, 0xc5); 461 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x8b, 0xd7); 462 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x8c, 0xe8); 463 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x8d, 0x20); 464 1.9.2.2 mjf 465 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x0c, 0x90); 466 1.9.2.2 mjf 467 1.9.2.2 mjf pseye_setregv(sc, 0xc0, 0x50); 468 1.9.2.2 mjf pseye_setregv(sc, 0xc1, 0x3c); 469 1.9.2.2 mjf pseye_setregv(sc, 0xc2, 0x0c); 470 1.9.2.2 mjf 471 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x2b, 0x00); 472 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x22, 0x7f); 473 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x23, 0x03); 474 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x11, 0x01); 475 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x0c, 0xd0); 476 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x64, 0xff); 477 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x0d, 0x41); 478 1.9.2.2 mjf 479 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x14, 0x41); 480 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x0e, 0xcd); 481 1.9.2.2 mjf pseye_sccb_setreg(sc, 0xac, 0xbf); 482 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x8e, 0x00); 483 1.9.2.2 mjf pseye_sccb_setreg(sc, 0x0c, 0xd0); 484 1.9.2.2 mjf 485 1.9.2.2 mjf pseye_stop(sc); 486 1.9.2.2 mjf } 487 1.9.2.2 mjf 488 1.9.2.2 mjf static void 489 1.9.2.2 mjf pseye_sccb_init(struct pseye_softc *sc) 490 1.9.2.2 mjf { 491 1.9.2.2 mjf pseye_setregv(sc, 0xe7, 0x3a); 492 1.9.2.2 mjf pseye_setreg(sc, PSEYE_SCCB_ADDRESS, 0x60); 493 1.9.2.2 mjf pseye_setreg(sc, PSEYE_SCCB_ADDRESS, 0x60); 494 1.9.2.2 mjf pseye_setreg(sc, PSEYE_SCCB_ADDRESS, 0x60); 495 1.9.2.2 mjf pseye_setreg(sc, PSEYE_SCCB_ADDRESS, 0x42); 496 1.9.2.2 mjf } 497 1.9.2.2 mjf 498 1.9.2.2 mjf static void 499 1.9.2.2 mjf pseye_stop(struct pseye_softc *sc) 500 1.9.2.2 mjf { 501 1.9.2.2 mjf pseye_led(sc, false); 502 1.9.2.2 mjf pseye_setreg(sc, 0xe0, 0x09); 503 1.9.2.2 mjf } 504 1.9.2.2 mjf 505 1.9.2.2 mjf static void 506 1.9.2.2 mjf pseye_start(struct pseye_softc *sc) 507 1.9.2.2 mjf { 508 1.9.2.2 mjf pseye_led(sc, true); 509 1.9.2.2 mjf pseye_setreg(sc, 0xe0, 0x00); 510 1.9.2.2 mjf } 511 1.9.2.2 mjf 512 1.9.2.2 mjf static void 513 1.9.2.2 mjf pseye_led(struct pseye_softc *sc, bool enabled) 514 1.9.2.2 mjf { 515 1.9.2.2 mjf uint8_t val; 516 1.9.2.2 mjf 517 1.9.2.2 mjf val = pseye_getreg(sc, 0x21); 518 1.9.2.2 mjf pseye_setreg(sc, 0x21, val | 0x80); 519 1.9.2.2 mjf 520 1.9.2.2 mjf val = pseye_getreg(sc, 0x23); 521 1.9.2.2 mjf if (enabled == true) 522 1.9.2.2 mjf val |= 0x80; 523 1.9.2.2 mjf else 524 1.9.2.2 mjf val &= ~0x80; 525 1.9.2.2 mjf pseye_setreg(sc, 0x23, val); 526 1.9.2.2 mjf } 527 1.9.2.2 mjf 528 1.9.2.2 mjf static uint8_t 529 1.9.2.2 mjf pseye_getreg(struct pseye_softc *sc, uint16_t reg) 530 1.9.2.2 mjf { 531 1.9.2.2 mjf usb_device_request_t req; 532 1.9.2.2 mjf usbd_status err; 533 1.9.2.2 mjf uint8_t buf; 534 1.9.2.2 mjf 535 1.9.2.2 mjf req.bmRequestType = UT_READ_VENDOR_DEVICE; 536 1.9.2.2 mjf req.bRequest = 1; 537 1.9.2.2 mjf USETW(req.wValue, 0x0000); 538 1.9.2.2 mjf USETW(req.wIndex, reg); 539 1.9.2.2 mjf USETW(req.wLength, 1); 540 1.9.2.2 mjf 541 1.9.2.2 mjf err = usbd_do_request(sc->sc_udev, &req, &buf); 542 1.9.2.2 mjf if (err) { 543 1.9.2.2 mjf aprint_error_dev(sc->sc_dev, "couldn't read reg 0x%04x: %s\n", 544 1.9.2.2 mjf reg, usbd_errstr(err)); 545 1.9.2.2 mjf return 0xff; 546 1.9.2.2 mjf } 547 1.9.2.2 mjf 548 1.9.2.2 mjf return buf; 549 1.9.2.2 mjf } 550 1.9.2.2 mjf 551 1.9.2.2 mjf static void 552 1.9.2.2 mjf pseye_setreg(struct pseye_softc *sc, uint16_t reg, uint8_t val) 553 1.9.2.2 mjf { 554 1.9.2.2 mjf usb_device_request_t req; 555 1.9.2.2 mjf usbd_status err; 556 1.9.2.2 mjf 557 1.9.2.2 mjf req.bmRequestType = UT_WRITE_VENDOR_DEVICE; 558 1.9.2.2 mjf req.bRequest = 1; 559 1.9.2.2 mjf USETW(req.wValue, 0x0000); 560 1.9.2.2 mjf USETW(req.wIndex, reg); 561 1.9.2.2 mjf USETW(req.wLength, 1); 562 1.9.2.2 mjf 563 1.9.2.2 mjf err = usbd_do_request(sc->sc_udev, &req, &val); 564 1.9.2.2 mjf if (err) 565 1.9.2.2 mjf aprint_error_dev(sc->sc_dev, "couldn't write reg 0x%04x: %s\n", 566 1.9.2.2 mjf reg, usbd_errstr(err)); 567 1.9.2.2 mjf } 568 1.9.2.2 mjf 569 1.9.2.2 mjf static void 570 1.9.2.2 mjf pseye_setregv(struct pseye_softc *sc, uint16_t reg, uint8_t val) 571 1.9.2.2 mjf { 572 1.9.2.2 mjf pseye_setreg(sc, reg, val); 573 1.9.2.2 mjf if (pseye_getreg(sc, reg) != val) 574 1.9.2.2 mjf aprint_error_dev(sc->sc_dev, "couldn't verify reg 0x%04x\n", 575 1.9.2.2 mjf reg); 576 1.9.2.2 mjf } 577 1.9.2.2 mjf 578 1.9.2.2 mjf static void 579 1.9.2.2 mjf pseye_sccb_setreg(struct pseye_softc *sc, uint8_t reg, uint8_t val) 580 1.9.2.2 mjf { 581 1.9.2.2 mjf pseye_setreg(sc, PSEYE_SCCB_SUBADDR, reg); 582 1.9.2.2 mjf pseye_setreg(sc, PSEYE_SCCB_WRITE, val); 583 1.9.2.2 mjf pseye_setreg(sc, PSEYE_SCCB_OPERATION, PSEYE_SCCB_OP_WRITE_3); 584 1.9.2.2 mjf 585 1.9.2.2 mjf if (pseye_sccb_status(sc) == false) 586 1.9.2.2 mjf aprint_error_dev(sc->sc_dev, "couldn't write sccb reg 0x%04x\n", 587 1.9.2.2 mjf reg); 588 1.9.2.2 mjf } 589 1.9.2.2 mjf 590 1.9.2.2 mjf static bool 591 1.9.2.2 mjf pseye_sccb_status(struct pseye_softc *sc) 592 1.9.2.2 mjf { 593 1.9.2.2 mjf int retry = 5; 594 1.9.2.2 mjf uint8_t reg; 595 1.9.2.2 mjf 596 1.9.2.2 mjf while (retry-- >= 0) { 597 1.9.2.2 mjf reg = pseye_getreg(sc, PSEYE_SCCB_STATUS); 598 1.9.2.2 mjf if (reg == 0x00) 599 1.9.2.2 mjf return true; 600 1.9.2.2 mjf else if (reg == 0x04) 601 1.9.2.2 mjf return false; 602 1.9.2.2 mjf } 603 1.9.2.2 mjf 604 1.9.2.2 mjf aprint_error_dev(sc->sc_dev, "timeout reading sccb status\n"); 605 1.9.2.2 mjf return false; 606 1.9.2.2 mjf } 607 1.9.2.2 mjf 608 1.9.2.2 mjf static usbd_status 609 1.9.2.2 mjf pseye_get_frame(struct pseye_softc *sc) 610 1.9.2.2 mjf { 611 1.9.2.2 mjf uint32_t len = sc->sc_bulkin_bufferlen; 612 1.9.2.2 mjf 613 1.9.2.2 mjf if (sc->sc_dying) 614 1.9.2.2 mjf return USBD_IOERROR; 615 1.9.2.2 mjf 616 1.9.2.2 mjf return usbd_bulk_transfer(sc->sc_bulkin_xfer, sc->sc_bulkin_pipe, 617 1.9.2.2 mjf USBD_SHORT_XFER_OK|USBD_NO_COPY, 50, 618 1.9.2.2 mjf sc->sc_bulkin_buffer, &len, "pseyerb"); 619 1.9.2.2 mjf } 620 1.9.2.2 mjf 621 1.9.2.2 mjf static int 622 1.9.2.2 mjf pseye_init_pipes(struct pseye_softc *sc) 623 1.9.2.2 mjf { 624 1.9.2.2 mjf usbd_status err; 625 1.9.2.2 mjf 626 1.9.2.2 mjf if (sc->sc_dying) 627 1.9.2.2 mjf return EIO; 628 1.9.2.2 mjf 629 1.9.2.2 mjf err = usbd_open_pipe(sc->sc_iface, sc->sc_bulkin, 0, 630 1.9.2.2 mjf &sc->sc_bulkin_pipe); 631 1.9.2.2 mjf if (err) { 632 1.9.2.2 mjf aprint_error_dev(sc->sc_dev, "couldn't open bulk-in pipe: %s\n", 633 1.9.2.2 mjf usbd_errstr(err)); 634 1.9.2.2 mjf return ENOMEM; 635 1.9.2.2 mjf } 636 1.9.2.2 mjf 637 1.9.2.2 mjf pseye_start(sc); 638 1.9.2.2 mjf 639 1.9.2.2 mjf return 0; 640 1.9.2.2 mjf } 641 1.9.2.2 mjf 642 1.9.2.2 mjf int 643 1.9.2.2 mjf pseye_close_pipes(struct pseye_softc *sc) 644 1.9.2.2 mjf { 645 1.9.2.2 mjf if (sc->sc_bulkin_pipe != NULL) { 646 1.9.2.2 mjf usbd_abort_pipe(sc->sc_bulkin_pipe); 647 1.9.2.2 mjf usbd_close_pipe(sc->sc_bulkin_pipe); 648 1.9.2.2 mjf sc->sc_bulkin_pipe = NULL; 649 1.9.2.2 mjf } 650 1.9.2.2 mjf 651 1.9.2.2 mjf pseye_stop(sc); 652 1.9.2.2 mjf 653 1.9.2.2 mjf return 0; 654 1.9.2.2 mjf } 655 1.9.2.2 mjf 656 1.9.2.2 mjf static void 657 1.9.2.2 mjf pseye_transfer_thread(void *opaque) 658 1.9.2.2 mjf { 659 1.9.2.2 mjf struct pseye_softc *sc = opaque; 660 1.9.2.2 mjf int error; 661 1.9.2.2 mjf struct video_payload payload; 662 1.9.2.2 mjf 663 1.9.2.2 mjf payload.frameno = 0; 664 1.9.2.2 mjf 665 1.9.2.2 mjf while (sc->sc_running) { 666 1.9.2.2 mjf error = pseye_get_frame(sc); 667 1.9.2.2 mjf if (error == USBD_NORMAL_COMPLETION) { 668 1.9.2.2 mjf payload.data = sc->sc_bulkin_buffer; 669 1.9.2.2 mjf payload.size = sc->sc_bulkin_bufferlen; 670 1.9.2.2 mjf payload.frameno = (payload.frameno + 1) & 1; 671 1.9.2.2 mjf payload.end_of_frame = 1; 672 1.9.2.2 mjf video_submit_payload(sc->sc_videodev, &payload); 673 1.9.2.2 mjf } 674 1.9.2.2 mjf } 675 1.9.2.2 mjf 676 1.9.2.2 mjf mutex_enter(&sc->sc_mtx); 677 1.9.2.2 mjf cv_broadcast(&sc->sc_cv); 678 1.9.2.2 mjf mutex_exit(&sc->sc_mtx); 679 1.9.2.2 mjf 680 1.9.2.2 mjf kthread_exit(0); 681 1.9.2.2 mjf } 682 1.9.2.2 mjf 683 1.9.2.2 mjf /* video(9) API implementations */ 684 1.9.2.2 mjf static int 685 1.9.2.2 mjf pseye_open(void *opaque, int flags) 686 1.9.2.2 mjf { 687 1.9.2.2 mjf struct pseye_softc *sc = opaque; 688 1.9.2.2 mjf 689 1.9.2.2 mjf if (sc->sc_dying) 690 1.9.2.2 mjf return EIO; 691 1.9.2.2 mjf 692 1.9.2.2 mjf return pseye_init_pipes(sc); 693 1.9.2.2 mjf } 694 1.9.2.2 mjf 695 1.9.2.2 mjf static void 696 1.9.2.2 mjf pseye_close(void *opaque) 697 1.9.2.2 mjf { 698 1.9.2.2 mjf struct pseye_softc *sc = opaque; 699 1.9.2.2 mjf 700 1.9.2.2 mjf pseye_close_pipes(sc); 701 1.9.2.2 mjf } 702 1.9.2.2 mjf 703 1.9.2.2 mjf static const char * 704 1.9.2.2 mjf pseye_get_devname(void *opaque) 705 1.9.2.2 mjf { 706 1.9.2.2 mjf return "PLAYSTATION(R) Eye"; 707 1.9.2.2 mjf } 708 1.9.2.2 mjf 709 1.9.2.2 mjf static int 710 1.9.2.2 mjf pseye_enum_format(void *opaque, uint32_t index, struct video_format *format) 711 1.9.2.2 mjf { 712 1.9.2.2 mjf if (index != 0) 713 1.9.2.2 mjf return EINVAL; 714 1.9.2.2 mjf return pseye_get_format(opaque, format); 715 1.9.2.2 mjf } 716 1.9.2.2 mjf 717 1.9.2.2 mjf static int 718 1.9.2.2 mjf pseye_get_format(void *opaque, struct video_format *format) 719 1.9.2.2 mjf { 720 1.9.2.2 mjf format->pixel_format = VIDEO_FORMAT_YUY2; /* XXX actually YUYV */ 721 1.9.2.2 mjf format->width = 640; 722 1.9.2.2 mjf format->height = 480; 723 1.9.2.2 mjf format->aspect_x = 4; 724 1.9.2.2 mjf format->aspect_y = 3; 725 1.9.2.2 mjf format->sample_size = format->width * format->height * 2; 726 1.9.2.2 mjf format->stride = format->width * 2; 727 1.9.2.2 mjf format->color.primaries = VIDEO_COLOR_PRIMARIES_UNSPECIFIED; 728 1.9.2.2 mjf format->color.gamma_function = VIDEO_GAMMA_FUNCTION_UNSPECIFIED; 729 1.9.2.2 mjf format->color.matrix_coeff = VIDEO_MATRIX_COEFF_UNSPECIFIED; 730 1.9.2.2 mjf format->interlace_flags = VIDEO_INTERLACE_ON; 731 1.9.2.2 mjf format->priv = 0; 732 1.9.2.2 mjf 733 1.9.2.2 mjf return 0; 734 1.9.2.2 mjf } 735 1.9.2.2 mjf 736 1.9.2.2 mjf static int 737 1.9.2.2 mjf pseye_set_format(void *opaque, struct video_format *format) 738 1.9.2.2 mjf { 739 1.9.2.2 mjf #if notyet 740 1.9.2.2 mjf if (format->pixel_format != VIDEO_FORMAT_YUYV) 741 1.9.2.2 mjf return EINVAL; 742 1.9.2.2 mjf if (format->width != 640 || format->height != 480) 743 1.9.2.2 mjf return EINVAL; 744 1.9.2.2 mjf #endif 745 1.9.2.2 mjf /* XXX */ 746 1.9.2.2 mjf return pseye_get_format(opaque, format); 747 1.9.2.2 mjf } 748 1.9.2.2 mjf 749 1.9.2.2 mjf static int 750 1.9.2.2 mjf pseye_try_format(void *opaque, struct video_format *format) 751 1.9.2.2 mjf { 752 1.9.2.2 mjf return pseye_get_format(opaque, format); 753 1.9.2.2 mjf } 754 1.9.2.2 mjf 755 1.9.2.2 mjf static int 756 1.9.2.2 mjf pseye_start_transfer(void *opaque) 757 1.9.2.2 mjf { 758 1.9.2.2 mjf struct pseye_softc *sc = opaque; 759 1.9.2.2 mjf int err = 0; 760 1.9.2.2 mjf 761 1.9.2.2 mjf mutex_enter(&sc->sc_mtx); 762 1.9.2.2 mjf if (sc->sc_running == 0) { 763 1.9.2.2 mjf sc->sc_running = 1; 764 1.9.2.2 mjf err = kthread_create(PRI_PSEYE, 0, NULL, pseye_transfer_thread, 765 1.9.2.2 mjf opaque, NULL, device_xname(sc->sc_dev)); 766 1.9.2.2 mjf } else 767 1.9.2.2 mjf aprint_error_dev(sc->sc_dev, "transfer already in progress\n"); 768 1.9.2.2 mjf mutex_exit(&sc->sc_mtx); 769 1.9.2.2 mjf 770 1.9.2.2 mjf return err; 771 1.9.2.2 mjf } 772 1.9.2.2 mjf 773 1.9.2.2 mjf static int 774 1.9.2.2 mjf pseye_stop_transfer(void *opaque) 775 1.9.2.2 mjf { 776 1.9.2.2 mjf struct pseye_softc *sc = opaque; 777 1.9.2.2 mjf 778 1.9.2.2 mjf mutex_enter(&sc->sc_mtx); 779 1.9.2.2 mjf if (sc->sc_running) { 780 1.9.2.2 mjf sc->sc_running = 0; 781 1.9.2.2 mjf cv_wait_sig(&sc->sc_cv, &sc->sc_mtx); 782 1.9.2.2 mjf } 783 1.9.2.2 mjf mutex_exit(&sc->sc_mtx); 784 1.9.2.2 mjf 785 1.9.2.2 mjf return 0; 786 1.9.2.2 mjf } 787
Indexes created Thu Oct 02 14:10:14 GMT 2025