From aa2762747fd39efda8276a192e4f29af3fed41f8 Mon Sep 17 00:00:00 2001 From: Ralph Metzler Date: Sun, 27 Aug 2017 23:54:49 +0200 Subject: [PATCH] move MaxS8 and special MAX card LNB functions to separate file --- ddbridge/Kbuild | 4 +- ddbridge/Makefile | 4 +- ddbridge/Makefile.kernel | 4 +- ddbridge/ddbridge-core.c | 415 +----------------------------------- ddbridge/ddbridge-max.c | 444 +++++++++++++++++++++++++++++++++++++++ ddbridge/ddbridge.h | 3 + 6 files changed, 455 insertions(+), 419 deletions(-) create mode 100644 ddbridge/ddbridge-max.c diff --git a/ddbridge/Kbuild b/ddbridge/Kbuild index 4e2bb79..7deaee3 100644 --- a/ddbridge/Kbuild +++ b/ddbridge/Kbuild @@ -1,7 +1,7 @@ EXTRA_CFLAGS += -DCONFIG_DVB_CXD2843 -DCONFIG_DVB_LNBP21 -DCONFIG_DVB_STV090x -DCONFIG_DVB_STV6110x -DCONFIG_DVB_DRXK -DCONFIG_DVB_STV0910 -DCONFIG_DVB_STV6111 -DCONFIG_DVB_LNBH25 -DCONFIG_DVB_MXL5XX -ddbridge-objs = ddbridge-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o -octonet-objs = octonet-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o +ddbridge-objs = ddbridge-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o ddbridge-max.o +octonet-objs = octonet-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o ddbridge-max.o obj-$(CONFIG_DVB_DDBRIDGE) += ddbridge.o obj-$(CONFIG_DVB_OCTONET) += octonet.o diff --git a/ddbridge/Makefile b/ddbridge/Makefile index 8ddac6f..11dac0c 100644 --- a/ddbridge/Makefile +++ b/ddbridge/Makefile @@ -2,8 +2,8 @@ # Makefile for the ddbridge device driver # -ddbridge-objs = ddbridge-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-ci.o -octonet-objs = octonet-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-ci.o +ddbridge-objs = ddbridge-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-ci.o ddbridge-max.o +octonet-objs = octonet-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-ci.o ddbridge-max.o obj-$(CONFIG_DVB_DDBRIDGE) += ddbridge.o obj-$(CONFIG_DVB_OCTONET) += octonet.o diff --git a/ddbridge/Makefile.kernel b/ddbridge/Makefile.kernel index bef5174..ce59054 100644 --- a/ddbridge/Makefile.kernel +++ b/ddbridge/Makefile.kernel @@ -2,8 +2,8 @@ # Makefile for the ddbridge device driver # -ddbridge-objs = ddbridge-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o -octonet-objs = octonet-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o +ddbridge-objs = ddbridge-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o ddbridge-max.o +octonet-objs = octonet-main.o ddbridge-hw.o ddbridge-i2c.o ddbridge-ns.o ddbridge-modulator.o ddbridge-core.o ddbridge-io.o ddbridge-ci.o ddbridge-max.o obj-$(CONFIG_DVB_DDBRIDGE) += ddbridge.o obj-$(CONFIG_DVB_OCTONET) += octonet.o diff --git a/ddbridge/ddbridge-core.c b/ddbridge/ddbridge-core.c index 0f6a2e3..c8e423f 100644 --- a/ddbridge/ddbridge-core.c +++ b/ddbridge/ddbridge-core.c @@ -48,18 +48,6 @@ static int vlan; module_param(vlan, int, 0444); MODULE_PARM_DESC(vlan, "VLAN and QoS IDs enabled"); -static int fmode; -module_param(fmode, int, 0444); -MODULE_PARM_DESC(fmode, "frontend emulation mode"); - -static int fmode_sat = -1; -module_param(fmode_sat, int, 0444); -MODULE_PARM_DESC(fmode_sat, "set frontend emulation mode sat"); - -static int old_quattro; -module_param(old_quattro, int, 0444); -MODULE_PARM_DESC(old_quattro, "old quattro LNB input order "); - static int xo2_speed = 2; module_param(xo2_speed, int, 0444); MODULE_PARM_DESC(xo2_speed, "default transfer speed for xo2 based duoflex, 0=55,1=75,2=90,3=104 MBit/s, default=2, use attribute to change for individual cards"); @@ -1350,405 +1338,6 @@ static int tuner_attach_stv6111(struct ddb_input *input, int type) return 0; } -static int lnb_command(struct ddb *dev, u32 link, u32 lnb, u32 cmd) -{ - u32 c, v = 0, tag = DDB_LINK_TAG(link); - - v = LNB_TONE & (dev->link[link].lnb.tone << (15 - lnb)); - ddbwritel(dev, cmd | v, tag | LNB_CONTROL(lnb)); - for (c = 0; c < 10; c++) { - v = ddbreadl(dev, tag | LNB_CONTROL(lnb)); - if ((v & LNB_BUSY) == 0) - break; - msleep(20); - } - if (c == 10) - dev_info(dev->dev, - "%s lnb = %08x cmd = %08x\n", - __func__, lnb, cmd); - return 0; -} - -static int max_send_master_cmd(struct dvb_frontend *fe, - struct dvb_diseqc_master_cmd *cmd) -{ - struct ddb_input *input = fe->sec_priv; - struct ddb_port *port = input->port; - struct ddb *dev = port->dev; - struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; - u32 tag = DDB_LINK_TAG(port->lnr); - int i; - u32 fmode = dev->link[port->lnr].lnb.fmode; - - if (fmode == 2 || fmode == 1) - return 0; - if (dvb->diseqc_send_master_cmd) - dvb->diseqc_send_master_cmd(fe, cmd); - - mutex_lock(&dev->link[port->lnr].lnb.lock); - ddbwritel(dev, 0, tag | LNB_BUF_LEVEL(dvb->input)); - for (i = 0; i < cmd->msg_len; i++) - ddbwritel(dev, cmd->msg[i], tag | LNB_BUF_WRITE(dvb->input)); - lnb_command(dev, port->lnr, dvb->input, LNB_CMD_DISEQC); - mutex_unlock(&dev->link[port->lnr].lnb.lock); - return 0; -} - -static int lnb_send_diseqc(struct ddb *dev, u32 link, u32 input, - struct dvb_diseqc_master_cmd *cmd) -{ - u32 tag = DDB_LINK_TAG(link); - int i; - - ddbwritel(dev, 0, tag | LNB_BUF_LEVEL(input)); - for (i = 0; i < cmd->msg_len; i++) - ddbwritel(dev, cmd->msg[i], tag | LNB_BUF_WRITE(input)); - lnb_command(dev, link, input, LNB_CMD_DISEQC); - return 0; -} - -static int lnb_set_sat(struct ddb *dev, u32 link, - u32 input, u32 sat, u32 band, u32 hor) -{ - struct dvb_diseqc_master_cmd cmd = { - .msg = {0xe0, 0x10, 0x38, 0xf0, 0x00, 0x00}, - .msg_len = 4 - }; - cmd.msg[3] = 0xf0 | (((sat << 2) & 0x0c) | - (band ? 1 : 0) | (hor ? 2 : 0)); - return lnb_send_diseqc(dev, link, input, &cmd); -} - -static int lnb_set_tone(struct ddb *dev, u32 link, u32 input, - fe_sec_tone_mode_t tone) -{ - int s = 0; - u32 mask = (1ULL << input); - - switch (tone) { - case SEC_TONE_OFF: - if (!(dev->link[link].lnb.tone & mask)) - return 0; - dev->link[link].lnb.tone &= ~(1ULL << input); - break; - case SEC_TONE_ON: - if (dev->link[link].lnb.tone & mask) - return 0; - dev->link[link].lnb.tone |= (1ULL << input); - break; - default: - s = -EINVAL; - break; - }; - if (!s) - s = lnb_command(dev, link, input, LNB_CMD_NOP); - return s; -} - -static int lnb_set_voltage(struct ddb *dev, u32 link, u32 input, - fe_sec_voltage_t voltage) -{ - int s = 0; - - if (dev->link[link].lnb.oldvoltage[input] == voltage) - return 0; - switch (voltage) { - case SEC_VOLTAGE_OFF: - if (dev->link[link].lnb.voltage[input]) - return 0; - lnb_command(dev, link, input, LNB_CMD_OFF); - break; - case SEC_VOLTAGE_13: - lnb_command(dev, link, input, LNB_CMD_LOW); - break; - case SEC_VOLTAGE_18: - lnb_command(dev, link, input, LNB_CMD_HIGH); - break; - default: - s = -EINVAL; - break; - }; - dev->link[link].lnb.oldvoltage[input] = voltage; - return s; -} - -static int max_set_input_unlocked(struct dvb_frontend *fe, int in) -{ - struct ddb_input *input = fe->sec_priv; - struct ddb_port *port = input->port; - struct ddb *dev = port->dev; - struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; - int res = 0; - - if (in > 3) - return -EINVAL; - if (dvb->input != in) { - u32 bit = (1ULL << input->nr); - u32 obit = dev->link[port->lnr].lnb.voltage[dvb->input] & bit; - - dev->link[port->lnr].lnb.voltage[dvb->input] &= ~bit; - dvb->input = in; - dev->link[port->lnr].lnb.voltage[dvb->input] |= obit; - } - res = dvb->set_input(fe, in); - return res; -} - -static int max_set_input(struct dvb_frontend *fe, int in) -{ - struct ddb_input *input = fe->sec_priv; - struct ddb_port *port = input->port; - struct ddb *dev = input->port->dev; - int res; - - mutex_lock(&dev->link[port->lnr].lnb.lock); - res = max_set_input_unlocked(fe, in); - mutex_unlock(&dev->link[port->lnr].lnb.lock); - return res; -} - -static int max_set_tone(struct dvb_frontend *fe, fe_sec_tone_mode_t tone) -{ - struct ddb_input *input = fe->sec_priv; - struct ddb_port *port = input->port; - struct ddb *dev = port->dev; - struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; - int tuner = 0; - int res = 0; - u32 fmode = dev->link[port->lnr].lnb.fmode; - - mutex_lock(&dev->link[port->lnr].lnb.lock); - dvb->tone = tone; - switch (fmode) { - default: - case 0: - case 3: - res = lnb_set_tone(dev, port->lnr, dvb->input, tone); - break; - case 1: - case 2: - if (old_quattro) { - if (dvb->tone == SEC_TONE_ON) - tuner |= 2; - if (dvb->voltage == SEC_VOLTAGE_18) - tuner |= 1; - } else { - if (dvb->tone == SEC_TONE_ON) - tuner |= 1; - if (dvb->voltage == SEC_VOLTAGE_18) - tuner |= 2; - } - res = max_set_input_unlocked(fe, tuner); - break; - } - mutex_unlock(&dev->link[port->lnr].lnb.lock); - return res; -} - -static int max_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage) -{ - struct ddb_input *input = fe->sec_priv; - struct ddb_port *port = input->port; - struct ddb *dev = port->dev; - struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; - int tuner = 0; - u32 nv, ov = dev->link[port->lnr].lnb.voltages; - int res = 0; - u32 fmode = dev->link[port->lnr].lnb.fmode; - - mutex_lock(&dev->link[port->lnr].lnb.lock); - dvb->voltage = voltage; - - switch (fmode) { - case 3: - default: - case 0: - if (fmode == 3) - max_set_input_unlocked(fe, 0); - if (voltage == SEC_VOLTAGE_OFF) - dev->link[port->lnr].lnb.voltage[dvb->input] &= - ~(1ULL << input->nr); - else - dev->link[port->lnr].lnb.voltage[dvb->input] |= - (1ULL << input->nr); - - res = lnb_set_voltage(dev, port->lnr, dvb->input, voltage); - break; - case 1: - case 2: - if (voltage == SEC_VOLTAGE_OFF) - dev->link[port->lnr].lnb.voltages &= - ~(1ULL << input->nr); - else - dev->link[port->lnr].lnb.voltages |= - (1ULL << input->nr); - nv = dev->link[port->lnr].lnb.voltages; - - if (old_quattro) { - if (dvb->tone == SEC_TONE_ON) - tuner |= 2; - if (dvb->voltage == SEC_VOLTAGE_18) - tuner |= 1; - } else { - if (dvb->tone == SEC_TONE_ON) - tuner |= 1; - if (dvb->voltage == SEC_VOLTAGE_18) - tuner |= 2; - } - res = max_set_input_unlocked(fe, tuner); - - if (nv != ov) { - if (nv) { - lnb_set_voltage(dev, port->lnr, 0, - SEC_VOLTAGE_13); - if (fmode == 1) { - lnb_set_voltage(dev, port->lnr, 0, - SEC_VOLTAGE_13); - if (old_quattro) { - lnb_set_voltage(dev, - port->lnr, 1, - SEC_VOLTAGE_18); - lnb_set_voltage(dev, port->lnr, - 2, - SEC_VOLTAGE_13); - } else { - lnb_set_voltage(dev, port->lnr, - 1, - SEC_VOLTAGE_13); - lnb_set_voltage(dev, port->lnr, - 2, - SEC_VOLTAGE_18); - } - lnb_set_voltage(dev, port->lnr, 3, - SEC_VOLTAGE_18); - } - } else { - lnb_set_voltage(dev, port->lnr, - 0, SEC_VOLTAGE_OFF); - if (fmode == 1) { - lnb_set_voltage(dev, port->lnr, 1, - SEC_VOLTAGE_OFF); - lnb_set_voltage(dev, port->lnr, 2, - SEC_VOLTAGE_OFF); - lnb_set_voltage(dev, port->lnr, 3, - SEC_VOLTAGE_OFF); - } - } - } - break; - } - mutex_unlock(&dev->link[port->lnr].lnb.lock); - return res; -} - -static int max_enable_high_lnb_voltage(struct dvb_frontend *fe, long arg) -{ - return 0; -} - -static int max_send_burst(struct dvb_frontend *fe, fe_sec_mini_cmd_t burst) -{ - return 0; -} - -static int mxl_fw_read(void *priv, u8 *buf, u32 len) -{ - struct ddb_link *link = priv; - struct ddb *dev = link->dev; - - dev_info(dev->dev, - "Read mxl_fw from link %u\n", link->nr); - - return ddbridge_flashread(dev, link->nr, buf, 0xc0000, len); -} - -static int lnb_init_fmode(struct ddb *dev, struct ddb_link *link, u32 fm) -{ - u32 l = link->nr; - - if (link->lnb.fmode == fm) - return 0; - dev_info(dev->dev, "Set fmode link %u = %u\n", l, fm); - mutex_lock(&link->lnb.lock); - if (fm == 2 || fm == 1) { - if (fmode_sat >= 0) { - lnb_set_sat(dev, l, 0, fmode_sat, 0, 0); - if (old_quattro) { - lnb_set_sat(dev, l, 1, fmode_sat, 0, 1); - lnb_set_sat(dev, l, 2, fmode_sat, 1, 0); - } else { - lnb_set_sat(dev, l, 1, fmode_sat, 1, 0); - lnb_set_sat(dev, l, 2, fmode_sat, 0, 1); - } - lnb_set_sat(dev, l, 3, fmode_sat, 1, 1); - } - lnb_set_tone(dev, l, 0, SEC_TONE_OFF); - if (old_quattro) { - lnb_set_tone(dev, l, 1, SEC_TONE_OFF); - lnb_set_tone(dev, l, 2, SEC_TONE_ON); - } else { - lnb_set_tone(dev, l, 1, SEC_TONE_ON); - lnb_set_tone(dev, l, 2, SEC_TONE_OFF); - } - lnb_set_tone(dev, l, 3, SEC_TONE_ON); - } - link->lnb.fmode = fm; - mutex_unlock(&link->lnb.lock); - return 0; -} - -static struct mxl5xx_cfg mxl5xx = { - .adr = 0x60, - .type = 0x01, - .clk = 27000000, - .ts_clk = 139, - .cap = 12, - .fw_read = mxl_fw_read, -}; - -static int fe_attach_mxl5xx(struct ddb_input *input) -{ - struct ddb *dev = input->port->dev; - struct i2c_adapter *i2c = &input->port->i2c->adap; - struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1]; - struct ddb_port *port = input->port; - struct ddb_link *link = &dev->link[port->lnr]; - struct mxl5xx_cfg cfg; - int demod, tuner; - - cfg = mxl5xx; - cfg.fw_priv = link; - if (dev->link[0].info->type == DDB_OCTONET) - ;/*cfg.ts_clk = 69;*/ - - demod = input->nr; - tuner = demod & 3; - if (fmode == 3) - tuner = 0; - dvb->fe = dvb_attach(mxl5xx_attach, i2c, &cfg, demod, tuner); - if (!dvb->fe) { - dev_err(dev->dev, "No MXL5XX found!\n"); - return -ENODEV; - } - if (input->nr < 4) { - lnb_command(dev, port->lnr, input->nr, LNB_CMD_INIT); - lnb_set_voltage(dev, port->lnr, input->nr, SEC_VOLTAGE_OFF); - } - lnb_init_fmode(dev, link, fmode); - - dvb->fe->ops.set_voltage = max_set_voltage; - dvb->fe->ops.enable_high_lnb_voltage = max_enable_high_lnb_voltage; - dvb->fe->ops.set_tone = max_set_tone; - dvb->diseqc_send_master_cmd = dvb->fe->ops.diseqc_send_master_cmd; - dvb->fe->ops.diseqc_send_master_cmd = max_send_master_cmd; - dvb->fe->ops.diseqc_send_burst = max_send_burst; - dvb->fe->sec_priv = input; - dvb->set_input = dvb->fe->ops.set_input; - dvb->fe->ops.set_input = max_set_input; - dvb->input = tuner; - return 0; -} - #if 0 static int start_input(struct ddb_input *input) { @@ -1993,7 +1582,7 @@ static int dvb_input_attach(struct ddb_input *input) dvb->fe2 = NULL; switch (port->type) { case DDB_TUNER_MXL5XX: - if (fe_attach_mxl5xx(input) < 0) + if (ddb_fe_attach_mxl5xx(input) < 0) return -ENODEV; break; case DDB_TUNER_DVBS_ST: @@ -4269,7 +3858,7 @@ static ssize_t fmode_store(struct device *device, struct device_attribute *attr, return -EINVAL; if (val > 3) return -EINVAL; - lnb_init_fmode(dev, &dev->link[num], val); + ddb_lnb_init_fmode(dev, &dev->link[num], val); return count; } diff --git a/ddbridge/ddbridge-max.c b/ddbridge/ddbridge-max.c new file mode 100644 index 0000000..2f77efe --- /dev/null +++ b/ddbridge/ddbridge-max.c @@ -0,0 +1,444 @@ +/* + * ddbridge-max.c: Digital Devices MAX card line support functions + * + * Copyright (C) 2010-2017 Digital Devices GmbH + * Ralph Metzler + * Marcus Metzler + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * version 2 only, as published by the Free Software Foundation. + * + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, point your browser to + * http://www.gnu.org/copyleft/gpl.html + */ + +#include "ddbridge.h" +#include "ddbridge-io.h" +#include "ddbridge-i2c.h" + +/* MAX LNB interface related module parameters */ + +static int fmode; +module_param(fmode, int, 0444); +MODULE_PARM_DESC(fmode, "frontend emulation mode"); + +static int fmode_sat = -1; +module_param(fmode_sat, int, 0444); +MODULE_PARM_DESC(fmode_sat, "set frontend emulation mode sat"); + +static int old_quattro; +module_param(old_quattro, int, 0444); +MODULE_PARM_DESC(old_quattro, "old quattro LNB input order "); + +/* MAX LNB interface related functions */ + +static int lnb_command(struct ddb *dev, u32 link, u32 lnb, u32 cmd) +{ + u32 c, v = 0, tag = DDB_LINK_TAG(link); + + v = LNB_TONE & (dev->link[link].lnb.tone << (15 - lnb)); + ddbwritel(dev, cmd | v, tag | LNB_CONTROL(lnb)); + for (c = 0; c < 10; c++) { + v = ddbreadl(dev, tag | LNB_CONTROL(lnb)); + if ((v & LNB_BUSY) == 0) + break; + msleep(20); + } + if (c == 10) + dev_info(dev->dev, + "%s lnb = %08x cmd = %08x\n", + __func__, lnb, cmd); + return 0; +} + +static int max_send_master_cmd(struct dvb_frontend *fe, + struct dvb_diseqc_master_cmd *cmd) +{ + struct ddb_input *input = fe->sec_priv; + struct ddb_port *port = input->port; + struct ddb *dev = port->dev; + struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; + u32 tag = DDB_LINK_TAG(port->lnr); + int i; + u32 fmode = dev->link[port->lnr].lnb.fmode; + + if (fmode == 2 || fmode == 1) + return 0; + if (dvb->diseqc_send_master_cmd) + dvb->diseqc_send_master_cmd(fe, cmd); + + mutex_lock(&dev->link[port->lnr].lnb.lock); + ddbwritel(dev, 0, tag | LNB_BUF_LEVEL(dvb->input)); + for (i = 0; i < cmd->msg_len; i++) + ddbwritel(dev, cmd->msg[i], tag | LNB_BUF_WRITE(dvb->input)); + lnb_command(dev, port->lnr, dvb->input, LNB_CMD_DISEQC); + mutex_unlock(&dev->link[port->lnr].lnb.lock); + return 0; +} + +static int lnb_send_diseqc(struct ddb *dev, u32 link, u32 input, + struct dvb_diseqc_master_cmd *cmd) +{ + u32 tag = DDB_LINK_TAG(link); + int i; + + ddbwritel(dev, 0, tag | LNB_BUF_LEVEL(input)); + for (i = 0; i < cmd->msg_len; i++) + ddbwritel(dev, cmd->msg[i], tag | LNB_BUF_WRITE(input)); + lnb_command(dev, link, input, LNB_CMD_DISEQC); + return 0; +} + +static int lnb_set_sat(struct ddb *dev, u32 link, + u32 input, u32 sat, u32 band, u32 hor) +{ + struct dvb_diseqc_master_cmd cmd = { + .msg = {0xe0, 0x10, 0x38, 0xf0, 0x00, 0x00}, + .msg_len = 4 + }; + cmd.msg[3] = 0xf0 | (((sat << 2) & 0x0c) | + (band ? 1 : 0) | (hor ? 2 : 0)); + return lnb_send_diseqc(dev, link, input, &cmd); +} + +static int lnb_set_tone(struct ddb *dev, u32 link, u32 input, + fe_sec_tone_mode_t tone) +{ + int s = 0; + u32 mask = (1ULL << input); + + switch (tone) { + case SEC_TONE_OFF: + if (!(dev->link[link].lnb.tone & mask)) + return 0; + dev->link[link].lnb.tone &= ~(1ULL << input); + break; + case SEC_TONE_ON: + if (dev->link[link].lnb.tone & mask) + return 0; + dev->link[link].lnb.tone |= (1ULL << input); + break; + default: + s = -EINVAL; + break; + }; + if (!s) + s = lnb_command(dev, link, input, LNB_CMD_NOP); + return s; +} + +static int lnb_set_voltage(struct ddb *dev, u32 link, u32 input, + fe_sec_voltage_t voltage) +{ + int s = 0; + + if (dev->link[link].lnb.oldvoltage[input] == voltage) + return 0; + switch (voltage) { + case SEC_VOLTAGE_OFF: + if (dev->link[link].lnb.voltage[input]) + return 0; + lnb_command(dev, link, input, LNB_CMD_OFF); + break; + case SEC_VOLTAGE_13: + lnb_command(dev, link, input, LNB_CMD_LOW); + break; + case SEC_VOLTAGE_18: + lnb_command(dev, link, input, LNB_CMD_HIGH); + break; + default: + s = -EINVAL; + break; + }; + dev->link[link].lnb.oldvoltage[input] = voltage; + return s; +} + +static int max_set_input_unlocked(struct dvb_frontend *fe, int in) +{ + struct ddb_input *input = fe->sec_priv; + struct ddb_port *port = input->port; + struct ddb *dev = port->dev; + struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; + int res = 0; + + if (in > 3) + return -EINVAL; + if (dvb->input != in) { + u32 bit = (1ULL << input->nr); + u32 obit = dev->link[port->lnr].lnb.voltage[dvb->input] & bit; + + dev->link[port->lnr].lnb.voltage[dvb->input] &= ~bit; + dvb->input = in; + dev->link[port->lnr].lnb.voltage[dvb->input] |= obit; + } + res = dvb->set_input(fe, in); + return res; +} + +static int max_set_input(struct dvb_frontend *fe, int in) +{ + struct ddb_input *input = fe->sec_priv; + struct ddb_port *port = input->port; + struct ddb *dev = input->port->dev; + int res; + + mutex_lock(&dev->link[port->lnr].lnb.lock); + res = max_set_input_unlocked(fe, in); + mutex_unlock(&dev->link[port->lnr].lnb.lock); + return res; +} + +static int max_set_tone(struct dvb_frontend *fe, fe_sec_tone_mode_t tone) +{ + struct ddb_input *input = fe->sec_priv; + struct ddb_port *port = input->port; + struct ddb *dev = port->dev; + struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; + int tuner = 0; + int res = 0; + u32 fmode = dev->link[port->lnr].lnb.fmode; + + mutex_lock(&dev->link[port->lnr].lnb.lock); + dvb->tone = tone; + switch (fmode) { + default: + case 0: + case 3: + res = lnb_set_tone(dev, port->lnr, dvb->input, tone); + break; + case 1: + case 2: + if (old_quattro) { + if (dvb->tone == SEC_TONE_ON) + tuner |= 2; + if (dvb->voltage == SEC_VOLTAGE_18) + tuner |= 1; + } else { + if (dvb->tone == SEC_TONE_ON) + tuner |= 1; + if (dvb->voltage == SEC_VOLTAGE_18) + tuner |= 2; + } + res = max_set_input_unlocked(fe, tuner); + break; + } + mutex_unlock(&dev->link[port->lnr].lnb.lock); + return res; +} + +static int max_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage) +{ + struct ddb_input *input = fe->sec_priv; + struct ddb_port *port = input->port; + struct ddb *dev = port->dev; + struct ddb_dvb *dvb = &port->dvb[input->nr & 1]; + int tuner = 0; + u32 nv, ov = dev->link[port->lnr].lnb.voltages; + int res = 0; + u32 fmode = dev->link[port->lnr].lnb.fmode; + + mutex_lock(&dev->link[port->lnr].lnb.lock); + dvb->voltage = voltage; + + switch (fmode) { + case 3: + default: + case 0: + if (fmode == 3) + max_set_input_unlocked(fe, 0); + if (voltage == SEC_VOLTAGE_OFF) + dev->link[port->lnr].lnb.voltage[dvb->input] &= + ~(1ULL << input->nr); + else + dev->link[port->lnr].lnb.voltage[dvb->input] |= + (1ULL << input->nr); + + res = lnb_set_voltage(dev, port->lnr, dvb->input, voltage); + break; + case 1: + case 2: + if (voltage == SEC_VOLTAGE_OFF) + dev->link[port->lnr].lnb.voltages &= + ~(1ULL << input->nr); + else + dev->link[port->lnr].lnb.voltages |= + (1ULL << input->nr); + nv = dev->link[port->lnr].lnb.voltages; + + if (old_quattro) { + if (dvb->tone == SEC_TONE_ON) + tuner |= 2; + if (dvb->voltage == SEC_VOLTAGE_18) + tuner |= 1; + } else { + if (dvb->tone == SEC_TONE_ON) + tuner |= 1; + if (dvb->voltage == SEC_VOLTAGE_18) + tuner |= 2; + } + res = max_set_input_unlocked(fe, tuner); + + if (nv != ov) { + if (nv) { + lnb_set_voltage(dev, port->lnr, 0, + SEC_VOLTAGE_13); + if (fmode == 1) { + lnb_set_voltage(dev, port->lnr, 0, + SEC_VOLTAGE_13); + if (old_quattro) { + lnb_set_voltage(dev, + port->lnr, 1, + SEC_VOLTAGE_18); + lnb_set_voltage(dev, port->lnr, + 2, + SEC_VOLTAGE_13); + } else { + lnb_set_voltage(dev, port->lnr, + 1, + SEC_VOLTAGE_13); + lnb_set_voltage(dev, port->lnr, + 2, + SEC_VOLTAGE_18); + } + lnb_set_voltage(dev, port->lnr, 3, + SEC_VOLTAGE_18); + } + } else { + lnb_set_voltage(dev, port->lnr, + 0, SEC_VOLTAGE_OFF); + if (fmode == 1) { + lnb_set_voltage(dev, port->lnr, 1, + SEC_VOLTAGE_OFF); + lnb_set_voltage(dev, port->lnr, 2, + SEC_VOLTAGE_OFF); + lnb_set_voltage(dev, port->lnr, 3, + SEC_VOLTAGE_OFF); + } + } + } + break; + } + mutex_unlock(&dev->link[port->lnr].lnb.lock); + return res; +} + +static int max_enable_high_lnb_voltage(struct dvb_frontend *fe, long arg) +{ + return 0; +} + +static int max_send_burst(struct dvb_frontend *fe, fe_sec_mini_cmd_t burst) +{ + return 0; +} + +static int mxl_fw_read(void *priv, u8 *buf, u32 len) +{ + struct ddb_link *link = priv; + struct ddb *dev = link->dev; + + dev_info(dev->dev, + "Read mxl_fw from link %u\n", link->nr); + + return ddbridge_flashread(dev, link->nr, buf, 0xc0000, len); +} + +int ddb_lnb_init_fmode(struct ddb *dev, struct ddb_link *link, u32 fm) +{ + u32 l = link->nr; + + if (link->lnb.fmode == fm) + return 0; + dev_info(dev->dev, "Set fmode link %u = %u\n", l, fm); + mutex_lock(&link->lnb.lock); + if (fm == 2 || fm == 1) { + if (fmode_sat >= 0) { + lnb_set_sat(dev, l, 0, fmode_sat, 0, 0); + if (old_quattro) { + lnb_set_sat(dev, l, 1, fmode_sat, 0, 1); + lnb_set_sat(dev, l, 2, fmode_sat, 1, 0); + } else { + lnb_set_sat(dev, l, 1, fmode_sat, 1, 0); + lnb_set_sat(dev, l, 2, fmode_sat, 0, 1); + } + lnb_set_sat(dev, l, 3, fmode_sat, 1, 1); + } + lnb_set_tone(dev, l, 0, SEC_TONE_OFF); + if (old_quattro) { + lnb_set_tone(dev, l, 1, SEC_TONE_OFF); + lnb_set_tone(dev, l, 2, SEC_TONE_ON); + } else { + lnb_set_tone(dev, l, 1, SEC_TONE_ON); + lnb_set_tone(dev, l, 2, SEC_TONE_OFF); + } + lnb_set_tone(dev, l, 3, SEC_TONE_ON); + } + link->lnb.fmode = fm; + mutex_unlock(&link->lnb.lock); + return 0; +} + +/* MAXS8 related functions */ + +static struct mxl5xx_cfg mxl5xx = { + .adr = 0x60, + .type = 0x01, + .clk = 27000000, + .ts_clk = 139, + .cap = 12, + .fw_read = mxl_fw_read, +}; + +int ddb_fe_attach_mxl5xx(struct ddb_input *input) +{ + struct ddb *dev = input->port->dev; + struct i2c_adapter *i2c = &input->port->i2c->adap; + struct ddb_dvb *dvb = &input->port->dvb[input->nr & 1]; + struct ddb_port *port = input->port; + struct ddb_link *link = &dev->link[port->lnr]; + struct mxl5xx_cfg cfg; + int demod, tuner; + + cfg = mxl5xx; + cfg.fw_priv = link; + if (dev->link[0].info->type == DDB_OCTONET) + ;/*cfg.ts_clk = 69;*/ + + demod = input->nr; + tuner = demod & 3; + if (fmode == 3) + tuner = 0; + dvb->fe = dvb_attach(mxl5xx_attach, i2c, &cfg, demod, tuner); + if (!dvb->fe) { + dev_err(dev->dev, "No MXL5XX found!\n"); + return -ENODEV; + } + if (input->nr < 4) { + lnb_command(dev, port->lnr, input->nr, LNB_CMD_INIT); + lnb_set_voltage(dev, port->lnr, input->nr, SEC_VOLTAGE_OFF); + } + ddb_lnb_init_fmode(dev, link, fmode); + + dvb->fe->ops.set_voltage = max_set_voltage; + dvb->fe->ops.enable_high_lnb_voltage = max_enable_high_lnb_voltage; + dvb->fe->ops.set_tone = max_set_tone; + dvb->diseqc_send_master_cmd = dvb->fe->ops.diseqc_send_master_cmd; + dvb->fe->ops.diseqc_send_master_cmd = max_send_master_cmd; + dvb->fe->ops.diseqc_send_burst = max_send_burst; + dvb->fe->sec_priv = input; + dvb->set_input = dvb->fe->ops.set_input; + dvb->fe->ops.set_input = max_set_input; + dvb->input = tuner; + return 0; +} + diff --git a/ddbridge/ddbridge.h b/ddbridge/ddbridge.h index cd62269..0167f2d 100644 --- a/ddbridge/ddbridge.h +++ b/ddbridge/ddbridge.h @@ -566,4 +566,7 @@ void ddb_i2c_release(struct ddb *dev); int ddb_ci_attach(struct ddb_port *port, u32 bitrate); +int ddb_fe_attach_mxl5xx(struct ddb_input *input); +int ddb_lnb_init_fmode(struct ddb *dev, struct ddb_link *link, u32 fm); + #endif