drivers/media/pci/ddbridge/ddbridge-max.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * ddbridge-max.c: Digital Devices bridge MAX card support
   4  *
   5  * Copyright (C) 2010-2017 Digital Devices GmbH
   6  *                         Ralph Metzler <[email protected]>
   7  *                         Marcus Metzler <[email protected]>
   8  */
   9
  10 #include <linux/module.h>
  11 #include <linux/init.h>
  12 #include <linux/interrupt.h>
  13 #include <linux/delay.h>
  14 #include <linux/slab.h>
  15 #include <linux/poll.h>
  16 #include <linux/io.h>
  17 #include <linux/pci.h>
  18 #include <linux/pci_ids.h>
  19 #include <linux/timer.h>
  20 #include <linux/i2c.h>
  21 #include <linux/swab.h>
  22 #include <linux/vmalloc.h>
  23
  24 #include "ddbridge.h"
  25 #include "ddbridge-regs.h"
  26 #include "ddbridge-io.h"
  27 #include "ddbridge-mci.h"
  28
  29 #include "ddbridge-max.h"
  30 #include "mxl5xx.h"
  31
  32 /******************************************************************************/
  33
  34 /* MaxS4/8 related modparams */
  35 static int fmode;
  36 module_param(fmode, int, 0444);
  37 MODULE_PARM_DESC(fmode, "frontend emulation mode");
  38
  39 static int fmode_sat = -1;
  40 module_param(fmode_sat, int, 0444);
  41 MODULE_PARM_DESC(fmode_sat, "set frontend emulation mode sat");
  42
  43 static int old_quattro;
  44 module_param(old_quattro, int, 0444);
  45 MODULE_PARM_DESC(old_quattro, "old quattro LNB input order ");
  46
  47 /******************************************************************************/
  48
  49 static int lnb_command(struct ddb *dev, u32 link, u32 lnb, u32 cmd)
  50 {
  51         u32 c, v = 0, tag = DDB_LINK_TAG(link);
  52
  53         v = LNB_TONE & (dev->link[link].lnb.tone << (15 - lnb));
  54         ddbwritel(dev, cmd | v, tag | LNB_CONTROL(lnb));
  55         for (c = 0; c < 10; c++) {
  56                 v = ddbreadl(dev, tag | LNB_CONTROL(lnb));
  57                 if ((v & LNB_BUSY) == 0)
  58                         break;
  59                 msleep(20);
  60         }
  61         if (c == 10)
  62                 dev_info(dev->dev, "%s lnb = %08x  cmd = %08x\n",
  63                          __func__, lnb, cmd);
  64         return 0;
  65 }
  66
  67 static int max_send_master_cmd(struct dvb_frontend *fe,
  68                                struct dvb_diseqc_master_cmd *cmd)
  69 {
  70         struct ddb_input *input = fe->sec_priv;
  71         struct ddb_port *port = input->port;
  72         struct ddb *dev = port->dev;
  73         struct ddb_dvb *dvb = &port->dvb[input->nr & 1];
  74         u32 tag = DDB_LINK_TAG(port->lnr);
  75         int i;
  76         u32 fmode = dev->link[port->lnr].lnb.fmode;
  77
  78         if (fmode == 2 || fmode == 1)
  79                 return 0;
  80         if (dvb->diseqc_send_master_cmd)
  81                 dvb->diseqc_send_master_cmd(fe, cmd);
  82
  83         mutex_lock(&dev->link[port->lnr].lnb.lock);
  84         ddbwritel(dev, 0, tag | LNB_BUF_LEVEL(dvb->input));
  85         for (i = 0; i < cmd->msg_len; i++)
  86                 ddbwritel(dev, cmd->msg[i], tag | LNB_BUF_WRITE(dvb->input));
  87         lnb_command(dev, port->lnr, dvb->input, LNB_CMD_DISEQC);
  88         mutex_unlock(&dev->link[port->lnr].lnb.lock);
  89         return 0;
  90 }
  91
  92 static int lnb_send_diseqc(struct ddb *dev, u32 link, u32 input,
  93                            struct dvb_diseqc_master_cmd *cmd)
  94 {
  95         u32 tag = DDB_LINK_TAG(link);
  96         int i;
  97
  98         ddbwritel(dev, 0, tag | LNB_BUF_LEVEL(input));
  99         for (i = 0; i < cmd->msg_len; i++)
 100                 ddbwritel(dev, cmd->msg[i], tag | LNB_BUF_WRITE(input));
 101         lnb_command(dev, link, input, LNB_CMD_DISEQC);
 102         return 0;
 103 }
 104
 105 static int lnb_set_sat(struct ddb *dev, u32 link, u32 input, u32 sat, u32 band,
 106                        u32 hor)
 107 {
 108         struct dvb_diseqc_master_cmd cmd = {
 109                 .msg = {0xe0, 0x10, 0x38, 0xf0, 0x00, 0x00},
 110                 .msg_len = 4
 111         };
 112         cmd.msg[3] = 0xf0 | (((sat << 2) & 0x0c) | (band ? 1 : 0) |
 113                 (hor ? 2 : 0));
 114         return lnb_send_diseqc(dev, link, input, &cmd);
 115 }
 116
 117 static int lnb_set_tone(struct ddb *dev, u32 link, u32 input,
 118                         enum fe_sec_tone_mode tone)
 119 {
 120         int s = 0;
 121         u32 mask = (1ULL << input);
 122
 123         switch (tone) {
 124         case SEC_TONE_OFF:
 125                 if (!(dev->link[link].lnb.tone & mask))
 126                         return 0;
 127                 dev->link[link].lnb.tone &= ~(1ULL << input);
 128                 break;
 129         case SEC_TONE_ON:
 130                 if (dev->link[link].lnb.tone & mask)
 131                         return 0;
 132                 dev->link[link].lnb.tone |= (1ULL << input);
 133                 break;
 134         default:
 135                 s = -EINVAL;
 136                 break;
 137         }
 138         if (!s)
 139                 s = lnb_command(dev, link, input, LNB_CMD_NOP);
 140         return s;
 141 }
 142
 143 static int lnb_set_voltage(struct ddb *dev, u32 link, u32 input,
 144                            enum fe_sec_voltage voltage)
 145 {
 146         int s = 0;
 147
 148         if (dev->link[link].lnb.oldvoltage[input] == voltage)
 149                 return 0;
 150         switch (voltage) {
 151         case SEC_VOLTAGE_OFF:
 152                 if (dev->link[link].lnb.voltage[input])
 153                         return 0;
 154                 lnb_command(dev, link, input, LNB_CMD_OFF);
 155                 break;
 156         case SEC_VOLTAGE_13:
 157                 lnb_command(dev, link, input, LNB_CMD_LOW);
 158                 break;
 159         case SEC_VOLTAGE_18:
 160                 lnb_command(dev, link, input, LNB_CMD_HIGH);
 161                 break;
 162         default:
 163                 s = -EINVAL;
 164                 break;
 165         }
 166         dev->link[link].lnb.oldvoltage[input] = voltage;
 167         return s;
 168 }
 169
 170 static int max_set_input_unlocked(struct dvb_frontend *fe, int in)
 171 {
 172         struct ddb_input *input = fe->sec_priv;
 173         struct ddb_port *port = input->port;
 174         struct ddb *dev = port->dev;
 175         struct ddb_dvb *dvb = &port->dvb[input->nr & 1];
 176         int res = 0;
 177
 178         if (in > 3)
 179                 return -EINVAL;
 180         if (dvb->input != in) {
 181                 u32 bit = (1ULL << input->nr);
 182                 u32 obit =
 183                         dev->link[port->lnr].lnb.voltage[dvb->input & 3] & bit;
 184
 185                 dev->link[port->lnr].lnb.voltage[dvb->input & 3] &= ~bit;
 186                 dvb->input = in;
 187                 dev->link[port->lnr].lnb.voltage[dvb->input & 3] |= obit;
 188         }
 189         res = dvb->set_input(fe, in);
 190         return res;
 191 }
 192
 193 static int max_set_tone(struct dvb_frontend *fe, enum fe_sec_tone_mode tone)
 194 {
 195         struct ddb_input *input = fe->sec_priv;
 196         struct ddb_port *port = input->port;
 197         struct ddb *dev = port->dev;
 198         struct ddb_dvb *dvb = &port->dvb[input->nr & 1];
 199         int tuner = 0;
 200         int res = 0;
 201         u32 fmode = dev->link[port->lnr].lnb.fmode;
 202
 203         mutex_lock(&dev->link[port->lnr].lnb.lock);
 204         dvb->tone = tone;
 205         switch (fmode) {
 206         default:
 207         case 0:
 208         case 3:
 209                 res = lnb_set_tone(dev, port->lnr, dvb->input, tone);
 210                 break;
 211         case 1:
 212         case 2:
 213                 if (old_quattro) {
 214                         if (dvb->tone == SEC_TONE_ON)
 215                                 tuner |= 2;
 216                         if (dvb->voltage == SEC_VOLTAGE_18)
 217                                 tuner |= 1;
 218                 } else {
 219                         if (dvb->tone == SEC_TONE_ON)
 220                                 tuner |= 1;
 221                         if (dvb->voltage == SEC_VOLTAGE_18)
 222                                 tuner |= 2;
 223                 }
 224                 res = max_set_input_unlocked(fe, tuner);
 225                 break;
 226         }
 227         mutex_unlock(&dev->link[port->lnr].lnb.lock);
 228         return res;
 229 }
 230
 231 static int max_set_voltage(struct dvb_frontend *fe, enum fe_sec_voltage voltage)
 232 {
 233         struct ddb_input *input = fe->sec_priv;
 234         struct ddb_port *port = input->port;
 235         struct ddb *dev = port->dev;
 236         struct ddb_dvb *dvb = &port->dvb[input->nr & 1];
 237         int tuner = 0;
 238         u32 nv, ov = dev->link[port->lnr].lnb.voltages;
 239         int res = 0;
 240         u32 fmode = dev->link[port->lnr].lnb.fmode;
 241
 242         mutex_lock(&dev->link[port->lnr].lnb.lock);
 243         dvb->voltage = voltage;
 244
 245         switch (fmode) {
 246         case 3:
 247         default:
 248         case 0:
 249                 if (fmode == 3)
 250                         max_set_input_unlocked(fe, 0);
 251                 if (voltage == SEC_VOLTAGE_OFF)
 252                         dev->link[port->lnr].lnb.voltage[dvb->input] &=
 253                                 ~(1ULL << input->nr);
 254                 else
 255                         dev->link[port->lnr].lnb.voltage[dvb->input] |=
 256                                 (1ULL << input->nr);
 257
 258                 res = lnb_set_voltage(dev, port->lnr, dvb->input, voltage);
 259                 break;
 260         case 1:
 261         case 2:
 262                 if (voltage == SEC_VOLTAGE_OFF)
 263                         dev->link[port->lnr].lnb.voltages &=
 264                                 ~(1ULL << input->nr);
 265                 else
 266                         dev->link[port->lnr].lnb.voltages |=
 267                                 (1ULL << input->nr);
 268
 269                 nv = dev->link[port->lnr].lnb.voltages;
 270
 271                 if (old_quattro) {
 272                         if (dvb->tone == SEC_TONE_ON)
 273                                 tuner |= 2;
 274                         if (dvb->voltage == SEC_VOLTAGE_18)
 275                                 tuner |= 1;
 276                 } else {
 277                         if (dvb->tone == SEC_TONE_ON)
 278                                 tuner |= 1;
 279                         if (dvb->voltage == SEC_VOLTAGE_18)
 280                                 tuner |= 2;
 281                 }
 282                 res = max_set_input_unlocked(fe, tuner);
 283
 284                 if (nv != ov) {
 285                         if (nv) {
 286                                 lnb_set_voltage(
 287                                         dev, port->lnr,
 288                                         0, SEC_VOLTAGE_13);
 289                                 if (fmode == 1) {
 290                                         lnb_set_voltage(
 291                                                 dev, port->lnr,
 292                                                 0, SEC_VOLTAGE_13);
 293                                         if (old_quattro) {
 294                                                 lnb_set_voltage(
 295                                                         dev, port->lnr,
 296                                                         1, SEC_VOLTAGE_18);
 297                                                 lnb_set_voltage(
 298                                                         dev, port->lnr,
 299                                                         2, SEC_VOLTAGE_13);
 300                                         } else {
 301                                                 lnb_set_voltage(
 302                                                         dev, port->lnr,
 303                                                         1, SEC_VOLTAGE_13);
 304                                                 lnb_set_voltage(
 305                                                         dev, port->lnr,
 306                                                         2, SEC_VOLTAGE_18);
 307                                         }
 308                                         lnb_set_voltage(
 309                                                 dev, port->lnr,
 310                                                 3, SEC_VOLTAGE_18);
 311                                 }
 312                         } else {
 313                                 lnb_set_voltage(
 314                                         dev, port->lnr,
 315                                         0, SEC_VOLTAGE_OFF);
 316                                 if (fmode == 1) {
 317                                         lnb_set_voltage(
 318                                                 dev, port->lnr,
 319                                                 1, SEC_VOLTAGE_OFF);
 320                                         lnb_set_voltage(
 321                                                 dev, port->lnr,
 322                                                 2, SEC_VOLTAGE_OFF);
 323                                         lnb_set_voltage(
 324                                                 dev, port->lnr,
 325                                                 3, SEC_VOLTAGE_OFF);
 326                                 }
 327                         }
 328                 }
 329                 break;
 330         }
 331         mutex_unlock(&dev->link[port->lnr].lnb.lock);
 332         return res;
 333 }
 334
 335 static int max_enable_high_lnb_voltage(struct dvb_frontend *fe, long arg)
 336 {
 337         return 0;
 338 }
 339
 340 static int max_send_burst(struct dvb_frontend *fe, enum fe_sec_mini_cmd burst)
 341 {
 342         return 0;
 343 }
 344
 345 static int mxl_fw_read(void *priv, u8 *buf, u32 len)
 346 {
 347         struct ddb_link *link = priv;
 348         struct ddb *dev = link->dev;
 349
 350         dev_info(dev->dev, "Read mxl_fw from link %u\n", link->nr);
 351
 352         return ddbridge_flashread(dev, link->nr, buf, 0xc0000, len);
 353 }
 354
 355 int ddb_lnb_init_fmode(struct ddb *dev, struct ddb_link *link, u32 fm)
 356 {
 357         u32 l = link->nr;
 358
 359         if (link->lnb.fmode == fm)
 360                 return 0;
 361         dev_info(dev->dev, "Set fmode link %u = %u\n", l, fm);
 362         mutex_lock(&link->lnb.lock);
 363         if (fm == 2 || fm == 1) {
 364                 if (fmode_sat >= 0) {
 365                         lnb_set_sat(dev, l, 0, fmode_sat, 0, 0);
 366                         if (old_quattro) {
 367                                 lnb_set_sat(dev, l, 1, fmode_sat, 0, 1);
 368                                 lnb_set_sat(dev, l, 2, fmode_sat, 1, 0);
 369                         } else {
 370                                 lnb_set_sat(dev, l, 1, fmode_sat, 1, 0);
 371                                 lnb_set_sat(dev, l, 2, fmode_sat, 0, 1);
 372                         }
 373                         lnb_set_sat(dev, l, 3, fmode_sat, 1, 1);
 374                 }
 375                 lnb_set_tone(dev, l, 0, SEC_TONE_OFF);
 376                 if (old_quattro) {
 377                         lnb_set_tone(dev, l, 1, SEC_TONE_OFF);
 378                         lnb_set_tone(dev, l, 2, SEC_TONE_ON);
 379                 } else {
 380                         lnb_set_tone(dev, l, 1, SEC_TONE_ON);
 381                         lnb_set_tone(dev, l, 2, SEC_TONE_OFF);
 382                 }
 383                 lnb_set_tone(dev, l, 3, SEC_TONE_ON);
 384         }
 385         link->lnb.fmode = fm;
 386         mutex_unlock(&link->lnb.lock);
 387         return 0;
 388 }
 389
 390 static struct mxl5xx_cfg mxl5xx = {
 391         .adr      = 0x60,
 392         .type     = 0x01,
 393         .clk      = 27000000,
 394         .ts_clk   = 139,
 395         .cap      = 12,
 396         .fw_read  = mxl_fw_read,
 397 };
 398
 399 int ddb_fe_attach_mxl5xx(struct ddb_input *input)
 400 {
 401         struct ddb *dev = input->port->dev;
 402         struct i2c_adapter *i2c = &input->port->i2c->adap;
 403         struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
 404         struct ddb_port *port = input->port;
 405         struct ddb_link *link = &dev->link[port->lnr];
 406         struct mxl5xx_cfg cfg;
 407         int demod, tuner;
 408
 409         cfg = mxl5xx;
 410         cfg.fw_priv = link;
 411         dvb->set_input = NULL;
 412
 413         demod = input->nr;
 414         tuner = demod & 3;
 415         if (fmode == 3)
 416                 tuner = 0;
 417
 418         dvb->fe = dvb_attach(mxl5xx_attach, i2c, &cfg,
 419                              demod, tuner, &dvb->set_input);
 420
 421         if (!dvb->fe) {
 422                 dev_err(dev->dev, "No MXL5XX found!\n");
 423                 return -ENODEV;
 424         }
 425
 426         if (!dvb->set_input) {
 427                 dev_err(dev->dev, "No mxl5xx_set_input function pointer!\n");
 428                 return -ENODEV;
 429         }
 430
 431         if (input->nr < 4) {
 432                 lnb_command(dev, port->lnr, input->nr, LNB_CMD_INIT);
 433                 lnb_set_voltage(dev, port->lnr, input->nr, SEC_VOLTAGE_OFF);
 434         }
 435         ddb_lnb_init_fmode(dev, link, fmode);
 436
 437         dvb->fe->ops.set_voltage = max_set_voltage;
 438         dvb->fe->ops.enable_high_lnb_voltage = max_enable_high_lnb_voltage;
 439         dvb->fe->ops.set_tone = max_set_tone;
 440         dvb->diseqc_send_master_cmd = dvb->fe->ops.diseqc_send_master_cmd;
 441         dvb->fe->ops.diseqc_send_master_cmd = max_send_master_cmd;
 442         dvb->fe->ops.diseqc_send_burst = max_send_burst;
 443         dvb->fe->sec_priv = input;
 444         dvb->input = tuner;
 445         return 0;
 446 }
 447
 448 /******************************************************************************/
 449 /* MAX MCI related functions */
 450
 451 int ddb_fe_attach_mci(struct ddb_input *input, u32 type)
 452 {
 453         struct ddb *dev = input->port->dev;
 454         struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1];
 455         struct ddb_port *port = input->port;
 456         struct ddb_link *link = &dev->link[port->lnr];
 457         int demod, tuner;
 458         struct mci_cfg cfg;
 459
 460         demod = input->nr;
 461         tuner = demod & 3;
 462         switch (type) {
 463         case DDB_TUNER_MCI_SX8:
 464                 cfg = ddb_max_sx8_cfg;
 465                 if (fmode == 3)
 466                         tuner = 0;
 467                 break;
 468         default:
 469                 return -EINVAL;
 470         }
 471         dvb->fe = ddb_mci_attach(input, &cfg, demod, &dvb->set_input);
 472         if (!dvb->fe) {
 473                 dev_err(dev->dev, "No MCI card found!\n");
 474                 return -ENODEV;
 475         }
 476         if (!dvb->set_input) {
 477                 dev_err(dev->dev, "No MCI set_input function pointer!\n");
 478                 return -ENODEV;
 479         }
 480         if (input->nr < 4) {
 481                 lnb_command(dev, port->lnr, input->nr, LNB_CMD_INIT);
 482                 lnb_set_voltage(dev, port->lnr, input->nr, SEC_VOLTAGE_OFF);
 483         }
 484         ddb_lnb_init_fmode(dev, link, fmode);
 485
 486         dvb->fe->ops.set_voltage = max_set_voltage;
 487         dvb->fe->ops.enable_high_lnb_voltage = max_enable_high_lnb_voltage;
 488         dvb->fe->ops.set_tone = max_set_tone;
 489         dvb->diseqc_send_master_cmd = dvb->fe->ops.diseqc_send_master_cmd;
 490         dvb->fe->ops.diseqc_send_master_cmd = max_send_master_cmd;
 491         dvb->fe->ops.diseqc_send_burst = max_send_burst;
 492         dvb->fe->sec_priv = input;
 493         dvb->input = tuner;
 494         return 0;
 495 }