udsbr.c revision 1.24
1/* $NetBSD: udsbr.c,v 1.24 2016/07/07 06:55:42 msaitoh 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.24 2016/07/07 06:55:42 msaitoh 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, sc->sc_dev); 154 155 sc->sc_child = radio_attach_mi(&udsbr_hw_if, sc, sc->sc_dev); 156 157 return; 158} 159 160void 161udsbr_childdet(device_t self, device_t child) 162{ 163} 164 165int 166udsbr_detach(device_t self, int flags) 167{ 168 struct udsbr_softc *sc = device_private(self); 169 int rv = 0; 170 171 if (sc->sc_child != NULL) 172 rv = config_detach(sc->sc_child, flags); 173 174 usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev); 175 176 return rv; 177} 178 179int 180udsbr_activate(device_t self, enum devact act) 181{ 182 struct udsbr_softc *sc = device_private(self); 183 184 switch (act) { 185 case DVACT_DEACTIVATE: 186 sc->sc_dying = 1; 187 return 0; 188 default: 189 return EOPNOTSUPP; 190 } 191} 192 193int 194udsbr_req(struct udsbr_softc *sc, int ureq, int value, int index) 195{ 196 usb_device_request_t req; 197 usbd_status err; 198 u_char data; 199 200 DPRINTFN(1,("udsbr_req: ureq=0x%02x value=0x%04x index=0x%04x\n", 201 ureq, value, index)); 202 req.bmRequestType = UT_READ_VENDOR_DEVICE; 203 req.bRequest = ureq; 204 USETW(req.wValue, value); 205 USETW(req.wIndex, index); 206 USETW(req.wLength, 1); 207 err = usbd_do_request(sc->sc_udev, &req, &data); 208 if (err) { 209 aprint_error_dev(sc->sc_dev, "request failed err=%d\n", err); 210 } 211 return !(data & 1); 212} 213 214void 215udsbr_start(struct udsbr_softc *sc) 216{ 217 (void)udsbr_req(sc, 0x00, 0x0000, 0x00c7); 218 (void)udsbr_req(sc, 0x02, 0x0001, 0x0000); 219} 220 221void 222udsbr_stop(struct udsbr_softc *sc) 223{ 224 (void)udsbr_req(sc, 0x00, 0x0016, 0x001c); 225 (void)udsbr_req(sc, 0x02, 0x0000, 0x0000); 226} 227 228void 229udsbr_setfreq(struct udsbr_softc *sc, int freq) 230{ 231 DPRINTF(("udsbr_setfreq: setfreq=%d\n", freq)); 232 /* 233 * Freq now is in Hz. We need to convert it to the frequency 234 * that the radio wants. This frequency is 10.7MHz above 235 * the actual frequency. We then need to convert to 236 * units of 12.5kHz. We add one to the IFM to make rounding 237 * easier. 238 */ 239 freq = (freq * 1000 + 10700001) / 12500; 240 (void)udsbr_req(sc, 0x01, (freq >> 8) & 0xff, freq & 0xff); 241 (void)udsbr_req(sc, 0x00, 0x0096, 0x00b7); 242 usbd_delay_ms(sc->sc_udev, 240); /* wait for signal to settle */ 243} 244 245int 246udsbr_status(struct udsbr_softc *sc) 247{ 248 return udsbr_req(sc, 0x00, 0x0000, 0x0024); 249} 250 251 252int 253udsbr_get_info(void *v, struct radio_info *ri) 254{ 255 struct udsbr_softc *sc = v; 256 257 ri->mute = sc->sc_mute; 258 ri->volume = sc->sc_vol ? 255 : 0; 259 ri->caps = RADIO_CAPS_DETECT_STEREO; 260 ri->rfreq = 0; 261 ri->lock = 0; 262 ri->freq = sc->sc_freq; 263 ri->info = udsbr_status(sc) ? RADIO_INFO_STEREO : 0; 264 265 return 0; 266} 267 268int 269udsbr_set_info(void *v, struct radio_info *ri) 270{ 271 struct udsbr_softc *sc = v; 272 273 sc->sc_mute = ri->mute != 0; 274 sc->sc_vol = ri->volume != 0; 275 sc->sc_freq = ri->freq; 276 udsbr_setfreq(sc, sc->sc_freq); 277 278 if (sc->sc_mute || sc->sc_vol == 0) 279 udsbr_stop(sc); 280 else 281 udsbr_start(sc); 282 283 return 0; 284} 285