static int fm_v4l2_s_ctrl(struct v4l2_ctrl *ctrl) { struct fmdev *fmdev = container_of(ctrl->handler, struct fmdev, ctrl_handler); int ret; switch (ctrl->id) { case V4L2_CID_AUDIO_VOLUME: /* set volume */ return fm_rx_set_volume(fmdev, (u16)ctrl->val); case V4L2_CID_AUDIO_MUTE: /* set mute */ return fmc_set_mute_mode(fmdev, (u8)ctrl->val); case V4L2_CID_TUNE_POWER_LEVEL: /* set TX power level - ext control */ return fm_tx_set_pwr_lvl(fmdev, (u8)ctrl->val); case V4L2_CID_TUNE_PREEMPHASIS: return fm_tx_set_preemph_filter(fmdev, (u8) ctrl->val); case V4L2_CID_RDS_TX_PI: ret = set_rds_picode(fmdev, ctrl->val); if (ret < 0) { fmerr("Failed to set RDS Radio PS Name\n"); return ret; } return 0; case V4L2_CID_RDS_TX_PTY: ret = set_rds_pty(fmdev, ctrl->val); if (ret < 0) { fmerr("Failed to set RDS Radio PS Name\n"); return ret; } return 0; case V4L2_CID_RDS_TX_PS_NAME: ret = fm_tx_set_radio_text(fmdev, ctrl->string, 1); if (ret < 0) { fmerr("Failed to set RDS Radio PS Name\n"); return ret; } return 0; case V4L2_CID_RDS_TX_RADIO_TEXT: ret = fm_tx_set_radio_text(fmdev, ctrl->string, 2); if (ret < 0) { fmerr("Failed to set RDS Radio Text\n"); return ret; } return 0; default: return -EINVAL; } }
/* Write TX RDS data */ static ssize_t fm_v4l2_fops_write(struct file *file, const char __user * buf, size_t count, loff_t *ppos) { struct tx_rds rds; int ret; struct fmdev *fmdev; ret = copy_from_user(&rds, buf, sizeof(rds)); fmdbg("(%d)type: %d, text %s, af %d\n", ret, rds.text_type, rds.text, rds.af_freq); fmdev = video_drvdata(file); fm_tx_set_radio_text(fmdev, rds.text, rds.text_type); fm_tx_set_af(fmdev, rds.af_freq); return 0; }
/* Write TX RDS data */ static ssize_t fm_v4l2_fops_write(struct file *file, const char __user * buf, size_t count, loff_t *ppos) { struct tx_rds rds; int ret; struct fmdev *fmdev; ret = copy_from_user(&rds, buf, sizeof(rds)); rds.text[sizeof(rds.text) - 1] = '\0'; fmdbg("(%d)type: %d, text %s, af %d\n", ret, rds.text_type, rds.text, rds.af_freq); if (ret) return -EFAULT; fmdev = video_drvdata(file); if (mutex_lock_interruptible(&fmdev->mutex)) return -ERESTARTSYS; fm_tx_set_radio_text(fmdev, rds.text, rds.text_type); fm_tx_set_af(fmdev, rds.af_freq); mutex_unlock(&fmdev->mutex); return sizeof(rds); }