[media] shark2: New driver for the Griffin radioSHARK v2 USB radio receiver (4faba767) · Commits · e / devices / android_kernel_fairphone_FP4

drivers/media/radio/Kconfig

+17 −0

Original line number	Diff line number	Diff line
		@@ -74,6 +74,23 @@ config RADIO_SHARK
		To compile this driver as a module, choose M here: the
		module will be called radio-shark.

		config RADIO_SHARK2
		tristate "Griffin radioSHARK2 USB radio receiver"
		depends on USB
		---help---
		Choose Y here if you have this radio receiver.

		There are 2 versions of this device, this driver is for version 2,
		which is black.

		In order to control your radio card, you will need to use programs
		that are compatible with the Video For Linux API. Information on
		this API and pointers to "v4l" programs may be found at
		<file:Documentation/video4linux/API.html>.

		To compile this driver as a module, choose M here: the
		module will be called radio-shark2.

		config I2C_SI4713
		tristate "I2C driver for Silicon Labs Si4713 device"
		depends on I2C && VIDEO_V4L2

drivers/media/radio/Makefile

+3 −0

Original line number	Diff line number	Diff line
		@@ -12,6 +12,7 @@ obj-$(CONFIG_RADIO_TYPHOON) += radio-typhoon.o
		obj-$(CONFIG_RADIO_TERRATEC) += radio-terratec.o
		obj-$(CONFIG_RADIO_MAXIRADIO) += radio-maxiradio.o
		obj-$(CONFIG_RADIO_SHARK) += radio-shark.o
		obj-$(CONFIG_RADIO_SHARK2) += shark2.o
		obj-$(CONFIG_RADIO_RTRACK) += radio-aimslab.o
		obj-$(CONFIG_RADIO_ZOLTRIX) += radio-zoltrix.o
		obj-$(CONFIG_RADIO_GEMTEK) += radio-gemtek.o
		@@ -30,4 +31,6 @@ obj-$(CONFIG_RADIO_TIMBERDALE) += radio-timb.o
		obj-$(CONFIG_RADIO_WL1273) += radio-wl1273.o
		obj-$(CONFIG_RADIO_WL128X) += wl128x/

		shark2-objs := radio-shark2.o radio-tea5777.o

		ccflags-y += -Isound

drivers/media/radio/radio-shark2.c

0 → 100644

+348 −0

Original line number	Diff line number	Diff line
		/*
		* Linux V4L2 radio driver for the Griffin radioSHARK2 USB radio receiver
		*
		* Note the radioSHARK2 offers the audio through a regular USB audio device,
		* this driver only handles the tuning.
		*
		* The info necessary to drive the shark2 was taken from the small userspace
		* shark2.c program by Hisaaki Shibata, which he kindly placed in the Public
		* Domain.
		*
		* Copyright (c) 2012 Hans de Goede <hdegoede@redhat.com>
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License as published by
		* the Free Software Foundation; either version 2 of the License, or
		* (at your option) any later version.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*
		* You should have received a copy of the GNU General Public License
		* along with this program; if not, write to the Free Software
		* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
		*/

		#include <linux/init.h>
		#include <linux/kernel.h>
		#include <linux/leds.h>
		#include <linux/module.h>
		#include <linux/slab.h>
		#include <linux/usb.h>
		#include <linux/workqueue.h>
		#include <media/v4l2-device.h>
		#include "radio-tea5777.h"

		MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
		MODULE_DESCRIPTION("Griffin radioSHARK2, USB radio receiver driver");
		MODULE_LICENSE("GPL");

		static int debug;
		module_param(debug, int, 0);
		MODULE_PARM_DESC(debug, "Debug level (0-1)");


		#define SHARK_IN_EP 0x83
		#define SHARK_OUT_EP 0x05

		#define TB_LEN 7
		#define DRV_NAME "radioshark2"

		#define v4l2_dev_to_shark(d) container_of(d, struct shark_device, v4l2_dev)

		enum { BLUE_LED, RED_LED, NO_LEDS };

		static void shark_led_set_blue(struct led_classdev *led_cdev,
		enum led_brightness value);
		static void shark_led_set_red(struct led_classdev *led_cdev,
		enum led_brightness value);

		static const struct led_classdev shark_led_templates[NO_LEDS] = {
		[BLUE_LED] = {
		.name = "%s:blue:",
		.brightness = LED_OFF,
		.max_brightness = 127,
		.brightness_set = shark_led_set_blue,
		},
		[RED_LED] = {
		.name = "%s:red:",
		.brightness = LED_OFF,
		.max_brightness = 1,
		.brightness_set = shark_led_set_red,
		},
		};

		struct shark_device {
		struct usb_device *usbdev;
		struct v4l2_device v4l2_dev;
		struct radio_tea5777 tea;

		struct work_struct led_work;
		struct led_classdev leds[NO_LEDS];
		char led_names[NO_LEDS][32];
		atomic_t brightness[NO_LEDS];
		unsigned long brightness_new;

		u8 *transfer_buffer;
		};

		static atomic_t shark_instance = ATOMIC_INIT(0);

		static int shark_write_reg(struct radio_tea5777 *tea, u64 reg)
		{
		struct shark_device *shark = tea->private_data;
		int i, res, actual_len;

		memset(shark->transfer_buffer, 0, TB_LEN);
		shark->transfer_buffer[0] = 0x81; /* Write register command */
		for (i = 0; i < 6; i++)
		shark->transfer_buffer[i + 1] = (reg >> (40 - i * 8)) & 0xff;

		v4l2_dbg(1, debug, tea->v4l2_dev,
		"shark2-write: %02x %02x %02x %02x %02x %02x %02x\n",
		shark->transfer_buffer[0], shark->transfer_buffer[1],
		shark->transfer_buffer[2], shark->transfer_buffer[3],
		shark->transfer_buffer[4], shark->transfer_buffer[5],
		shark->transfer_buffer[6]);

		res = usb_interrupt_msg(shark->usbdev,
		usb_sndintpipe(shark->usbdev, SHARK_OUT_EP),
		shark->transfer_buffer, TB_LEN,
		&actual_len, 1000);
		if (res < 0) {
		v4l2_err(tea->v4l2_dev, "write error: %d\n", res);
		return res;
		}

		return 0;
		}

		static int shark_read_reg(struct radio_tea5777 tea, u32 reg_ret)
		{
		struct shark_device *shark = tea->private_data;
		int i, res, actual_len;
		u32 reg = 0;

		memset(shark->transfer_buffer, 0, TB_LEN);
		shark->transfer_buffer[0] = 0x82;
		res = usb_interrupt_msg(shark->usbdev,
		usb_sndintpipe(shark->usbdev, SHARK_OUT_EP),
		shark->transfer_buffer, TB_LEN,
		&actual_len, 1000);
		if (res < 0) {
		v4l2_err(tea->v4l2_dev, "request-read error: %d\n", res);
		return res;
		}

		res = usb_interrupt_msg(shark->usbdev,
		usb_rcvintpipe(shark->usbdev, SHARK_IN_EP),
		shark->transfer_buffer, TB_LEN,
		&actual_len, 1000);
		if (res < 0) {
		v4l2_err(tea->v4l2_dev, "read error: %d\n", res);
		return res;
		}

		for (i = 0; i < 3; i++)
		reg \|= shark->transfer_buffer[i] << (16 - i * 8);

		v4l2_dbg(1, debug, tea->v4l2_dev, "shark2-read: %02x %02x %02x\n",
		shark->transfer_buffer[0], shark->transfer_buffer[1],
		shark->transfer_buffer[2]);

		*reg_ret = reg;
		return 0;
		}

		static struct radio_tea5777_ops shark_tea_ops = {
		.write_reg = shark_write_reg,
		.read_reg = shark_read_reg,
		};

		static void shark_led_work(struct work_struct *work)
		{
		struct shark_device *shark =
		container_of(work, struct shark_device, led_work);
		int i, res, brightness, actual_len;
		/*
		* We use the v4l2_dev lock and registered bit to ensure the device
		* does not get unplugged and unreffed while we're running.
		*/
		mutex_lock(&shark->tea.mutex);
		if (!video_is_registered(&shark->tea.vd))
		goto leave;

		for (i = 0; i < 2; i++) {
		if (!test_and_clear_bit(i, &shark->brightness_new))
		continue;

		brightness = atomic_read(&shark->brightness[i]);
		memset(shark->transfer_buffer, 0, TB_LEN);
		shark->transfer_buffer[0] = 0x83 + i;
		shark->transfer_buffer[1] = brightness;
		res = usb_interrupt_msg(shark->usbdev,
		usb_sndintpipe(shark->usbdev,
		SHARK_OUT_EP),
		shark->transfer_buffer, TB_LEN,
		&actual_len, 1000);
		if (res < 0)
		v4l2_err(&shark->v4l2_dev, "set LED %s error: %d\n",
		shark->led_names[i], res);
		}
		leave:
		mutex_unlock(&shark->tea.mutex);
		}

		static void shark_led_set_blue(struct led_classdev *led_cdev,
		enum led_brightness value)
		{
		struct shark_device *shark =
		container_of(led_cdev, struct shark_device, leds[BLUE_LED]);

		atomic_set(&shark->brightness[BLUE_LED], value);
		set_bit(BLUE_LED, &shark->brightness_new);
		schedule_work(&shark->led_work);
		}

		static void shark_led_set_red(struct led_classdev *led_cdev,
		enum led_brightness value)
		{
		struct shark_device *shark =
		container_of(led_cdev, struct shark_device, leds[RED_LED]);

		atomic_set(&shark->brightness[RED_LED], value);
		set_bit(RED_LED, &shark->brightness_new);
		schedule_work(&shark->led_work);
		}

		static void usb_shark_disconnect(struct usb_interface *intf)
		{
		struct v4l2_device *v4l2_dev = usb_get_intfdata(intf);
		struct shark_device *shark = v4l2_dev_to_shark(v4l2_dev);
		int i;

		mutex_lock(&shark->tea.mutex);
		v4l2_device_disconnect(&shark->v4l2_dev);
		radio_tea5777_exit(&shark->tea);
		mutex_unlock(&shark->tea.mutex);

		for (i = 0; i < NO_LEDS; i++)
		led_classdev_unregister(&shark->leds[i]);

		v4l2_device_put(&shark->v4l2_dev);
		}

		static void usb_shark_release(struct v4l2_device *v4l2_dev)
		{
		struct shark_device *shark = v4l2_dev_to_shark(v4l2_dev);

		cancel_work_sync(&shark->led_work);
		v4l2_device_unregister(&shark->v4l2_dev);
		kfree(shark->transfer_buffer);
		kfree(shark);
		}

		static int usb_shark_probe(struct usb_interface *intf,
		const struct usb_device_id *id)
		{
		struct shark_device *shark;
		int i, retval = -ENOMEM;

		shark = kzalloc(sizeof(struct shark_device), GFP_KERNEL);
		if (!shark)
		return retval;

		shark->transfer_buffer = kmalloc(TB_LEN, GFP_KERNEL);
		if (!shark->transfer_buffer)
		goto err_alloc_buffer;

		/*
		* Work around a bug in usbhid/hid-core.c, where it leaves a dangling
		* pointer in intfdata causing v4l2-device.c to not set it. Which
		* results in usb_shark_disconnect() referencing the dangling pointer
		*
		* REMOVE (as soon as the above bug is fixed, patch submitted)
		*/
		usb_set_intfdata(intf, NULL);

		shark->v4l2_dev.release = usb_shark_release;
		v4l2_device_set_name(&shark->v4l2_dev, DRV_NAME, &shark_instance);
		retval = v4l2_device_register(&intf->dev, &shark->v4l2_dev);
		if (retval) {
		v4l2_err(&shark->v4l2_dev, "couldn't register v4l2_device\n");
		goto err_reg_dev;
		}

		shark->usbdev = interface_to_usbdev(intf);
		shark->tea.v4l2_dev = &shark->v4l2_dev;
		shark->tea.private_data = shark;
		shark->tea.ops = &shark_tea_ops;
		shark->tea.has_am = true;
		shark->tea.write_before_read = true;
		strlcpy(shark->tea.card, "Griffin radioSHARK2",
		sizeof(shark->tea.card));
		usb_make_path(shark->usbdev, shark->tea.bus_info,
		sizeof(shark->tea.bus_info));

		retval = radio_tea5777_init(&shark->tea, THIS_MODULE);
		if (retval) {
		v4l2_err(&shark->v4l2_dev, "couldn't init tea5777\n");
		goto err_init_tea;
		}

		INIT_WORK(&shark->led_work, shark_led_work);
		for (i = 0; i < NO_LEDS; i++) {
		shark->leds[i] = shark_led_templates[i];
		snprintf(shark->led_names[i], sizeof(shark->led_names[0]),
		shark->leds[i].name, shark->v4l2_dev.name);
		shark->leds[i].name = shark->led_names[i];
		/*
		* We don't fail the probe if we fail to register the leds,
		* because once we've called radio_tea5777_init, the /dev/radio0
		* node may be opened from userspace holding a reference to us!
		*
		* Note we cannot register the leds first instead as
		* shark_led_work depends on the v4l2 mutex and registered bit.
		*/
		retval = led_classdev_register(&intf->dev, &shark->leds[i]);
		if (retval)
		v4l2_err(&shark->v4l2_dev,
		"couldn't register led: %s\n",
		shark->led_names[i]);
		}

		return 0;

		err_init_tea:
		v4l2_device_unregister(&shark->v4l2_dev);
		err_reg_dev:
		kfree(shark->transfer_buffer);
		err_alloc_buffer:
		kfree(shark);

		return retval;
		}

		/* Specify the bcdDevice value, as the radioSHARK and radioSHARK2 share ids */
		static struct usb_device_id usb_shark_device_table[] = {
		{ .match_flags = USB_DEVICE_ID_MATCH_DEVICE_AND_VERSION \|
		USB_DEVICE_ID_MATCH_INT_CLASS,
		.idVendor = 0x077d,
		.idProduct = 0x627a,
		.bcdDevice_lo = 0x0010,
		.bcdDevice_hi = 0x0010,
		.bInterfaceClass = 3,
		},
		{ }
		};
		MODULE_DEVICE_TABLE(usb, usb_shark_device_table);

		static struct usb_driver usb_shark_driver = {
		.name = DRV_NAME,
		.probe = usb_shark_probe,
		.disconnect = usb_shark_disconnect,
		.id_table = usb_shark_device_table,
		};
		module_usb_driver(usb_shark_driver);

drivers/media/radio/radio-tea5777.c

0 → 100644

+489 −0

File added.

Preview size limit exceeded, changes collapsed.

drivers/media/radio/radio-tea5777.h

0 → 100644

+87 −0

Original line number	Diff line number	Diff line
		#ifndef __RADIO_TEA5777_H
		#define __RADIO_TEA5777_H

		/*
		* v4l2 driver for TEA5777 Philips AM/FM radio tuner chips
		*
		* Copyright (c) 2012 Hans de Goede <hdegoede@redhat.com>
		*
		* Based on the ALSA driver for TEA5757/5759 Philips AM/FM radio tuner chips:
		*
		* Copyright (c) 2004 Jaroslav Kysela <perex@perex.cz>
		* Copyright (c) 2012 Hans de Goede <hdegoede@redhat.com>
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License as published by
		* the Free Software Foundation; either version 2 of the License, or
		* (at your option) any later version.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*
		* You should have received a copy of the GNU General Public License
		* along with this program; if not, write to the Free Software
		* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
		*
		*/

		#include <linux/videodev2.h>
		#include <media/v4l2-ctrls.h>
		#include <media/v4l2-dev.h>
		#include <media/v4l2-device.h>

		#define TEA575X_FMIF 10700
		#define TEA575X_AMIF 450

		struct radio_tea5777;

		struct radio_tea5777_ops {
		/*
		* Write the 6 bytes large write register of the tea5777
		*
		* val represents the 6 write registers, with byte 1 from the
		* datasheet being the most significant byte (so byte 5 of the u64),
		* and byte 6 from the datasheet being the least significant byte.
		*
		* returns 0 on success.
		*/
		int (write_reg)(struct radio_tea5777 tea, u64 val);
		/*
		* Read the 3 bytes large read register of the tea5777
		*
		* The read value gets returned in val, akin to write_reg, byte 1 from
		* the datasheet is stored as the most significant byte (so byte 2 of
		* the u32), and byte 3 from the datasheet gets stored as the least
		* significant byte (iow byte 0 of the u32).
		*
		* returns 0 on success.
		*/
		int (read_reg)(struct radio_tea5777 tea, u32 *val);
		};

		struct radio_tea5777 {
		struct v4l2_device *v4l2_dev;
		struct v4l2_file_operations fops;
		struct video_device vd; /* video device */
		bool has_am; /* Device can tune to AM freqs */
		bool write_before_read; /* must write before read quirk */
		bool needs_write; /* for write before read quirk */
		u32 freq; /* current frequency */
		u32 seek_rangelow; /* current hwseek limits */
		u32 seek_rangehigh;
		u32 read_reg;
		u64 write_reg;
		struct mutex mutex;
		struct radio_tea5777_ops *ops;
		void *private_data;
		u8 card[32];
		u8 bus_info[32];
		struct v4l2_ctrl_handler ctrl_handler;
		};

		int radio_tea5777_init(struct radio_tea5777 tea, struct module owner);
		void radio_tea5777_exit(struct radio_tea5777 *tea);

		#endif /* __RADIO_TEA5777_H */