udsbr.c revision 1.17
11.17Sdyoung/*	$NetBSD: udsbr.c,v 1.17 2009/11/12 19:51:44 dyoung 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.17Sdyoung__KERNEL_RCSID(0, "$NetBSD: udsbr.c,v 1.17 2009/11/12 19:51:44 dyoung 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
1801.1Saugustss	switch (act) {
1811.1Saugustss	case DVACT_DEACTIVATE:
1821.1Saugustss		sc->sc_dying = 1;
1831.17Sdyoung		return 0;
1841.17Sdyoung	default:
1851.17Sdyoung		return EOPNOTSUPP;
1861.1Saugustss	}
1871.1Saugustss}
1881.1Saugustss
1891.1Saugustssint
1901.1Saugustssudsbr_req(struct udsbr_softc *sc, int ureq, int value, int index)
1911.1Saugustss{
1921.1Saugustss	usb_device_request_t req;
1931.1Saugustss	usbd_status err;
1941.1Saugustss	u_char data;
1951.1Saugustss
1961.4Saugustss	DPRINTFN(1,("udsbr_req: ureq=0x%02x value=0x%04x index=0x%04x\n",
1971.4Saugustss		    ureq, value, index));
1981.1Saugustss	req.bmRequestType = UT_READ_VENDOR_DEVICE;
1991.1Saugustss	req.bRequest = ureq;
2001.1Saugustss	USETW(req.wValue, value);
2011.1Saugustss	USETW(req.wIndex, index);
2021.1Saugustss	USETW(req.wLength, 1);
2031.1Saugustss	err = usbd_do_request(sc->sc_udev, &req, &data);
2041.1Saugustss	if (err) {
2051.15Scube		aprint_error_dev(sc->sc_dev, "request failed err=%d\n", err);
2061.1Saugustss	}
2071.1Saugustss	return !(data & 1);
2081.1Saugustss}
2091.1Saugustss
2101.1Saugustssvoid
2111.1Saugustssudsbr_start(struct udsbr_softc *sc)
2121.1Saugustss{
2131.1Saugustss	(void)udsbr_req(sc, 0x00, 0x0000, 0x00c7);
2141.1Saugustss	(void)udsbr_req(sc, 0x02, 0x0001, 0x0000);
2151.1Saugustss}
2161.1Saugustss
2171.1Saugustssvoid
2181.1Saugustssudsbr_stop(struct udsbr_softc *sc)
2191.1Saugustss{
2201.1Saugustss	(void)udsbr_req(sc, 0x00, 0x0016, 0x001c);
2211.1Saugustss	(void)udsbr_req(sc, 0x02, 0x0000, 0x0000);
2221.1Saugustss}
2231.1Saugustss
2241.1Saugustssvoid
2251.1Saugustssudsbr_setfreq(struct udsbr_softc *sc, int freq)
2261.1Saugustss{
2271.1Saugustss	DPRINTF(("udsbr_setfreq: setfreq=%d\n", freq));
2281.2Saugustss        /*
2291.2Saugustss         * Freq now is in Hz.  We need to convert it to the frequency
2301.2Saugustss         * that the radio wants.  This frequency is 10.7MHz above
2311.2Saugustss         * the actual frequency.  We then need to convert to
2321.2Saugustss         * units of 12.5kHz.  We add one to the IFM to make rounding
2331.7Saugustss         * easier.
2341.2Saugustss         */
2351.4Saugustss        freq = (freq * 1000 + 10700001) / 12500;
2361.1Saugustss	(void)udsbr_req(sc, 0x01, (freq >> 8) & 0xff, freq & 0xff);
2371.1Saugustss	(void)udsbr_req(sc, 0x00, 0x0096, 0x00b7);
2381.4Saugustss	usbd_delay_ms(sc->sc_udev, 240); /* wait for signal to settle */
2391.1Saugustss}
2401.1Saugustss
2411.1Saugustssint
2421.1Saugustssudsbr_status(struct udsbr_softc *sc)
2431.1Saugustss{
2441.1Saugustss	return (udsbr_req(sc, 0x00, 0x0000, 0x0024));
2451.1Saugustss}
2461.1Saugustss
2471.1Saugustss
2481.1Saugustssint
2491.1Saugustssudsbr_get_info(void *v, struct radio_info *ri)
2501.1Saugustss{
2511.1Saugustss	struct udsbr_softc *sc = v;
2521.1Saugustss
2531.1Saugustss	ri->mute = sc->sc_mute;
2541.1Saugustss	ri->volume = sc->sc_vol ? 255 : 0;
2551.1Saugustss	ri->caps = RADIO_CAPS_DETECT_STEREO;
2561.1Saugustss	ri->rfreq = 0;
2571.1Saugustss	ri->lock = 0;
2581.1Saugustss	ri->freq = sc->sc_freq;
2591.1Saugustss	ri->info = udsbr_status(sc) ? RADIO_INFO_STEREO : 0;
2601.1Saugustss
2611.1Saugustss	return (0);
2621.1Saugustss}
2631.1Saugustss
2641.1Saugustssint
2651.1Saugustssudsbr_set_info(void *v, struct radio_info *ri)
2661.1Saugustss{
2671.1Saugustss	struct udsbr_softc *sc = v;
2681.1Saugustss
2691.1Saugustss	sc->sc_mute = ri->mute != 0;
2701.1Saugustss	sc->sc_vol = ri->volume != 0;
2711.1Saugustss	sc->sc_freq = ri->freq;
2721.1Saugustss	udsbr_setfreq(sc, sc->sc_freq);
2731.1Saugustss
2741.1Saugustss	if (sc->sc_mute || sc->sc_vol == 0)
2751.1Saugustss		udsbr_stop(sc);
2761.1Saugustss	else
2771.1Saugustss		udsbr_start(sc);
2781.1Saugustss
2791.1Saugustss	return (0);
2801.1Saugustss}
281