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

   1 #include <linux/init.h>
   2 #include <linux/list.h>
   3 #include <linux/module.h>
   4 #include <linux/kernel.h>
   5 #include <linux/bitmap.h>
   6 #include <linux/usb.h>
   7 #include <linux/i2c.h>
   8 #include <media/v4l2-dev.h>
   9 #include <linux/mm.h>
  10 #include <linux/mutex.h>
  11 #include <media/v4l2-ioctl.h>
  12 #include <media/v4l2-event.h>
  13 #include <media/v4l2-fh.h>
  14 #include <linux/sched.h>
  15
  16 #include "pd-common.h"
  17 #include "vendorcmds.h"
  18
  19 static int set_frequency(struct poseidon *p, __u32 frequency);
  20 static int poseidon_fm_close(struct file *filp);
  21 static int poseidon_fm_open(struct file *filp);
  22
  23 #define TUNER_FREQ_MIN_FM 76000000U
  24 #define TUNER_FREQ_MAX_FM 108000000U
  25
  26 #define MAX_PREEMPHASIS (V4L2_PREEMPHASIS_75_uS + 1)
  27 static int preemphasis[MAX_PREEMPHASIS] = {
  28         TLG_TUNE_ASTD_NONE,   /* V4L2_PREEMPHASIS_DISABLED */
  29         TLG_TUNE_ASTD_FM_EUR, /* V4L2_PREEMPHASIS_50_uS    */
  30         TLG_TUNE_ASTD_FM_US,  /* V4L2_PREEMPHASIS_75_uS    */
  31 };
  32
  33 static int poseidon_check_mode_radio(struct poseidon *p)
  34 {
  35         int ret;
  36         u32 status;
  37
  38         set_current_state(TASK_INTERRUPTIBLE);
  39         schedule_timeout(HZ/2);
  40         ret = usb_set_interface(p->udev, 0, BULK_ALTERNATE_IFACE);
  41         if (ret < 0)
  42                 goto out;
  43
  44         ret = set_tuner_mode(p, TLG_MODE_FM_RADIO);
  45         if (ret != 0)
  46                 goto out;
  47
  48         ret = send_set_req(p, SGNL_SRC_SEL, TLG_SIG_SRC_ANTENNA, &status);
  49         ret = send_set_req(p, TUNER_AUD_ANA_STD,
  50                                 p->radio_data.pre_emphasis, &status);
  51         ret |= send_set_req(p, TUNER_AUD_MODE,
  52                                 TLG_TUNE_TVAUDIO_MODE_STEREO, &status);
  53         ret |= send_set_req(p, AUDIO_SAMPLE_RATE_SEL,
  54                                 ATV_AUDIO_RATE_48K, &status);
  55         ret |= send_set_req(p, TUNE_FREQ_SELECT, TUNER_FREQ_MIN_FM, &status);
  56 out:
  57         return ret;
  58 }
  59
  60 #ifdef CONFIG_PM
  61 static int pm_fm_suspend(struct poseidon *p)
  62 {
  63         logpm(p);
  64         pm_alsa_suspend(p);
  65         usb_set_interface(p->udev, 0, 0);
  66         msleep(300);
  67         return 0;
  68 }
  69
  70 static int pm_fm_resume(struct poseidon *p)
  71 {
  72         logpm(p);
  73         poseidon_check_mode_radio(p);
  74         set_frequency(p, p->radio_data.fm_freq);
  75         pm_alsa_resume(p);
  76         return 0;
  77 }
  78 #endif
  79
  80 static int poseidon_fm_open(struct file *filp)
  81 {
  82         struct poseidon *p = video_drvdata(filp);
  83         int ret = 0;
  84
  85         mutex_lock(&p->lock);
  86         if (p->state & POSEIDON_STATE_DISCONNECT) {
  87                 ret = -ENODEV;
  88                 goto out;
  89         }
  90
  91         if (p->state && !(p->state & POSEIDON_STATE_FM)) {
  92                 ret = -EBUSY;
  93                 goto out;
  94         }
  95         ret = v4l2_fh_open(filp);
  96         if (ret)
  97                 goto out;
  98
  99         usb_autopm_get_interface(p->interface);
 100         if (0 == p->state) {
 101                 struct video_device *vfd = &p->radio_data.fm_dev;
 102
 103                 /* default pre-emphasis */
 104                 if (p->radio_data.pre_emphasis == 0)
 105                         p->radio_data.pre_emphasis = TLG_TUNE_ASTD_FM_EUR;
 106                 set_debug_mode(vfd, debug_mode);
 107
 108                 ret = poseidon_check_mode_radio(p);
 109                 if (ret < 0) {
 110                         usb_autopm_put_interface(p->interface);
 111                         goto out;
 112                 }
 113                 p->state |= POSEIDON_STATE_FM;
 114         }
 115         kref_get(&p->kref);
 116 out:
 117         mutex_unlock(&p->lock);
 118         return ret;
 119 }
 120
 121 static int poseidon_fm_close(struct file *filp)
 122 {
 123         struct poseidon *p = video_drvdata(filp);
 124         struct radio_data *fm = &p->radio_data;
 125         uint32_t status;
 126
 127         mutex_lock(&p->lock);
 128         if (v4l2_fh_is_singular_file(filp))
 129                 p->state &= ~POSEIDON_STATE_FM;
 130
 131         if (fm->is_radio_streaming && filp == p->file_for_stream) {
 132                 fm->is_radio_streaming = 0;
 133                 send_set_req(p, PLAY_SERVICE, TLG_TUNE_PLAY_SVC_STOP, &status);
 134         }
 135         usb_autopm_put_interface(p->interface);
 136         mutex_unlock(&p->lock);
 137
 138         kref_put(&p->kref, poseidon_delete);
 139         return v4l2_fh_release(filp);
 140 }
 141
 142 static int vidioc_querycap(struct file *file, void *priv,
 143                         struct v4l2_capability *v)
 144 {
 145         struct poseidon *p = video_drvdata(file);
 146
 147         strlcpy(v->driver, "tele-radio", sizeof(v->driver));
 148         strlcpy(v->card, "Telegent Poseidon", sizeof(v->card));
 149         usb_make_path(p->udev, v->bus_info, sizeof(v->bus_info));
 150         v->device_caps = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
 151         /* Report all capabilities of the USB device */
 152         v->capabilities = v->device_caps | V4L2_CAP_DEVICE_CAPS |
 153                         V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_VBI_CAPTURE |
 154                         V4L2_CAP_AUDIO | V4L2_CAP_STREAMING |
 155                         V4L2_CAP_READWRITE;
 156         return 0;
 157 }
 158
 159 static const struct v4l2_file_operations poseidon_fm_fops = {
 160         .owner         = THIS_MODULE,
 161         .open          = poseidon_fm_open,
 162         .release       = poseidon_fm_close,
 163         .poll           = v4l2_ctrl_poll,
 164         .unlocked_ioctl = video_ioctl2,
 165 };
 166
 167 static int tlg_fm_vidioc_g_tuner(struct file *file, void *priv,
 168                                  struct v4l2_tuner *vt)
 169 {
 170         struct poseidon *p = video_drvdata(file);
 171         struct tuner_fm_sig_stat_s fm_stat = {};
 172         int ret, status, count = 5;
 173
 174         if (vt->index != 0)
 175                 return -EINVAL;
 176
 177         vt->type        = V4L2_TUNER_RADIO;
 178         vt->capability  = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LOW;
 179         vt->rangelow    = TUNER_FREQ_MIN_FM * 2 / 125;
 180         vt->rangehigh   = TUNER_FREQ_MAX_FM * 2 / 125;
 181         vt->rxsubchans  = V4L2_TUNER_SUB_STEREO;
 182         vt->audmode     = V4L2_TUNER_MODE_STEREO;
 183         vt->signal      = 0;
 184         vt->afc         = 0;
 185         strlcpy(vt->name, "Radio", sizeof(vt->name));
 186
 187         mutex_lock(&p->lock);
 188         ret = send_get_req(p, TUNER_STATUS, TLG_MODE_FM_RADIO,
 189                               &fm_stat, &status, sizeof(fm_stat));
 190
 191         while (fm_stat.sig_lock_busy && count-- && !ret) {
 192                 set_current_state(TASK_INTERRUPTIBLE);
 193                 schedule_timeout(HZ);
 194
 195                 ret = send_get_req(p, TUNER_STATUS, TLG_MODE_FM_RADIO,
 196                                   &fm_stat, &status, sizeof(fm_stat));
 197         }
 198         mutex_unlock(&p->lock);
 199
 200         if (ret || status) {
 201                 vt->signal = 0;
 202         } else if ((fm_stat.sig_present || fm_stat.sig_locked)
 203                         && fm_stat.sig_strength == 0) {
 204                 vt->signal = 0xffff;
 205         } else
 206                 vt->signal = (fm_stat.sig_strength * 255 / 10) << 8;
 207
 208         return 0;
 209 }
 210
 211 static int fm_get_freq(struct file *file, void *priv,
 212                        struct v4l2_frequency *argp)
 213 {
 214         struct poseidon *p = video_drvdata(file);
 215
 216         if (argp->tuner)
 217                 return -EINVAL;
 218         argp->frequency = p->radio_data.fm_freq;
 219         return 0;
 220 }
 221
 222 static int set_frequency(struct poseidon *p, __u32 frequency)
 223 {
 224         __u32 freq ;
 225         int ret, status;
 226
 227         mutex_lock(&p->lock);
 228
 229         ret = send_set_req(p, TUNER_AUD_ANA_STD,
 230                                 p->radio_data.pre_emphasis, &status);
 231
 232         freq = (frequency * 125) / 2; /* Hz */
 233         freq = clamp(freq, TUNER_FREQ_MIN_FM, TUNER_FREQ_MAX_FM);
 234
 235         ret = send_set_req(p, TUNE_FREQ_SELECT, freq, &status);
 236         if (ret < 0)
 237                 goto error ;
 238         ret = send_set_req(p, TAKE_REQUEST, 0, &status);
 239
 240         set_current_state(TASK_INTERRUPTIBLE);
 241         schedule_timeout(HZ/4);
 242         if (!p->radio_data.is_radio_streaming) {
 243                 ret = send_set_req(p, TAKE_REQUEST, 0, &status);
 244                 ret = send_set_req(p, PLAY_SERVICE,
 245                                 TLG_TUNE_PLAY_SVC_START, &status);
 246                 p->radio_data.is_radio_streaming = 1;
 247         }
 248         p->radio_data.fm_freq = freq * 2 / 125;
 249 error:
 250         mutex_unlock(&p->lock);
 251         return ret;
 252 }
 253
 254 static int fm_set_freq(struct file *file, void *priv,
 255                        const struct v4l2_frequency *argp)
 256 {
 257         struct poseidon *p = video_drvdata(file);
 258
 259         if (argp->tuner)
 260                 return -EINVAL;
 261         p->file_for_stream = file;
 262 #ifdef CONFIG_PM
 263         p->pm_suspend = pm_fm_suspend;
 264         p->pm_resume  = pm_fm_resume;
 265 #endif
 266         return set_frequency(p, argp->frequency);
 267 }
 268
 269 static int tlg_fm_s_ctrl(struct v4l2_ctrl *ctrl)
 270 {
 271         struct poseidon *p = container_of(ctrl->handler, struct poseidon,
 272                                                 radio_data.ctrl_handler);
 273         int pre_emphasis;
 274         u32 status;
 275
 276         switch (ctrl->id) {
 277         case V4L2_CID_TUNE_PREEMPHASIS:
 278                 pre_emphasis = preemphasis[ctrl->val];
 279                 send_set_req(p, TUNER_AUD_ANA_STD, pre_emphasis, &status);
 280                 p->radio_data.pre_emphasis = pre_emphasis;
 281                 return 0;
 282         }
 283         return -EINVAL;
 284 }
 285
 286 static int vidioc_s_tuner(struct file *file, void *priv, struct v4l2_tuner *vt)
 287 {
 288         return vt->index > 0 ? -EINVAL : 0;
 289 }
 290
 291 static const struct v4l2_ctrl_ops tlg_fm_ctrl_ops = {
 292         .s_ctrl = tlg_fm_s_ctrl,
 293 };
 294
 295 static const struct v4l2_ioctl_ops poseidon_fm_ioctl_ops = {
 296         .vidioc_querycap    = vidioc_querycap,
 297         .vidioc_s_tuner     = vidioc_s_tuner,
 298         .vidioc_g_tuner     = tlg_fm_vidioc_g_tuner,
 299         .vidioc_g_frequency = fm_get_freq,
 300         .vidioc_s_frequency = fm_set_freq,
 301         .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
 302         .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
 303 };
 304
 305 static struct video_device poseidon_fm_template = {
 306         .name       = "Telegent-Radio",
 307         .fops       = &poseidon_fm_fops,
 308         .minor      = -1,
 309         .release    = video_device_release_empty,
 310         .ioctl_ops  = &poseidon_fm_ioctl_ops,
 311 };
 312
 313 int poseidon_fm_init(struct poseidon *p)
 314 {
 315         struct video_device *vfd = &p->radio_data.fm_dev;
 316         struct v4l2_ctrl_handler *hdl = &p->radio_data.ctrl_handler;
 317
 318         *vfd = poseidon_fm_template;
 319
 320         set_frequency(p, TUNER_FREQ_MIN_FM);
 321         v4l2_ctrl_handler_init(hdl, 1);
 322         v4l2_ctrl_new_std_menu(hdl, &tlg_fm_ctrl_ops, V4L2_CID_TUNE_PREEMPHASIS,
 323                         V4L2_PREEMPHASIS_75_uS, 0, V4L2_PREEMPHASIS_50_uS);
 324         if (hdl->error) {
 325                 v4l2_ctrl_handler_free(hdl);
 326                 return hdl->error;
 327         }
 328         vfd->v4l2_dev = &p->v4l2_dev;
 329         vfd->ctrl_handler = hdl;
 330         set_bit(V4L2_FL_USE_FH_PRIO, &vfd->flags);
 331         video_set_drvdata(vfd, p);
 332         return video_register_device(vfd, VFL_TYPE_RADIO, -1);
 333 }
 334
 335 int poseidon_fm_exit(struct poseidon *p)
 336 {
 337         video_unregister_device(&p->radio_data.fm_dev);
 338         v4l2_ctrl_handler_free(&p->radio_data.ctrl_handler);
 339         return 0;
 340 }