udsbr.c revision 1.23
1/* $NetBSD: udsbr.c,v 1.23 2016/04/23 10:15:32 skrll Exp $ */ 2 3/* 4 * Copyright (c) 2002 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Lennart Augustsson (lennart@augustsson.net). 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32/* 33 * Driver for the D-Link DSB-R100 FM radio. 34 * I apologize for the magic hex constants, but this is what happens 35 * when you have to reverse engineer the driver. 36 * Parts of the code borrowed from Linux and parts from Warner Losh's 37 * FreeBSD driver. 38 */ 39 40#include <sys/cdefs.h> 41__KERNEL_RCSID(0, "$NetBSD: udsbr.c,v 1.23 2016/04/23 10:15:32 skrll Exp $"); 42 43#include <sys/param.h> 44#include <sys/systm.h> 45#include <sys/kernel.h> 46#include <sys/device.h> 47 48#include <sys/radioio.h> 49#include <dev/radio_if.h> 50 51#include <dev/usb/usb.h> 52#include <dev/usb/usbdi.h> 53#include <dev/usb/usbdi_util.h> 54#include <dev/usb/usbdivar.h> 55 56#include <dev/usb/usbdevs.h> 57 58#ifdef UDSBR_DEBUG 59#define DPRINTF(x) if (udsbrdebug) printf x 60#define DPRINTFN(n,x) if (udsbrdebug>(n)) printf x 61int udsbrdebug = 0; 62#else 63#define DPRINTF(x) 64#define DPRINTFN(n,x) 65#endif 66 67#define UDSBR_CONFIG_NO 1 68 69Static int udsbr_get_info(void *, struct radio_info *); 70Static int udsbr_set_info(void *, struct radio_info *); 71 72const struct radio_hw_if udsbr_hw_if = { 73 NULL, /* open */ 74 NULL, /* close */ 75 udsbr_get_info, 76 udsbr_set_info, 77 NULL 78}; 79 80struct udsbr_softc { 81 device_t sc_dev; 82 struct usbd_device * sc_udev; 83 84 char sc_mute; 85 char sc_vol; 86 uint32_t sc_freq; 87 88 device_t sc_child; 89 90 char sc_dying; 91}; 92 93Static int udsbr_req(struct udsbr_softc *, int, int, 94 int); 95Static void udsbr_start(struct udsbr_softc *); 96Static void udsbr_stop(struct udsbr_softc *); 97Static void udsbr_setfreq(struct udsbr_softc *, int); 98Static int udsbr_status(struct udsbr_softc *); 99 100int udsbr_match(device_t, cfdata_t, void *); 101void udsbr_attach(device_t, device_t, void *); 102void udsbr_childdet(device_t, device_t); 103int udsbr_detach(device_t, int); 104int udsbr_activate(device_t, enum devact); 105extern struct cfdriver udsbr_cd; 106CFATTACH_DECL2_NEW(udsbr, sizeof(struct udsbr_softc), udsbr_match, 107 udsbr_attach, udsbr_detach, udsbr_activate, NULL, udsbr_childdet); 108 109int 110udsbr_match(device_t parent, cfdata_t match, void *aux) 111{ 112 struct usb_attach_arg *uaa = aux; 113 114 DPRINTFN(50,("udsbr_match\n")); 115 116 if (uaa->uaa_vendor != USB_VENDOR_CYPRESS || 117 uaa->uaa_product != USB_PRODUCT_CYPRESS_FMRADIO) 118 return UMATCH_NONE; 119 return UMATCH_VENDOR_PRODUCT; 120} 121 122void 123udsbr_attach(device_t parent, device_t self, void *aux) 124{ 125 struct udsbr_softc *sc = device_private(self); 126 struct usb_attach_arg *uaa = aux; 127 struct usbd_device * dev = uaa->uaa_device; 128 char *devinfop; 129 usbd_status err; 130 131 DPRINTFN(10,("udsbr_attach: sc=%p\n", sc)); 132 133 sc->sc_dev = self; 134 135 aprint_naive("\n"); 136 aprint_normal("\n"); 137 138 devinfop = usbd_devinfo_alloc(dev, 0); 139 aprint_normal_dev(self, "%s\n", devinfop); 140 usbd_devinfo_free(devinfop); 141 142 err = usbd_set_config_no(dev, UDSBR_CONFIG_NO, 1); 143 if (err) { 144 aprint_error_dev(self, "failed to set configuration" 145 ", err=%s\n", usbd_errstr(err)); 146 return; 147 } 148 149 sc->sc_udev = dev; 150 151 DPRINTFN(10, ("udsbr_attach: %p\n", sc->sc_udev)); 152 153 usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, 154 sc->sc_dev); 155 156 sc->sc_child = radio_attach_mi(&udsbr_hw_if, sc, sc->sc_dev); 157 158 return; 159} 160 161void 162udsbr_childdet(device_t self, device_t child) 163{ 164} 165 166int 167udsbr_detach(device_t self, int flags) 168{ 169 struct udsbr_softc *sc = device_private(self); 170 int rv = 0; 171 172 if (sc->sc_child != NULL) 173 rv = config_detach(sc->sc_child, flags); 174 175 usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, 176 sc->sc_dev); 177 178 return rv; 179} 180 181int 182udsbr_activate(device_t self, enum devact act) 183{ 184 struct udsbr_softc *sc = device_private(self); 185 186 switch (act) { 187 case DVACT_DEACTIVATE: 188 sc->sc_dying = 1; 189 return 0; 190 default: 191 return EOPNOTSUPP; 192 } 193} 194 195int 196udsbr_req(struct udsbr_softc *sc, int ureq, int value, int index) 197{ 198 usb_device_request_t req; 199 usbd_status err; 200 u_char data; 201 202 DPRINTFN(1,("udsbr_req: ureq=0x%02x value=0x%04x index=0x%04x\n", 203 ureq, value, index)); 204 req.bmRequestType = UT_READ_VENDOR_DEVICE; 205 req.bRequest = ureq; 206 USETW(req.wValue, value); 207 USETW(req.wIndex, index); 208 USETW(req.wLength, 1); 209 err = usbd_do_request(sc->sc_udev, &req, &data); 210 if (err) { 211 aprint_error_dev(sc->sc_dev, "request failed err=%d\n", err); 212 } 213 return !(data & 1); 214} 215 216void 217udsbr_start(struct udsbr_softc *sc) 218{ 219 (void)udsbr_req(sc, 0x00, 0x0000, 0x00c7); 220 (void)udsbr_req(sc, 0x02, 0x0001, 0x0000); 221} 222 223void 224udsbr_stop(struct udsbr_softc *sc) 225{ 226 (void)udsbr_req(sc, 0x00, 0x0016, 0x001c); 227 (void)udsbr_req(sc, 0x02, 0x0000, 0x0000); 228} 229 230void 231udsbr_setfreq(struct udsbr_softc *sc, int freq) 232{ 233 DPRINTF(("udsbr_setfreq: setfreq=%d\n", freq)); 234 /* 235 * Freq now is in Hz. We need to convert it to the frequency 236 * that the radio wants. This frequency is 10.7MHz above 237 * the actual frequency. We then need to convert to 238 * units of 12.5kHz. We add one to the IFM to make rounding 239 * easier. 240 */ 241 freq = (freq * 1000 + 10700001) / 12500; 242 (void)udsbr_req(sc, 0x01, (freq >> 8) & 0xff, freq & 0xff); 243 (void)udsbr_req(sc, 0x00, 0x0096, 0x00b7); 244 usbd_delay_ms(sc->sc_udev, 240); /* wait for signal to settle */ 245} 246 247int 248udsbr_status(struct udsbr_softc *sc) 249{ 250 return udsbr_req(sc, 0x00, 0x0000, 0x0024); 251} 252 253 254int 255udsbr_get_info(void *v, struct radio_info *ri) 256{ 257 struct udsbr_softc *sc = v; 258 259 ri->mute = sc->sc_mute; 260 ri->volume = sc->sc_vol ? 255 : 0; 261 ri->caps = RADIO_CAPS_DETECT_STEREO; 262 ri->rfreq = 0; 263 ri->lock = 0; 264 ri->freq = sc->sc_freq; 265 ri->info = udsbr_status(sc) ? RADIO_INFO_STEREO : 0; 266 267 return 0; 268} 269 270int 271udsbr_set_info(void *v, struct radio_info *ri) 272{ 273 struct udsbr_softc *sc = v; 274 275 sc->sc_mute = ri->mute != 0; 276 sc->sc_vol = ri->volume != 0; 277 sc->sc_freq = ri->freq; 278 udsbr_setfreq(sc, sc->sc_freq); 279 280 if (sc->sc_mute || sc->sc_vol == 0) 281 udsbr_stop(sc); 282 else 283 udsbr_start(sc); 284 285 return 0; 286} 287