^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * radio-timb.c Timberdale FPGA Radio driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (c) 2009 Intel Corporation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <media/v4l2-ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <media/v4l2-device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <media/v4l2-ctrls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <media/v4l2-event.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/platform_data/media/timb_radio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define DRIVER_NAME "timb-radio"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct timbradio {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct timb_radio_platform_data pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) struct v4l2_subdev *sd_tuner;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) struct v4l2_subdev *sd_dsp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) struct video_device video_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) struct v4l2_device v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct mutex lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) static int timbradio_vidioc_querycap(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct v4l2_capability *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) strscpy(v->driver, DRIVER_NAME, sizeof(v->driver));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) strscpy(v->card, "Timberdale Radio", sizeof(v->card));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) snprintf(v->bus_info, sizeof(v->bus_info), "platform:"DRIVER_NAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) static int timbradio_vidioc_g_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) struct timbradio *tr = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) return v4l2_subdev_call(tr->sd_tuner, tuner, g_tuner, v);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) static int timbradio_vidioc_s_tuner(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) const struct v4l2_tuner *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) struct timbradio *tr = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) return v4l2_subdev_call(tr->sd_tuner, tuner, s_tuner, v);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static int timbradio_vidioc_s_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) const struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct timbradio *tr = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) return v4l2_subdev_call(tr->sd_tuner, tuner, s_frequency, f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) static int timbradio_vidioc_g_frequency(struct file *file, void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) struct v4l2_frequency *f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) struct timbradio *tr = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) return v4l2_subdev_call(tr->sd_tuner, tuner, g_frequency, f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) static const struct v4l2_ioctl_ops timbradio_ioctl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) .vidioc_querycap = timbradio_vidioc_querycap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) .vidioc_g_tuner = timbradio_vidioc_g_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) .vidioc_s_tuner = timbradio_vidioc_s_tuner,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) .vidioc_g_frequency = timbradio_vidioc_g_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) .vidioc_s_frequency = timbradio_vidioc_s_frequency,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) .vidioc_log_status = v4l2_ctrl_log_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) static const struct v4l2_file_operations timbradio_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) .open = v4l2_fh_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) .release = v4l2_fh_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) .poll = v4l2_ctrl_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) .unlocked_ioctl = video_ioctl2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) static int timbradio_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) struct timb_radio_platform_data *pdata = pdev->dev.platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) struct timbradio *tr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) if (!pdata) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) dev_err(&pdev->dev, "Platform data missing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) tr = devm_kzalloc(&pdev->dev, sizeof(*tr), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) if (!tr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) err = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) tr->pdata = *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) mutex_init(&tr->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) strscpy(tr->video_dev.name, "Timberdale Radio",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) sizeof(tr->video_dev.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) tr->video_dev.fops = &timbradio_fops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) tr->video_dev.ioctl_ops = &timbradio_ioctl_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) tr->video_dev.release = video_device_release_empty;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) tr->video_dev.minor = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) tr->video_dev.lock = &tr->lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) tr->video_dev.device_caps = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) strscpy(tr->v4l2_dev.name, DRIVER_NAME, sizeof(tr->v4l2_dev.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) err = v4l2_device_register(NULL, &tr->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) goto err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) tr->video_dev.v4l2_dev = &tr->v4l2_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) tr->sd_tuner = v4l2_i2c_new_subdev_board(&tr->v4l2_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) i2c_get_adapter(pdata->i2c_adapter), pdata->tuner, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) tr->sd_dsp = v4l2_i2c_new_subdev_board(&tr->v4l2_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) i2c_get_adapter(pdata->i2c_adapter), pdata->dsp, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) if (tr->sd_tuner == NULL || tr->sd_dsp == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) goto err_video_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) tr->v4l2_dev.ctrl_handler = tr->sd_dsp->ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) err = video_register_device(&tr->video_dev, VFL_TYPE_RADIO, -1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) dev_err(&pdev->dev, "Error reg video\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) goto err_video_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) video_set_drvdata(&tr->video_dev, tr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) platform_set_drvdata(pdev, tr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) err_video_req:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) v4l2_device_unregister(&tr->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) err:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) dev_err(&pdev->dev, "Failed to register: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) static int timbradio_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) struct timbradio *tr = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) video_unregister_device(&tr->video_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) v4l2_device_unregister(&tr->v4l2_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) static struct platform_driver timbradio_platform_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) .name = DRIVER_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) .probe = timbradio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) .remove = timbradio_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) module_platform_driver(timbradio_platform_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) MODULE_DESCRIPTION("Timberdale Radio driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) MODULE_AUTHOR("Mocean Laboratories <info@mocean-labs.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) MODULE_VERSION("0.0.2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) MODULE_ALIAS("platform:"DRIVER_NAME);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags