309 lines
6.5 KiB
C
309 lines
6.5 KiB
C
/*
|
|
Intersil ISL6423 SEC and LNB Power supply controller
|
|
|
|
Copyright (C) Manu Abraham <abraham.manu@gmail.com>
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 2 of the License, or
|
|
(at your option) any later version.
|
|
|
|
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, write to the Free Software
|
|
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/string.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include <media/dvb_frontend.h>
|
|
#include "isl6423.h"
|
|
|
|
static unsigned int verbose;
|
|
module_param(verbose, int, 0644);
|
|
MODULE_PARM_DESC(verbose, "Set Verbosity level");
|
|
|
|
#define FE_ERROR 0
|
|
#define FE_NOTICE 1
|
|
#define FE_INFO 2
|
|
#define FE_DEBUG 3
|
|
#define FE_DEBUGREG 4
|
|
|
|
#define dprintk(__y, __z, format, arg...) do { \
|
|
if (__z) { \
|
|
if ((verbose > FE_ERROR) && (verbose > __y)) \
|
|
printk(KERN_ERR "%s: " format "\n", __func__ , ##arg); \
|
|
else if ((verbose > FE_NOTICE) && (verbose > __y)) \
|
|
printk(KERN_NOTICE "%s: " format "\n", __func__ , ##arg); \
|
|
else if ((verbose > FE_INFO) && (verbose > __y)) \
|
|
printk(KERN_INFO "%s: " format "\n", __func__ , ##arg); \
|
|
else if ((verbose > FE_DEBUG) && (verbose > __y)) \
|
|
printk(KERN_DEBUG "%s: " format "\n", __func__ , ##arg); \
|
|
} else { \
|
|
if (verbose > __y) \
|
|
printk(format, ##arg); \
|
|
} \
|
|
} while (0)
|
|
|
|
struct isl6423_dev {
|
|
const struct isl6423_config *config;
|
|
struct i2c_adapter *i2c;
|
|
|
|
u8 reg_3;
|
|
u8 reg_4;
|
|
|
|
unsigned int verbose;
|
|
};
|
|
|
|
static int isl6423_write(struct isl6423_dev *isl6423, u8 reg)
|
|
{
|
|
struct i2c_adapter *i2c = isl6423->i2c;
|
|
u8 addr = isl6423->config->addr;
|
|
int err = 0;
|
|
|
|
struct i2c_msg msg = { .addr = addr, .flags = 0, .buf = ®, .len = 1 };
|
|
|
|
dprintk(FE_DEBUG, 1, "write reg %02X", reg);
|
|
err = i2c_transfer(i2c, &msg, 1);
|
|
if (err < 0)
|
|
goto exit;
|
|
return 0;
|
|
|
|
exit:
|
|
dprintk(FE_ERROR, 1, "I/O error <%d>", err);
|
|
return err;
|
|
}
|
|
|
|
static int isl6423_set_modulation(struct dvb_frontend *fe)
|
|
{
|
|
struct isl6423_dev *isl6423 = (struct isl6423_dev *) fe->sec_priv;
|
|
const struct isl6423_config *config = isl6423->config;
|
|
int err = 0;
|
|
u8 reg_2 = 0;
|
|
|
|
reg_2 = 0x01 << 5;
|
|
|
|
if (config->mod_extern)
|
|
reg_2 |= (1 << 3);
|
|
else
|
|
reg_2 |= (1 << 4);
|
|
|
|
err = isl6423_write(isl6423, reg_2);
|
|
if (err < 0)
|
|
goto exit;
|
|
return 0;
|
|
|
|
exit:
|
|
dprintk(FE_ERROR, 1, "I/O error <%d>", err);
|
|
return err;
|
|
}
|
|
|
|
static int isl6423_voltage_boost(struct dvb_frontend *fe, long arg)
|
|
{
|
|
struct isl6423_dev *isl6423 = (struct isl6423_dev *) fe->sec_priv;
|
|
u8 reg_3 = isl6423->reg_3;
|
|
u8 reg_4 = isl6423->reg_4;
|
|
int err = 0;
|
|
|
|
if (arg) {
|
|
/* EN = 1, VSPEN = 1, VBOT = 1 */
|
|
reg_4 |= (1 << 4);
|
|
reg_4 |= 0x1;
|
|
reg_3 |= (1 << 3);
|
|
} else {
|
|
/* EN = 1, VSPEN = 1, VBOT = 0 */
|
|
reg_4 |= (1 << 4);
|
|
reg_4 &= ~0x1;
|
|
reg_3 |= (1 << 3);
|
|
}
|
|
err = isl6423_write(isl6423, reg_3);
|
|
if (err < 0)
|
|
goto exit;
|
|
|
|
err = isl6423_write(isl6423, reg_4);
|
|
if (err < 0)
|
|
goto exit;
|
|
|
|
isl6423->reg_3 = reg_3;
|
|
isl6423->reg_4 = reg_4;
|
|
|
|
return 0;
|
|
exit:
|
|
dprintk(FE_ERROR, 1, "I/O error <%d>", err);
|
|
return err;
|
|
}
|
|
|
|
|
|
static int isl6423_set_voltage(struct dvb_frontend *fe,
|
|
enum fe_sec_voltage voltage)
|
|
{
|
|
struct isl6423_dev *isl6423 = (struct isl6423_dev *) fe->sec_priv;
|
|
u8 reg_3 = isl6423->reg_3;
|
|
u8 reg_4 = isl6423->reg_4;
|
|
int err = 0;
|
|
|
|
switch (voltage) {
|
|
case SEC_VOLTAGE_OFF:
|
|
/* EN = 0 */
|
|
reg_4 &= ~(1 << 4);
|
|
break;
|
|
|
|
case SEC_VOLTAGE_13:
|
|
/* EN = 1, VSPEN = 1, VTOP = 0, VBOT = 0 */
|
|
reg_4 |= (1 << 4);
|
|
reg_4 &= ~0x3;
|
|
reg_3 |= (1 << 3);
|
|
break;
|
|
|
|
case SEC_VOLTAGE_18:
|
|
/* EN = 1, VSPEN = 1, VTOP = 1, VBOT = 0 */
|
|
reg_4 |= (1 << 4);
|
|
reg_4 |= 0x2;
|
|
reg_4 &= ~0x1;
|
|
reg_3 |= (1 << 3);
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
err = isl6423_write(isl6423, reg_3);
|
|
if (err < 0)
|
|
goto exit;
|
|
|
|
err = isl6423_write(isl6423, reg_4);
|
|
if (err < 0)
|
|
goto exit;
|
|
|
|
isl6423->reg_3 = reg_3;
|
|
isl6423->reg_4 = reg_4;
|
|
|
|
return 0;
|
|
exit:
|
|
dprintk(FE_ERROR, 1, "I/O error <%d>", err);
|
|
return err;
|
|
}
|
|
|
|
static int isl6423_set_current(struct dvb_frontend *fe)
|
|
{
|
|
struct isl6423_dev *isl6423 = (struct isl6423_dev *) fe->sec_priv;
|
|
u8 reg_3 = isl6423->reg_3;
|
|
const struct isl6423_config *config = isl6423->config;
|
|
int err = 0;
|
|
|
|
switch (config->current_max) {
|
|
case SEC_CURRENT_275m:
|
|
/* 275mA */
|
|
/* ISELH = 0, ISELL = 0 */
|
|
reg_3 &= ~0x3;
|
|
break;
|
|
|
|
case SEC_CURRENT_515m:
|
|
/* 515mA */
|
|
/* ISELH = 0, ISELL = 1 */
|
|
reg_3 &= ~0x2;
|
|
reg_3 |= 0x1;
|
|
break;
|
|
|
|
case SEC_CURRENT_635m:
|
|
/* 635mA */
|
|
/* ISELH = 1, ISELL = 0 */
|
|
reg_3 &= ~0x1;
|
|
reg_3 |= 0x2;
|
|
break;
|
|
|
|
case SEC_CURRENT_800m:
|
|
/* 800mA */
|
|
/* ISELH = 1, ISELL = 1 */
|
|
reg_3 |= 0x3;
|
|
break;
|
|
}
|
|
|
|
err = isl6423_write(isl6423, reg_3);
|
|
if (err < 0)
|
|
goto exit;
|
|
|
|
switch (config->curlim) {
|
|
case SEC_CURRENT_LIM_ON:
|
|
/* DCL = 0 */
|
|
reg_3 &= ~0x10;
|
|
break;
|
|
|
|
case SEC_CURRENT_LIM_OFF:
|
|
/* DCL = 1 */
|
|
reg_3 |= 0x10;
|
|
break;
|
|
}
|
|
|
|
err = isl6423_write(isl6423, reg_3);
|
|
if (err < 0)
|
|
goto exit;
|
|
|
|
isl6423->reg_3 = reg_3;
|
|
|
|
return 0;
|
|
exit:
|
|
dprintk(FE_ERROR, 1, "I/O error <%d>", err);
|
|
return err;
|
|
}
|
|
|
|
static void isl6423_release(struct dvb_frontend *fe)
|
|
{
|
|
isl6423_set_voltage(fe, SEC_VOLTAGE_OFF);
|
|
|
|
kfree(fe->sec_priv);
|
|
fe->sec_priv = NULL;
|
|
}
|
|
|
|
struct dvb_frontend *isl6423_attach(struct dvb_frontend *fe,
|
|
struct i2c_adapter *i2c,
|
|
const struct isl6423_config *config)
|
|
{
|
|
struct isl6423_dev *isl6423;
|
|
|
|
isl6423 = kzalloc(sizeof(struct isl6423_dev), GFP_KERNEL);
|
|
if (!isl6423)
|
|
return NULL;
|
|
|
|
isl6423->config = config;
|
|
isl6423->i2c = i2c;
|
|
fe->sec_priv = isl6423;
|
|
|
|
/* SR3H = 0, SR3M = 1, SR3L = 0 */
|
|
isl6423->reg_3 = 0x02 << 5;
|
|
/* SR4H = 0, SR4M = 1, SR4L = 1 */
|
|
isl6423->reg_4 = 0x03 << 5;
|
|
|
|
if (isl6423_set_current(fe))
|
|
goto exit;
|
|
|
|
if (isl6423_set_modulation(fe))
|
|
goto exit;
|
|
|
|
fe->ops.release_sec = isl6423_release;
|
|
fe->ops.set_voltage = isl6423_set_voltage;
|
|
fe->ops.enable_high_lnb_voltage = isl6423_voltage_boost;
|
|
isl6423->verbose = verbose;
|
|
|
|
return fe;
|
|
|
|
exit:
|
|
kfree(isl6423);
|
|
fe->sec_priv = NULL;
|
|
return NULL;
|
|
}
|
|
EXPORT_SYMBOL(isl6423_attach);
|
|
|
|
MODULE_DESCRIPTION("ISL6423 SEC");
|
|
MODULE_AUTHOR("Manu Abraham");
|
|
MODULE_LICENSE("GPL");
|