udsbr.c revision 1.16
11.16Splunky/* $NetBSD: udsbr.c,v 1.16 2009/09/23 19:07:19 plunky Exp $ */ 21.1Saugustss 31.1Saugustss/* 41.1Saugustss * Copyright (c) 2002 The NetBSD Foundation, Inc. 51.1Saugustss * All rights reserved. 61.1Saugustss * 71.1Saugustss * This code is derived from software contributed to The NetBSD Foundation 81.3Saugustss * by Lennart Augustsson (lennart@augustsson.net). 91.1Saugustss * 101.1Saugustss * Redistribution and use in source and binary forms, with or without 111.1Saugustss * modification, are permitted provided that the following conditions 121.1Saugustss * are met: 131.1Saugustss * 1. Redistributions of source code must retain the above copyright 141.1Saugustss * notice, this list of conditions and the following disclaimer. 151.1Saugustss * 2. Redistributions in binary form must reproduce the above copyright 161.1Saugustss * notice, this list of conditions and the following disclaimer in the 171.1Saugustss * documentation and/or other materials provided with the distribution. 181.1Saugustss * 191.1Saugustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 201.1Saugustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 211.1Saugustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 221.1Saugustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 231.1Saugustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 241.1Saugustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 251.1Saugustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 261.1Saugustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 271.1Saugustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 281.1Saugustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 291.1Saugustss * POSSIBILITY OF SUCH DAMAGE. 301.1Saugustss */ 311.1Saugustss 321.2Saugustss/* 331.2Saugustss * Driver for the D-Link DSB-R100 FM radio. 341.3Saugustss * I apologize for the magic hex constants, but this is what happens 351.2Saugustss * when you have to reverse engineer the driver. 361.2Saugustss * Parts of the code borrowed from Linux and parts from Warner Losh's 371.2Saugustss * FreeBSD driver. 381.2Saugustss */ 391.2Saugustss 401.1Saugustss#include <sys/cdefs.h> 411.16Splunky__KERNEL_RCSID(0, "$NetBSD: udsbr.c,v 1.16 2009/09/23 19:07:19 plunky Exp $"); 421.1Saugustss 431.1Saugustss#include <sys/param.h> 441.1Saugustss#include <sys/systm.h> 451.1Saugustss#include <sys/kernel.h> 461.1Saugustss#include <sys/device.h> 471.1Saugustss 481.1Saugustss#include <sys/radioio.h> 491.1Saugustss#include <dev/radio_if.h> 501.1Saugustss 511.1Saugustss#include <dev/usb/usb.h> 521.1Saugustss#include <dev/usb/usbdi.h> 531.1Saugustss#include <dev/usb/usbdi_util.h> 541.1Saugustss 551.1Saugustss#include <dev/usb/usbdevs.h> 561.1Saugustss 571.1Saugustss#ifdef UDSBR_DEBUG 581.1Saugustss#define DPRINTF(x) if (udsbrdebug) logprintf x 591.1Saugustss#define DPRINTFN(n,x) if (udsbrdebug>(n)) logprintf x 601.1Saugustssint udsbrdebug = 0; 611.1Saugustss#else 621.1Saugustss#define DPRINTF(x) 631.1Saugustss#define DPRINTFN(n,x) 641.1Saugustss#endif 651.1Saugustss 661.1Saugustss#define UDSBR_CONFIG_NO 1 671.1Saugustss 681.5SaugustssStatic int udsbr_get_info(void *, struct radio_info *); 691.5SaugustssStatic int udsbr_set_info(void *, struct radio_info *); 701.1Saugustss 711.9Syamtconst struct radio_hw_if udsbr_hw_if = { 721.1Saugustss NULL, /* open */ 731.1Saugustss NULL, /* close */ 741.1Saugustss udsbr_get_info, 751.1Saugustss udsbr_set_info, 761.1Saugustss NULL 771.1Saugustss}; 781.1Saugustss 791.1Saugustssstruct udsbr_softc { 801.1Saugustss USBBASEDEVICE sc_dev; 811.1Saugustss usbd_device_handle sc_udev; 821.1Saugustss 831.1Saugustss char sc_mute; 841.1Saugustss char sc_vol; 851.1Saugustss u_int32_t sc_freq; 861.1Saugustss 871.15Scube device_t sc_child; 881.1Saugustss 891.1Saugustss char sc_dying; 901.1Saugustss}; 911.1Saugustss 921.5SaugustssStatic int udsbr_req(struct udsbr_softc *sc, int ureq, int value, 931.5Saugustss int index); 941.5SaugustssStatic void udsbr_start(struct udsbr_softc *sc); 951.5SaugustssStatic void udsbr_stop(struct udsbr_softc *sc); 961.5SaugustssStatic void udsbr_setfreq(struct udsbr_softc *sc, int freq); 971.5SaugustssStatic int udsbr_status(struct udsbr_softc *sc); 981.1Saugustss 991.15Scubeint udsbr_match(device_t, cfdata_t, void *); 1001.13Sdyoungvoid udsbr_attach(device_t, device_t, void *); 1011.13Sdyoungvoid udsbr_childdet(device_t, device_t); 1021.13Sdyoungint udsbr_detach(device_t, int); 1031.13Sdyoungint udsbr_activate(device_t, enum devact); 1041.13Sdyoungextern struct cfdriver udsbr_cd; 1051.15ScubeCFATTACH_DECL2_NEW(udsbr, sizeof(struct udsbr_softc), udsbr_match, 1061.13Sdyoung udsbr_attach, udsbr_detach, udsbr_activate, NULL, udsbr_childdet); 1071.1Saugustss 1081.1SaugustssUSB_MATCH(udsbr) 1091.1Saugustss{ 1101.1Saugustss USB_MATCH_START(udsbr, uaa); 1111.1Saugustss 1121.1Saugustss DPRINTFN(50,("udsbr_match\n")); 1131.1Saugustss 1141.1Saugustss if (uaa->vendor != USB_VENDOR_CYPRESS || 1151.1Saugustss uaa->product != USB_PRODUCT_CYPRESS_FMRADIO) 1161.1Saugustss return (UMATCH_NONE); 1171.1Saugustss return (UMATCH_VENDOR_PRODUCT); 1181.1Saugustss} 1191.1Saugustss 1201.1SaugustssUSB_ATTACH(udsbr) 1211.1Saugustss{ 1221.1Saugustss USB_ATTACH_START(udsbr, sc, uaa); 1231.1Saugustss usbd_device_handle dev = uaa->device; 1241.10Saugustss char *devinfop; 1251.1Saugustss usbd_status err; 1261.1Saugustss 1271.1Saugustss DPRINTFN(10,("udsbr_attach: sc=%p\n", sc)); 1281.1Saugustss 1291.15Scube sc->sc_dev = self; 1301.15Scube 1311.16Splunky aprint_naive("\n"); 1321.16Splunky aprint_normal("\n"); 1331.16Splunky 1341.10Saugustss devinfop = usbd_devinfo_alloc(dev, 0); 1351.15Scube aprint_normal_dev(self, "%s\n", devinfop); 1361.10Saugustss usbd_devinfo_free(devinfop); 1371.1Saugustss 1381.1Saugustss err = usbd_set_config_no(dev, UDSBR_CONFIG_NO, 1); 1391.1Saugustss if (err) { 1401.15Scube aprint_error_dev(self, "setting config no failed\n"); 1411.1Saugustss USB_ATTACH_ERROR_RETURN; 1421.1Saugustss } 1431.1Saugustss 1441.1Saugustss sc->sc_udev = dev; 1451.1Saugustss 1461.1Saugustss DPRINTFN(10, ("udsbr_attach: %p\n", sc->sc_udev)); 1471.1Saugustss 1481.1Saugustss usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, 1491.1Saugustss USBDEV(sc->sc_dev)); 1501.1Saugustss 1511.1Saugustss sc->sc_child = radio_attach_mi(&udsbr_hw_if, sc, USBDEV(sc->sc_dev)); 1521.1Saugustss 1531.1Saugustss USB_ATTACH_SUCCESS_RETURN; 1541.1Saugustss} 1551.1Saugustss 1561.13Sdyoungvoid 1571.13Sdyoungudsbr_childdet(device_t self, device_t child) 1581.13Sdyoung{ 1591.13Sdyoung} 1601.13Sdyoung 1611.1SaugustssUSB_DETACH(udsbr) 1621.1Saugustss{ 1631.1Saugustss USB_DETACH_START(udsbr, sc); 1641.1Saugustss int rv = 0; 1651.1Saugustss 1661.1Saugustss if (sc->sc_child != NULL) 1671.1Saugustss rv = config_detach(sc->sc_child, flags); 1681.1Saugustss 1691.1Saugustss usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, 1701.1Saugustss USBDEV(sc->sc_dev)); 1711.1Saugustss 1721.1Saugustss return (rv); 1731.1Saugustss} 1741.1Saugustss 1751.1Saugustssint 1761.1Saugustssudsbr_activate(device_ptr_t self, enum devact act) 1771.1Saugustss{ 1781.15Scube struct udsbr_softc *sc = device_private(self); 1791.1Saugustss int rv = 0; 1801.1Saugustss 1811.1Saugustss switch (act) { 1821.1Saugustss case DVACT_ACTIVATE: 1831.1Saugustss return (EOPNOTSUPP); 1841.1Saugustss break; 1851.1Saugustss 1861.1Saugustss case DVACT_DEACTIVATE: 1871.1Saugustss sc->sc_dying = 1; 1881.1Saugustss if (sc->sc_child != NULL) 1891.1Saugustss rv = config_deactivate(sc->sc_child); 1901.1Saugustss break; 1911.1Saugustss } 1921.1Saugustss return (rv); 1931.1Saugustss} 1941.1Saugustss 1951.1Saugustssint 1961.1Saugustssudsbr_req(struct udsbr_softc *sc, int ureq, int value, int index) 1971.1Saugustss{ 1981.1Saugustss usb_device_request_t req; 1991.1Saugustss usbd_status err; 2001.1Saugustss u_char data; 2011.1Saugustss 2021.4Saugustss DPRINTFN(1,("udsbr_req: ureq=0x%02x value=0x%04x index=0x%04x\n", 2031.4Saugustss ureq, value, index)); 2041.1Saugustss req.bmRequestType = UT_READ_VENDOR_DEVICE; 2051.1Saugustss req.bRequest = ureq; 2061.1Saugustss USETW(req.wValue, value); 2071.1Saugustss USETW(req.wIndex, index); 2081.1Saugustss USETW(req.wLength, 1); 2091.1Saugustss err = usbd_do_request(sc->sc_udev, &req, &data); 2101.1Saugustss if (err) { 2111.15Scube aprint_error_dev(sc->sc_dev, "request failed err=%d\n", err); 2121.1Saugustss } 2131.1Saugustss return !(data & 1); 2141.1Saugustss} 2151.1Saugustss 2161.1Saugustssvoid 2171.1Saugustssudsbr_start(struct udsbr_softc *sc) 2181.1Saugustss{ 2191.1Saugustss (void)udsbr_req(sc, 0x00, 0x0000, 0x00c7); 2201.1Saugustss (void)udsbr_req(sc, 0x02, 0x0001, 0x0000); 2211.1Saugustss} 2221.1Saugustss 2231.1Saugustssvoid 2241.1Saugustssudsbr_stop(struct udsbr_softc *sc) 2251.1Saugustss{ 2261.1Saugustss (void)udsbr_req(sc, 0x00, 0x0016, 0x001c); 2271.1Saugustss (void)udsbr_req(sc, 0x02, 0x0000, 0x0000); 2281.1Saugustss} 2291.1Saugustss 2301.1Saugustssvoid 2311.1Saugustssudsbr_setfreq(struct udsbr_softc *sc, int freq) 2321.1Saugustss{ 2331.1Saugustss DPRINTF(("udsbr_setfreq: setfreq=%d\n", freq)); 2341.2Saugustss /* 2351.2Saugustss * Freq now is in Hz. We need to convert it to the frequency 2361.2Saugustss * that the radio wants. This frequency is 10.7MHz above 2371.2Saugustss * the actual frequency. We then need to convert to 2381.2Saugustss * units of 12.5kHz. We add one to the IFM to make rounding 2391.7Saugustss * easier. 2401.2Saugustss */ 2411.4Saugustss freq = (freq * 1000 + 10700001) / 12500; 2421.1Saugustss (void)udsbr_req(sc, 0x01, (freq >> 8) & 0xff, freq & 0xff); 2431.1Saugustss (void)udsbr_req(sc, 0x00, 0x0096, 0x00b7); 2441.4Saugustss usbd_delay_ms(sc->sc_udev, 240); /* wait for signal to settle */ 2451.1Saugustss} 2461.1Saugustss 2471.1Saugustssint 2481.1Saugustssudsbr_status(struct udsbr_softc *sc) 2491.1Saugustss{ 2501.1Saugustss return (udsbr_req(sc, 0x00, 0x0000, 0x0024)); 2511.1Saugustss} 2521.1Saugustss 2531.1Saugustss 2541.1Saugustssint 2551.1Saugustssudsbr_get_info(void *v, struct radio_info *ri) 2561.1Saugustss{ 2571.1Saugustss struct udsbr_softc *sc = v; 2581.1Saugustss 2591.1Saugustss ri->mute = sc->sc_mute; 2601.1Saugustss ri->volume = sc->sc_vol ? 255 : 0; 2611.1Saugustss ri->caps = RADIO_CAPS_DETECT_STEREO; 2621.1Saugustss ri->rfreq = 0; 2631.1Saugustss ri->lock = 0; 2641.1Saugustss ri->freq = sc->sc_freq; 2651.1Saugustss ri->info = udsbr_status(sc) ? RADIO_INFO_STEREO : 0; 2661.1Saugustss 2671.1Saugustss return (0); 2681.1Saugustss} 2691.1Saugustss 2701.1Saugustssint 2711.1Saugustssudsbr_set_info(void *v, struct radio_info *ri) 2721.1Saugustss{ 2731.1Saugustss struct udsbr_softc *sc = v; 2741.1Saugustss 2751.1Saugustss sc->sc_mute = ri->mute != 0; 2761.1Saugustss sc->sc_vol = ri->volume != 0; 2771.1Saugustss sc->sc_freq = ri->freq; 2781.1Saugustss udsbr_setfreq(sc, sc->sc_freq); 2791.1Saugustss 2801.1Saugustss if (sc->sc_mute || sc->sc_vol == 0) 2811.1Saugustss udsbr_stop(sc); 2821.1Saugustss else 2831.1Saugustss udsbr_start(sc); 2841.1Saugustss 2851.1Saugustss return (0); 2861.1Saugustss} 287