drivers/media/i2c/saa6588.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3     Driver for SAA6588 RDS decoder
   4
   5     (c) 2005 Hans J. Koch
   6
   7 */
   8
   9
  10 #include <linux/module.h>
  11 #include <linux/kernel.h>
  12 #include <linux/i2c.h>
  13 #include <linux/types.h>
  14 #include <linux/videodev2.h>
  15 #include <linux/init.h>
  16 #include <linux/errno.h>
  17 #include <linux/slab.h>
  18 #include <linux/poll.h>
  19 #include <linux/wait.h>
  20 #include <linux/uaccess.h>
  21
  22 #include <media/i2c/saa6588.h>
  23 #include <media/v4l2-device.h>
  24
  25
  26 /* insmod options */
  27 static unsigned int debug;
  28 static unsigned int xtal;
  29 static unsigned int mmbs;
  30 static unsigned int plvl;
  31 static unsigned int bufblocks = 100;
  32
  33 module_param(debug, int, 0644);
  34 MODULE_PARM_DESC(debug, "enable debug messages");
  35 module_param(xtal, int, 0);
  36 MODULE_PARM_DESC(xtal, "select oscillator frequency (0..3), default 0");
  37 module_param(mmbs, int, 0);
  38 MODULE_PARM_DESC(mmbs, "enable MMBS mode: 0=off (default), 1=on");
  39 module_param(plvl, int, 0);
  40 MODULE_PARM_DESC(plvl, "select pause level (0..3), default 0");
  41 module_param(bufblocks, int, 0);
  42 MODULE_PARM_DESC(bufblocks, "number of buffered blocks, default 100");
  43
  44 MODULE_DESCRIPTION("v4l2 driver module for SAA6588 RDS decoder");
  45 MODULE_AUTHOR("Hans J. Koch <[email protected]>");
  46
  47 MODULE_LICENSE("GPL");
  48
  49 /* ---------------------------------------------------------------------- */
  50
  51 #define UNSET       (-1U)
  52 #define PREFIX      "saa6588: "
  53 #define dprintk     if (debug) printk
  54
  55 struct saa6588 {
  56         struct v4l2_subdev sd;
  57         struct delayed_work work;
  58         spinlock_t lock;
  59         unsigned char *buffer;
  60         unsigned int buf_size;
  61         unsigned int rd_index;
  62         unsigned int wr_index;
  63         unsigned int block_count;
  64         unsigned char last_blocknum;
  65         wait_queue_head_t read_queue;
  66         int data_available_for_read;
  67         u8 sync;
  68 };
  69
  70 static inline struct saa6588 *to_saa6588(struct v4l2_subdev *sd)
  71 {
  72         return container_of(sd, struct saa6588, sd);
  73 }
  74
  75 /* ---------------------------------------------------------------------- */
  76
  77 /*
  78  * SAA6588 defines
  79  */
  80
  81 /* Initialization and mode control byte (0w) */
  82
  83 /* bit 0+1 (DAC0/DAC1) */
  84 #define cModeStandard           0x00
  85 #define cModeFastPI             0x01
  86 #define cModeReducedRequest     0x02
  87 #define cModeInvalid            0x03
  88
  89 /* bit 2 (RBDS) */
  90 #define cProcessingModeRDS      0x00
  91 #define cProcessingModeRBDS     0x04
  92
  93 /* bit 3+4 (SYM0/SYM1) */
  94 #define cErrCorrectionNone      0x00
  95 #define cErrCorrection2Bits     0x08
  96 #define cErrCorrection5Bits     0x10
  97 #define cErrCorrectionNoneRBDS  0x18
  98
  99 /* bit 5 (NWSY) */
 100 #define cSyncNormal             0x00
 101 #define cSyncRestart            0x20
 102
 103 /* bit 6 (TSQD) */
 104 #define cSigQualityDetectOFF    0x00
 105 #define cSigQualityDetectON     0x40
 106
 107 /* bit 7 (SQCM) */
 108 #define cSigQualityTriggered    0x00
 109 #define cSigQualityContinous    0x80
 110
 111 /* Pause level and flywheel control byte (1w) */
 112
 113 /* bits 0..5 (FEB0..FEB5) */
 114 #define cFlywheelMaxBlocksMask  0x3F
 115 #define cFlywheelDefault        0x20
 116
 117 /* bits 6+7 (PL0/PL1) */
 118 #define cPauseLevel_11mV        0x00
 119 #define cPauseLevel_17mV        0x40
 120 #define cPauseLevel_27mV        0x80
 121 #define cPauseLevel_43mV        0xC0
 122
 123 /* Pause time/oscillator frequency/quality detector control byte (1w) */
 124
 125 /* bits 0..4 (SQS0..SQS4) */
 126 #define cQualityDetectSensMask  0x1F
 127 #define cQualityDetectDefault   0x0F
 128
 129 /* bit 5 (SOSC) */
 130 #define cSelectOscFreqOFF       0x00
 131 #define cSelectOscFreqON        0x20
 132
 133 /* bit 6+7 (PTF0/PTF1) */
 134 #define cOscFreq_4332kHz        0x00
 135 #define cOscFreq_8664kHz        0x40
 136 #define cOscFreq_12996kHz       0x80
 137 #define cOscFreq_17328kHz       0xC0
 138
 139 /* ---------------------------------------------------------------------- */
 140
 141 static bool block_from_buf(struct saa6588 *s, unsigned char *buf)
 142 {
 143         int i;
 144
 145         if (s->rd_index == s->wr_index) {
 146                 if (debug > 2)
 147                         dprintk(PREFIX "Read: buffer empty.\n");
 148                 return false;
 149         }
 150
 151         if (debug > 2) {
 152                 dprintk(PREFIX "Read: ");
 153                 for (i = s->rd_index; i < s->rd_index + 3; i++)
 154                         dprintk("0x%02x ", s->buffer[i]);
 155         }
 156
 157         memcpy(buf, &s->buffer[s->rd_index], 3);
 158
 159         s->rd_index += 3;
 160         if (s->rd_index >= s->buf_size)
 161                 s->rd_index = 0;
 162         s->block_count--;
 163
 164         if (debug > 2)
 165                 dprintk("%d blocks total.\n", s->block_count);
 166
 167         return true;
 168 }
 169
 170 static void read_from_buf(struct saa6588 *s, struct saa6588_command *a)
 171 {
 172         unsigned char __user *buf_ptr = a->buffer;
 173         unsigned char buf[3];
 174         unsigned long flags;
 175         unsigned int rd_blocks;
 176         unsigned int i;
 177
 178         a->result = 0;
 179         if (!a->buffer)
 180                 return;
 181
 182         while (!a->nonblocking && !s->data_available_for_read) {
 183                 int ret = wait_event_interruptible(s->read_queue,
 184                                              s->data_available_for_read);
 185                 if (ret == -ERESTARTSYS) {
 186                         a->result = -EINTR;
 187                         return;
 188                 }
 189         }
 190
 191         rd_blocks = a->block_count;
 192         spin_lock_irqsave(&s->lock, flags);
 193         if (rd_blocks > s->block_count)
 194                 rd_blocks = s->block_count;
 195         spin_unlock_irqrestore(&s->lock, flags);
 196
 197         if (!rd_blocks)
 198                 return;
 199
 200         for (i = 0; i < rd_blocks; i++) {
 201                 bool got_block;
 202
 203                 spin_lock_irqsave(&s->lock, flags);
 204                 got_block = block_from_buf(s, buf);
 205                 spin_unlock_irqrestore(&s->lock, flags);
 206                 if (!got_block)
 207                         break;
 208                 if (copy_to_user(buf_ptr, buf, 3)) {
 209                         a->result = -EFAULT;
 210                         return;
 211                 }
 212                 buf_ptr += 3;
 213                 a->result += 3;
 214         }
 215         spin_lock_irqsave(&s->lock, flags);
 216         s->data_available_for_read = (s->block_count > 0);
 217         spin_unlock_irqrestore(&s->lock, flags);
 218 }
 219
 220 static void block_to_buf(struct saa6588 *s, unsigned char *blockbuf)
 221 {
 222         unsigned int i;
 223
 224         if (debug > 3)
 225                 dprintk(PREFIX "New block: ");
 226
 227         for (i = 0; i < 3; ++i) {
 228                 if (debug > 3)
 229                         dprintk("0x%02x ", blockbuf[i]);
 230                 s->buffer[s->wr_index] = blockbuf[i];
 231                 s->wr_index++;
 232         }
 233
 234         if (s->wr_index >= s->buf_size)
 235                 s->wr_index = 0;
 236
 237         if (s->wr_index == s->rd_index) {
 238                 s->rd_index += 3;
 239                 if (s->rd_index >= s->buf_size)
 240                         s->rd_index = 0;
 241         } else
 242                 s->block_count++;
 243
 244         if (debug > 3)
 245                 dprintk("%d blocks total.\n", s->block_count);
 246 }
 247
 248 static void saa6588_i2c_poll(struct saa6588 *s)
 249 {
 250         struct i2c_client *client = v4l2_get_subdevdata(&s->sd);
 251         unsigned long flags;
 252         unsigned char tmpbuf[6];
 253         unsigned char blocknum;
 254         unsigned char tmp;
 255
 256         /* Although we only need 3 bytes, we have to read at least 6.
 257            SAA6588 returns garbage otherwise. */
 258         if (6 != i2c_master_recv(client, &tmpbuf[0], 6)) {
 259                 if (debug > 1)
 260                         dprintk(PREFIX "read error!\n");
 261                 return;
 262         }
 263
 264         s->sync = tmpbuf[0] & 0x10;
 265         if (!s->sync)
 266                 return;
 267         blocknum = tmpbuf[0] >> 5;
 268         if (blocknum == s->last_blocknum) {
 269                 if (debug > 3)
 270                         dprintk("Saw block %d again.\n", blocknum);
 271                 return;
 272         }
 273
 274         s->last_blocknum = blocknum;
 275
 276         /*
 277            Byte order according to v4l2 specification:
 278
 279            Byte 0: Least Significant Byte of RDS Block
 280            Byte 1: Most Significant Byte of RDS Block
 281            Byte 2 Bit 7: Error bit. Indicates that an uncorrectable error
 282            occurred during reception of this block.
 283            Bit 6: Corrected bit. Indicates that an error was
 284            corrected for this data block.
 285            Bits 5-3: Same as bits 0-2.
 286            Bits 2-0: Block number.
 287
 288            SAA6588 byte order is Status-MSB-LSB, so we have to swap the
 289            first and the last of the 3 bytes block.
 290          */
 291
 292         swap(tmpbuf[2], tmpbuf[0]);
 293
 294         /* Map 'Invalid block E' to 'Invalid Block' */
 295         if (blocknum == 6)
 296                 blocknum = V4L2_RDS_BLOCK_INVALID;
 297         /* And if are not in mmbs mode, then 'Block E' is also mapped
 298            to 'Invalid Block'. As far as I can tell MMBS is discontinued,
 299            and if there is ever a need to support E blocks, then please
 300            contact the linux-media mailinglist. */
 301         else if (!mmbs && blocknum == 5)
 302                 blocknum = V4L2_RDS_BLOCK_INVALID;
 303         tmp = blocknum;
 304         tmp |= blocknum << 3;   /* Received offset == Offset Name (OK ?) */
 305         if ((tmpbuf[2] & 0x03) == 0x03)
 306                 tmp |= V4L2_RDS_BLOCK_ERROR;     /* uncorrectable error */
 307         else if ((tmpbuf[2] & 0x03) != 0x00)
 308                 tmp |= V4L2_RDS_BLOCK_CORRECTED; /* corrected error */
 309         tmpbuf[2] = tmp;        /* Is this enough ? Should we also check other bits ? */
 310
 311         spin_lock_irqsave(&s->lock, flags);
 312         block_to_buf(s, tmpbuf);
 313         spin_unlock_irqrestore(&s->lock, flags);
 314         s->data_available_for_read = 1;
 315         wake_up_interruptible(&s->read_queue);
 316 }
 317
 318 static void saa6588_work(struct work_struct *work)
 319 {
 320         struct saa6588 *s = container_of(work, struct saa6588, work.work);
 321
 322         saa6588_i2c_poll(s);
 323         schedule_delayed_work(&s->work, msecs_to_jiffies(20));
 324 }
 325
 326 static void saa6588_configure(struct saa6588 *s)
 327 {
 328         struct i2c_client *client = v4l2_get_subdevdata(&s->sd);
 329         unsigned char buf[3];
 330         int rc;
 331
 332         buf[0] = cSyncRestart;
 333         if (mmbs)
 334                 buf[0] |= cProcessingModeRBDS;
 335
 336         buf[1] = cFlywheelDefault;
 337         switch (plvl) {
 338         case 0:
 339                 buf[1] |= cPauseLevel_11mV;
 340                 break;
 341         case 1:
 342                 buf[1] |= cPauseLevel_17mV;
 343                 break;
 344         case 2:
 345                 buf[1] |= cPauseLevel_27mV;
 346                 break;
 347         case 3:
 348                 buf[1] |= cPauseLevel_43mV;
 349                 break;
 350         default:                /* nothing */
 351                 break;
 352         }
 353
 354         buf[2] = cQualityDetectDefault | cSelectOscFreqON;
 355
 356         switch (xtal) {
 357         case 0:
 358                 buf[2] |= cOscFreq_4332kHz;
 359                 break;
 360         case 1:
 361                 buf[2] |= cOscFreq_8664kHz;
 362                 break;
 363         case 2:
 364                 buf[2] |= cOscFreq_12996kHz;
 365                 break;
 366         case 3:
 367                 buf[2] |= cOscFreq_17328kHz;
 368                 break;
 369         default:                /* nothing */
 370                 break;
 371         }
 372
 373         dprintk(PREFIX "writing: 0w=0x%02x 1w=0x%02x 2w=0x%02x\n",
 374                 buf[0], buf[1], buf[2]);
 375
 376         rc = i2c_master_send(client, buf, 3);
 377         if (rc != 3)
 378                 printk(PREFIX "i2c i/o error: rc == %d (should be 3)\n", rc);
 379 }
 380
 381 /* ---------------------------------------------------------------------- */
 382
 383 static long saa6588_command(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
 384 {
 385         struct saa6588 *s = to_saa6588(sd);
 386         struct saa6588_command *a = arg;
 387
 388         switch (cmd) {
 389                 /* --- close() for /dev/radio --- */
 390         case SAA6588_CMD_CLOSE:
 391                 s->data_available_for_read = 1;
 392                 wake_up_interruptible(&s->read_queue);
 393                 s->data_available_for_read = 0;
 394                 a->result = 0;
 395                 break;
 396                 /* --- read() for /dev/radio --- */
 397         case SAA6588_CMD_READ:
 398                 read_from_buf(s, a);
 399                 break;
 400                 /* --- poll() for /dev/radio --- */
 401         case SAA6588_CMD_POLL:
 402                 a->poll_mask = 0;
 403                 if (s->data_available_for_read)
 404                         a->poll_mask |= EPOLLIN | EPOLLRDNORM;
 405                 poll_wait(a->instance, &s->read_queue, a->event_list);
 406                 break;
 407
 408         default:
 409                 /* nothing */
 410                 return -ENOIOCTLCMD;
 411         }
 412         return 0;
 413 }
 414
 415 static int saa6588_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
 416 {
 417         struct saa6588 *s = to_saa6588(sd);
 418
 419         vt->capability |= V4L2_TUNER_CAP_RDS | V4L2_TUNER_CAP_RDS_BLOCK_IO;
 420         if (s->sync)
 421                 vt->rxsubchans |= V4L2_TUNER_SUB_RDS;
 422         return 0;
 423 }
 424
 425 static int saa6588_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
 426 {
 427         struct saa6588 *s = to_saa6588(sd);
 428
 429         saa6588_configure(s);
 430         return 0;
 431 }
 432
 433 /* ----------------------------------------------------------------------- */
 434
 435 static const struct v4l2_subdev_core_ops saa6588_core_ops = {
 436         .command = saa6588_command,
 437 };
 438
 439 static const struct v4l2_subdev_tuner_ops saa6588_tuner_ops = {
 440         .g_tuner = saa6588_g_tuner,
 441         .s_tuner = saa6588_s_tuner,
 442 };
 443
 444 static const struct v4l2_subdev_ops saa6588_ops = {
 445         .core = &saa6588_core_ops,
 446         .tuner = &saa6588_tuner_ops,
 447 };
 448
 449 /* ---------------------------------------------------------------------- */
 450
 451 static int saa6588_probe(struct i2c_client *client)
 452 {
 453         struct saa6588 *s;
 454         struct v4l2_subdev *sd;
 455
 456         v4l_info(client, "saa6588 found @ 0x%x (%s)\n",
 457                         client->addr << 1, client->adapter->name);
 458
 459         s = devm_kzalloc(&client->dev, sizeof(*s), GFP_KERNEL);
 460         if (s == NULL)
 461                 return -ENOMEM;
 462
 463         s->buf_size = bufblocks * 3;
 464
 465         s->buffer = devm_kzalloc(&client->dev, s->buf_size, GFP_KERNEL);
 466         if (s->buffer == NULL)
 467                 return -ENOMEM;
 468         sd = &s->sd;
 469         v4l2_i2c_subdev_init(sd, client, &saa6588_ops);
 470         spin_lock_init(&s->lock);
 471         s->block_count = 0;
 472         s->wr_index = 0;
 473         s->rd_index = 0;
 474         s->last_blocknum = 0xff;
 475         init_waitqueue_head(&s->read_queue);
 476         s->data_available_for_read = 0;
 477
 478         saa6588_configure(s);
 479
 480         /* start polling via eventd */
 481         INIT_DELAYED_WORK(&s->work, saa6588_work);
 482         schedule_delayed_work(&s->work, 0);
 483         return 0;
 484 }
 485
 486 static void saa6588_remove(struct i2c_client *client)
 487 {
 488         struct v4l2_subdev *sd = i2c_get_clientdata(client);
 489         struct saa6588 *s = to_saa6588(sd);
 490
 491         v4l2_device_unregister_subdev(sd);
 492
 493         cancel_delayed_work_sync(&s->work);
 494 }
 495
 496 /* ----------------------------------------------------------------------- */
 497
 498 static const struct i2c_device_id saa6588_id[] = {
 499         { "saa6588", 0 },
 500         { }
 501 };
 502 MODULE_DEVICE_TABLE(i2c, saa6588_id);
 503
 504 static struct i2c_driver saa6588_driver = {
 505         .driver = {
 506                 .name   = "saa6588",
 507         },
 508         .probe_new      = saa6588_probe,
 509         .remove         = saa6588_remove,
 510         .id_table       = saa6588_id,
 511 };
 512
 513 module_i2c_driver(saa6588_driver);