[media] tlg2300: add control handler for radio device node (173fdb8a) · Commits · 戴 / test

drivers/media/usb/tlg2300/pd-common.h

+2 −0

Original line number	Diff line number	Diff line
		@@ -10,6 +10,7 @@
		#include <linux/poll.h>
		#include <media/videobuf-vmalloc.h>
		#include <media/v4l2-device.h>
		#include <media/v4l2-ctrls.h>

		#include "dvb_frontend.h"
		#include "dvbdev.h"
		@@ -119,6 +120,7 @@ struct radio_data {
		unsigned int is_radio_streaming;
		int pre_emphasis;
		struct video_device fm_dev;
		struct v4l2_ctrl_handler ctrl_handler;
		};

		#define DVB_SBUF_NUM 4

drivers/media/usb/tlg2300/pd-radio.c

+26 −86

Original line number	Diff line number	Diff line
		@@ -261,104 +261,34 @@ static int fm_set_freq(struct file file, void priv,
		return set_frequency(p, argp->frequency);
		}

		static int tlg_fm_vidioc_g_ctrl(struct file file, void priv,
		struct v4l2_control *arg)
		static int tlg_fm_s_ctrl(struct v4l2_ctrl *ctrl)
		{
		return 0;
		}

		static int tlg_fm_vidioc_g_exts_ctrl(struct file file, void fh,
		struct v4l2_ext_controls *ctrls)
		{
		struct poseidon *p = file->private_data;
		int i;

		if (ctrls->ctrl_class != V4L2_CTRL_CLASS_FM_TX)
		return -EINVAL;

		for (i = 0; i < ctrls->count; i++) {
		struct v4l2_ext_control *ctrl = ctrls->controls + i;

		if (ctrl->id != V4L2_CID_TUNE_PREEMPHASIS)
		continue;

		if (i < MAX_PREEMPHASIS)
		ctrl->value = p->radio_data.pre_emphasis;
		}
		return 0;
		}

		static int tlg_fm_vidioc_s_exts_ctrl(struct file file, void fh,
		struct v4l2_ext_controls *ctrls)
		{
		int i;

		if (ctrls->ctrl_class != V4L2_CTRL_CLASS_FM_TX)
		return -EINVAL;

		for (i = 0; i < ctrls->count; i++) {
		struct v4l2_ext_control *ctrl = ctrls->controls + i;

		if (ctrl->id != V4L2_CID_TUNE_PREEMPHASIS)
		continue;

		if (ctrl->value >= 0 && ctrl->value < MAX_PREEMPHASIS) {
		struct poseidon *p = file->private_data;
		int pre_emphasis = preemphasis[ctrl->value];
		struct poseidon *p = container_of(ctrl->handler, struct poseidon,
		radio_data.ctrl_handler);
		int pre_emphasis;
		u32 status;

		send_set_req(p, TUNER_AUD_ANA_STD,
		pre_emphasis, &status);
		switch (ctrl->id) {
		case V4L2_CID_TUNE_PREEMPHASIS:
		pre_emphasis = preemphasis[ctrl->val];
		send_set_req(p, TUNER_AUD_ANA_STD, pre_emphasis, &status);
		p->radio_data.pre_emphasis = pre_emphasis;
		}
		}
		return 0;
		}

		static int tlg_fm_vidioc_s_ctrl(struct file file, void priv,
		struct v4l2_control *ctrl)
		{
		return 0;
		}

		static int tlg_fm_vidioc_queryctrl(struct file file, void priv,
		struct v4l2_queryctrl *ctrl)
		{
		if (!(ctrl->id & V4L2_CTRL_FLAG_NEXT_CTRL))
		return -EINVAL;

		ctrl->id &= ~V4L2_CTRL_FLAG_NEXT_CTRL;
		if (ctrl->id != V4L2_CID_TUNE_PREEMPHASIS) {
		/* return the next supported control */
		ctrl->id = V4L2_CID_TUNE_PREEMPHASIS;
		v4l2_ctrl_query_fill(ctrl, V4L2_PREEMPHASIS_DISABLED,
		V4L2_PREEMPHASIS_75_uS, 1,
		V4L2_PREEMPHASIS_50_uS);
		ctrl->flags = V4L2_CTRL_FLAG_UPDATE;
		return 0;
		}
		return -EINVAL;
		}

		static int tlg_fm_vidioc_querymenu(struct file file, void fh,
		struct v4l2_querymenu *qmenu)
		{
		return v4l2_ctrl_query_menu(qmenu, NULL, NULL);
		}

		static int vidioc_s_tuner(struct file file, void priv, struct v4l2_tuner *vt)
		{
		return vt->index > 0 ? -EINVAL : 0;
		}

		static const struct v4l2_ctrl_ops tlg_fm_ctrl_ops = {
		.s_ctrl = tlg_fm_s_ctrl,
		};

		static const struct v4l2_ioctl_ops poseidon_fm_ioctl_ops = {
		.vidioc_querycap = vidioc_querycap,
		.vidioc_queryctrl = tlg_fm_vidioc_queryctrl,
		.vidioc_querymenu = tlg_fm_vidioc_querymenu,
		.vidioc_g_ctrl = tlg_fm_vidioc_g_ctrl,
		.vidioc_s_ctrl = tlg_fm_vidioc_s_ctrl,
		.vidioc_s_ext_ctrls = tlg_fm_vidioc_s_exts_ctrl,
		.vidioc_g_ext_ctrls = tlg_fm_vidioc_g_exts_ctrl,
		.vidioc_s_tuner = vidioc_s_tuner,
		.vidioc_g_tuner = tlg_fm_vidioc_g_tuner,
		.vidioc_g_frequency = fm_get_freq,
		@@ -376,16 +306,26 @@ static struct video_device poseidon_fm_template = {
		int poseidon_fm_init(struct poseidon *p)
		{
		struct video_device *vfd = &p->radio_data.fm_dev;
		struct v4l2_ctrl_handler *hdl = &p->radio_data.ctrl_handler;

		*vfd = poseidon_fm_template;
		vfd->v4l2_dev = &p->v4l2_dev;
		video_set_drvdata(vfd, p);

		set_frequency(p, TUNER_FREQ_MIN_FM);
		v4l2_ctrl_handler_init(hdl, 1);
		v4l2_ctrl_new_std_menu(hdl, &tlg_fm_ctrl_ops, V4L2_CID_TUNE_PREEMPHASIS,
		V4L2_PREEMPHASIS_75_uS, 0, V4L2_PREEMPHASIS_50_uS);
		if (hdl->error) {
		v4l2_ctrl_handler_free(hdl);
		return hdl->error;
		}
		vfd->v4l2_dev = &p->v4l2_dev;
		vfd->ctrl_handler = hdl;
		video_set_drvdata(vfd, p);
		return video_register_device(vfd, VFL_TYPE_RADIO, -1);
		}

		int poseidon_fm_exit(struct poseidon *p)
		{
		v4l2_ctrl_handler_free(&p->radio_data.ctrl_handler);
		return 0;
		}

Admin message