^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) * vivid-radio-tx.c - radio transmitter support functions.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright 2014 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/sched/signal.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/videodev2.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/v4l2-dv-timings.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <media/v4l2-common.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <media/v4l2-event.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <media/v4l2-dv-timings.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include "vivid-core.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include "vivid-ctrls.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include "vivid-radio-common.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include "vivid-radio-tx.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) ssize_t vivid_radio_tx_write(struct file *file, const char __user *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) size_t size, loff_t *offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) struct vivid_dev *dev = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct v4l2_rds_data *data = dev->rds_gen.data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) ktime_t timestamp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) unsigned blk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) if (dev->radio_tx_rds_controls)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) if (size < sizeof(*data))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) size = sizeof(*data) * (size / sizeof(*data));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) if (mutex_lock_interruptible(&dev->mutex))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) return -ERESTARTSYS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) if (dev->radio_tx_rds_owner &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) file->private_data != dev->radio_tx_rds_owner) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) mutex_unlock(&dev->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) dev->radio_tx_rds_owner = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) retry:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) timestamp = ktime_sub(ktime_get(), dev->radio_rds_init_time);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) blk = ktime_divns(timestamp, VIVID_RDS_NSEC_PER_BLK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) if (blk - VIVID_RDS_GEN_BLOCKS >= dev->radio_tx_rds_last_block)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) dev->radio_tx_rds_last_block = blk - VIVID_RDS_GEN_BLOCKS + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) * No data is available if there hasn't been time to get new data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) * or if the RDS receiver has been disabled, or if we use the data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) * from the RDS transmitter and that RDS transmitter has been disabled,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) * or if the signal quality is too weak.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) if (blk == dev->radio_tx_rds_last_block ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) !(dev->radio_tx_subchans & V4L2_TUNER_SUB_RDS)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) mutex_unlock(&dev->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) if (file->f_flags & O_NONBLOCK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) return -EWOULDBLOCK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) if (msleep_interruptible(20) && signal_pending(current))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) return -EINTR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) if (mutex_lock_interruptible(&dev->mutex))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) return -ERESTARTSYS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) goto retry;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) for (i = 0; i < size && blk > dev->radio_tx_rds_last_block;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) dev->radio_tx_rds_last_block++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) unsigned data_blk = dev->radio_tx_rds_last_block % VIVID_RDS_GEN_BLOCKS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct v4l2_rds_data rds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) if (copy_from_user(&rds, buf + i, sizeof(rds))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) i = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) i += sizeof(rds);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) if (!dev->radio_rds_loop)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) if ((rds.block & V4L2_RDS_BLOCK_MSK) == V4L2_RDS_BLOCK_INVALID ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) (rds.block & V4L2_RDS_BLOCK_ERROR))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) rds.block &= V4L2_RDS_BLOCK_MSK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) data[data_blk] = rds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) mutex_unlock(&dev->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) __poll_t vivid_radio_tx_poll(struct file *file, struct poll_table_struct *wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) return EPOLLOUT | EPOLLWRNORM | v4l2_ctrl_poll(file, wait);
^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) int vidioc_g_modulator(struct file *file, void *fh, struct v4l2_modulator *a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) struct vivid_dev *dev = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) if (a->index > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) strscpy(a->name, "AM/FM/SW Transmitter", sizeof(a->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) a->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) V4L2_TUNER_CAP_FREQ_BANDS | V4L2_TUNER_CAP_RDS |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) (dev->radio_tx_rds_controls ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) V4L2_TUNER_CAP_RDS_CONTROLS :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) V4L2_TUNER_CAP_RDS_BLOCK_IO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) a->rangelow = AM_FREQ_RANGE_LOW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) a->rangehigh = FM_FREQ_RANGE_HIGH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) a->txsubchans = dev->radio_tx_subchans;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) int vidioc_s_modulator(struct file *file, void *fh, const struct v4l2_modulator *a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) struct vivid_dev *dev = video_drvdata(file);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) if (a->index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) if (a->txsubchans & ~0x13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) dev->radio_tx_subchans = a->txsubchans;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags