-
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
return err;
}
-/*****************/
-
-//i2c operation
-static int mt2063_writeregs(struct mt2063_state *state, u8 reg1,
- u8 *data, int len)
+/*
+ * mt2063_write - Write data into the I2C bus
+ */
+static u32 mt2063_write(struct mt2063_state *state,
+ u8 reg, u8 *data, u32 len)
{
+ struct dvb_frontend *fe = state->frontend;
int ret;
- u8 buf[60]; /* = { reg1, data }; */
-
+ u8 buf[60];
struct i2c_msg msg = {
.addr = state->config->tuner_address,
.flags = 0,
.len = len + 1
};
- msg.buf[0] = reg1;
+ msg.buf[0] = reg;
memcpy(msg.buf + 1, data, len);
- //printk("mt2063_writeregs state->i2c=%p\n", state->i2c);
+ fe->ops.i2c_gate_ctrl(fe, 1);
ret = i2c_transfer(state->i2c, &msg, 1);
+ fe->ops.i2c_gate_ctrl(fe, 0);
if (ret < 0)
printk("mt2063_writeregs error ret=%d\n", ret);
return ret;
}
-static int mt2063_read_regs(struct mt2063_state *state, u8 reg1, u8 * b, u8 len)
-{
- int ret;
- u8 b0[] = { reg1 };
- struct i2c_msg msg[] = {
- {
- .addr = state->config->tuner_address,
- .flags = I2C_M_RD,
- .buf = b0,
- .len = 1}, {
- .addr = state->config->tuner_address,
- .flags = I2C_M_RD,
- .buf = b,
- .len = len}
- };
-
- //printk("mt2063_read_regs state->i2c=%p\n", state->i2c);
- ret = i2c_transfer(state->i2c, msg, 2);
- if (ret < 0)
- printk("mt2063_readregs error ret=%d\n", ret);
-
- return ret;
-}
-
-//context of mt2063_userdef.c <Henry> ======================================
-//#################################################################
-//=================================================================
-/*****************************************************************************
-**
-** Name: MT_WriteSub
-**
-** Description: Write values to device using a two-wire serial bus.
-**
-** Parameters: hUserData - User-specific I/O parameter that was
-** passed to tuner's Open function.
-** addr - device serial bus address (value passed
-** as parameter to MTxxxx_Open)
-** subAddress - serial bus sub-address (Register Address)
-** pData - pointer to the Data to be written to the
-** device
-** cnt - number of bytes/registers to be written
-**
-** Returns: status:
-** MT_OK - No errors
-** MT_COMM_ERR - Serial bus communications error
-** user-defined
-**
-** Notes: This is a callback function that is called from the
-** the tuning algorithm. You MUST provide code for this
-** function to write data using the tuner's 2-wire serial
-** bus.
-**
-** The hUserData parameter is a user-specific argument.
-** If additional arguments are needed for the user's
-** serial bus read/write functions, this argument can be
-** used to supply the necessary information.
-** The hUserData parameter is initialized in the tuner's Open
-** function.
-**
-** Revision History:
-**
-** SCR Date Author Description
-** -------------------------------------------------------------------------
-** N/A 03-25-2004 DAD Original
-**
-*****************************************************************************/
-static u32 MT2063_WriteSub(struct mt2063_state *state,
- u8 subAddress, u8 *pData, u32 cnt)
-{
- u32 status = 0; /* Status to be returned */
- struct dvb_frontend *fe = state->frontend;
-
- /*
- ** ToDo: Add code here to implement a serial-bus write
- ** operation to the MTxxxx tuner. If successful,
- ** return MT_OK.
- */
-
- fe->ops.i2c_gate_ctrl(fe, 1); //I2C bypass drxk3926 close i2c bridge
-
- if (mt2063_writeregs(state, subAddress, pData, cnt) < 0) {
- status = -EINVAL;
- }
- fe->ops.i2c_gate_ctrl(fe, 0); //I2C bypass drxk3926 close i2c bridge
-
- return (status);
-}
-
-/*****************************************************************************
-**
-** Name: MT_ReadSub
-**
-** Description: Read values from device using a two-wire serial bus.
-**
-** Parameters: hUserData - User-specific I/O parameter that was
-** passed to tuner's Open function.
-** addr - device serial bus address (value passed
-** as parameter to MTxxxx_Open)
-** subAddress - serial bus sub-address (Register Address)
-** pData - pointer to the Data to be written to the
-** device
-** cnt - number of bytes/registers to be written
-**
-** Returns: status:
-** MT_OK - No errors
-** MT_COMM_ERR - Serial bus communications error
-** user-defined
-**
-** Notes: This is a callback function that is called from the
-** the tuning algorithm. You MUST provide code for this
-** function to read data using the tuner's 2-wire serial
-** bus.
-**
-** The hUserData parameter is a user-specific argument.
-** If additional arguments are needed for the user's
-** serial bus read/write functions, this argument can be
-** used to supply the necessary information.
-** The hUserData parameter is initialized in the tuner's Open
-** function.
-**
-** Revision History:
-**
-** SCR Date Author Description
-** -------------------------------------------------------------------------
-** N/A 03-25-2004 DAD Original
-**
-*****************************************************************************/
-static u32 MT2063_ReadSub(struct mt2063_state *state,
+/*
+ * mt2063_read - Read data from the I2C bus
+ */
+static u32 mt2063_read(struct mt2063_state *state,
u8 subAddress, u8 *pData, u32 cnt)
{
u32 status = 0; /* Status to be returned */
struct dvb_frontend *fe = state->frontend;
u32 i = 0;
- /*
- ** ToDo: Add code here to implement a serial-bus read
- ** operation to the MTxxxx tuner. If successful,
- ** return MT_OK.
- */
- fe->ops.i2c_gate_ctrl(fe, 1); //I2C bypass drxk3926 close i2c bridge
+ fe->ops.i2c_gate_ctrl(fe, 1);
for (i = 0; i < cnt; i++) {
- if (mt2063_read_regs(state, subAddress + i, pData + i, 1) < 0) {
- status = -EINVAL;
+ int ret;
+ u8 b0[] = { subAddress + i };
+ struct i2c_msg msg[] = {
+ {
+ .addr = state->config->tuner_address,
+ .flags = I2C_M_RD,
+ .buf = b0,
+ .len = 1
+ }, {
+ .addr = state->config->tuner_address,
+ .flags = I2C_M_RD,
+ .buf = pData + 1,
+ .len = 1
+ }
+ };
+
+ ret = i2c_transfer(state->i2c, msg, 2);
+ if (ret < 0)
break;
- }
}
-
- fe->ops.i2c_gate_ctrl(fe, 0); //I2C bypass drxk3926 close i2c bridge
-
+ fe->ops.i2c_gate_ctrl(fe, 0);
return (status);
}
do {
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_LO_STATUS,
&state->reg[MT2063_REG_LO_STATUS], 1);
{
/* read the actual tuner register values for LO1C_1 and LO1C_2 */
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_LO1C_1,
&state->
reg[MT2063_REG_LO1C_1], 2);
{
/* Read the actual tuner register values for LO2C_1, LO2C_2 and LO2C_3 */
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_LO2C_1,
&state->
reg[MT2063_REG_LO2C_1], 3);
/* Initiate ADC output to reg 0x0A */
if (reg != orig)
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_BYP_CTRL,
®, 1);
for (i = 0; i < 8; i++) {
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_ADC_OUT,
&state->
reg
/* Restore value of Register BYP_CTRL */
if (reg != orig)
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_BYP_CTRL,
&orig, 1);
}
if (reg >= MT2063_REG_END_REGS)
return -ERANGE;
- status = MT2063_ReadSub(state, reg, &state->reg[reg], 1);
+ status = mt2063_read(state, reg, &state->reg[reg], 1);
return (status);
}
};
/* Read the Part/Rev code from the tuner */
- status = MT2063_ReadSub(state, MT2063_REG_PART_REV, state->reg, 1);
+ status = mt2063_read(state, MT2063_REG_PART_REV, state->reg, 1);
if (status < 0)
return status;
return -ENODEV; /* Wrong tuner Part/Rev code */
/* Check the 2nd byte of the Part/Rev code from the tuner */
- status = MT2063_ReadSub(state,
+ status = mt2063_read(state,
MT2063_REG_RSVD_3B,
&state->reg[MT2063_REG_RSVD_3B], 1);
return -ENODEV; /* Wrong tuner Part/Rev code */
/* Reset the tuner */
- status = MT2063_WriteSub(state, MT2063_REG_LO2CQ_3, &all_resets, 1);
+ status = mt2063_write(state, MT2063_REG_LO2CQ_3, &all_resets, 1);
if (status < 0)
return status;
while (status >= 0 && *def) {
u8 reg = *def++;
u8 val = *def++;
- status = MT2063_WriteSub(state, reg, &val, 1);
+ status = mt2063_write(state, reg, &val, 1);
}
if (status < 0)
return status;
maxReads = 10;
while (status >= 0 && (FCRUN != 0) && (maxReads-- > 0)) {
msleep(2);
- status = MT2063_ReadSub(state,
+ status = mt2063_read(state,
MT2063_REG_XO_STATUS,
&state->
reg[MT2063_REG_XO_STATUS], 1);
if (FCRUN != 0)
return -ENODEV;
- status = MT2063_ReadSub(state,
+ status = mt2063_read(state,
MT2063_REG_FIFFC,
&state->reg[MT2063_REG_FIFFC], 1);
if (status < 0)
return status;
/* Read back all the registers from the tuner */
- status = MT2063_ReadSub(state,
+ status = mt2063_read(state,
MT2063_REG_PART_REV,
state->reg, MT2063_REG_END_REGS);
if (status < 0)
*/
state->reg[MT2063_REG_CTUNE_CTRL] = 0x0A;
- status = MT2063_WriteSub(state,
+ status = mt2063_write(state,
MT2063_REG_CTUNE_CTRL,
&state->reg[MT2063_REG_CTUNE_CTRL], 1);
if (status < 0)
return status;
/* Read the ClearTune filter calibration value */
- status = MT2063_ReadSub(state,
+ status = mt2063_read(state,
MT2063_REG_FIFFC,
&state->reg[MT2063_REG_FIFFC], 1);
if (status < 0)
fcu_osc = state->reg[MT2063_REG_FIFFC];
state->reg[MT2063_REG_CTUNE_CTRL] = 0x00;
- status = MT2063_WriteSub(state,
+ status = mt2063_write(state,
MT2063_REG_CTUNE_CTRL,
&state->reg[MT2063_REG_CTUNE_CTRL], 1);
if (status < 0)
/* Buffer the queue for restoration later and get actual LO2 values. */
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_LO2CQ_1,
&(tempLO2CQ[0]), 3);
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_LO2C_1,
&(tempLO2C[0]), 3);
(tempLO2CQ[2] != tempLO2C[2])) {
/* put actual LO2 value into queue (with 0 in one-shot bits) */
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO2CQ_1,
&(tempLO2C[0]), 3);
state->reg[MT2063_REG_LO1CQ_2] =
(u8) (FracN);
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO1CQ_1,
&state->
reg[MT2063_REG_LO1CQ_1], 2);
/* set the one-shot bit to load the pair of LO values */
tmpOneShot = tempLO2CQ[2] | 0xE0;
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO2CQ_3,
&tmpOneShot, 1);
if (restore) {
/* put actual LO2 value into queue (0 in one-shot bits) */
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO2CQ_1,
&(tempLO2CQ[0]), 3);
/* Buffer the queue for restoration later and get actual LO2 values. */
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_LO1CQ_1,
&(tempLO1CQ[0]), 2);
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_LO1C_1,
&(tempLO1C[0]), 2);
|| (tempLO1CQ[1] != tempLO1C[1])) {
/* put actual LO1 value into queue */
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO1CQ_1,
&(tempLO1C[0]), 2);
state->reg[MT2063_REG_LO2CQ_3] =
(u8) ((FracN2 & 0x0F));
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO1CQ_1,
&state->
reg[MT2063_REG_LO1CQ_1], 3);
tmpOneShot =
state->reg[MT2063_REG_LO2CQ_3] | 0xE0;
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO2CQ_3,
&tmpOneShot, 1);
if (restore) {
/* put previous LO1 queue value back into queue */
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_LO1CQ_1,
&(tempLO1CQ[0]), 2);
if ((Bits & 0xFF00) != 0) {
state->reg[MT2063_REG_PWR_2] &= ~(u8) (Bits >> 8);
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_PWR_2,
&state->reg[MT2063_REG_PWR_2], 1);
}
if ((Bits & 0xFF) != 0) {
state->reg[MT2063_REG_PWR_1] &= ~(u8) (Bits & 0xFF);
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_PWR_1,
&state->reg[MT2063_REG_PWR_1], 1);
}
state->reg[MT2063_REG_PWR_1] &= ~0x04; /* Turn off the bit */
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_PWR_1,
&state->reg[MT2063_REG_PWR_1], 1);
state->reg[MT2063_REG_BYP_CTRL] =
(state->reg[MT2063_REG_BYP_CTRL] & 0x9F) | 0x40;
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_BYP_CTRL,
&state->reg[MT2063_REG_BYP_CTRL],
1);
state->reg[MT2063_REG_BYP_CTRL] =
(state->reg[MT2063_REG_BYP_CTRL] & 0x9F);
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_BYP_CTRL,
&state->reg[MT2063_REG_BYP_CTRL],
1);
if (reg >= MT2063_REG_END_REGS)
status |= -ERANGE;
- status = MT2063_WriteSub(state, reg, &val,
+ status = mt2063_write(state, reg, &val,
1);
if (status >= 0)
state->reg[reg] = val;
*/
if (status >= 0) {
status |=
- MT2063_ReadSub(state,
+ mt2063_read(state,
MT2063_REG_FIFFC,
&state->reg[MT2063_REG_FIFFC], 1);
fiffc = state->reg[MT2063_REG_FIFFC];
** IMPORTANT: There is a required order for writing
** (0x05 must follow all the others).
*/
- status |= MT2063_WriteSub(state, MT2063_REG_LO1CQ_1, &state->reg[MT2063_REG_LO1CQ_1], 5); /* 0x01 - 0x05 */
+ status |= mt2063_write(state, MT2063_REG_LO1CQ_1, &state->reg[MT2063_REG_LO1CQ_1], 5); /* 0x01 - 0x05 */
if (state->tuner_id == MT2063_B0) {
/* Re-write the one-shot bits to trigger the tune operation */
- status |= MT2063_WriteSub(state, MT2063_REG_LO2CQ_3, &state->reg[MT2063_REG_LO2CQ_3], 1); /* 0x05 */
+ status |= mt2063_write(state, MT2063_REG_LO2CQ_3, &state->reg[MT2063_REG_LO2CQ_3], 1); /* 0x05 */
}
/* Write out the FIFF offset only if it's changing */
if (state->reg[MT2063_REG_FIFF_OFFSET] !=
state->reg[MT2063_REG_FIFF_OFFSET] =
(u8) fiffof;
status |=
- MT2063_WriteSub(state,
+ mt2063_write(state,
MT2063_REG_FIFF_OFFSET,
&state->
reg[MT2063_REG_FIFF_OFFSET],
projects / GitHub / moto-9609 / android_kernel_motorola_exynos9610.git / commitdiff