lnbp21.c revision 9c12224a607a4b22ab86784e3394b52810b9507c 
1/*
2 * lnbp21.h - driver for lnb supply and control ic lnbp21
3 *
4 * Copyright (C) 2006 Oliver Endriss
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 *
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15 * GNU General Public License for more details.
16 *
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21 * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
22 *
23 *
24 * the project's page is at http://www.linuxtv.org
25 */
26#include <linux/delay.h>
27#include <linux/errno.h>
28#include <linux/init.h>
29#include <linux/kernel.h>
30#include <linux/module.h>
31#include <linux/string.h>
32#include <linux/slab.h>
33
34#include "dvb_frontend.h"
35#include "lnbp21.h"
36
37struct lnbp21 {
38	u8			config;
39	u8			override_or;
40	u8			override_and;
41	struct i2c_adapter	*i2c;
42};
43
44static int lnbp21_set_voltage(struct dvb_frontend *fe, fe_sec_voltage_t voltage)
45{
46	struct lnbp21 *lnbp21 = (struct lnbp21 *) fe->sec_priv;
47	struct i2c_msg msg = {	.addr = 0x08, .flags = 0,
48				.buf = &lnbp21->config,
49				.len = sizeof(lnbp21->config) };
50
51	lnbp21->config &= ~(LNBP21_VSEL | LNBP21_EN);
52
53	switch(voltage) {
54	case SEC_VOLTAGE_OFF:
55		break;
56	case SEC_VOLTAGE_13:
57		lnbp21->config |= LNBP21_EN;
58		break;
59	case SEC_VOLTAGE_18:
60		lnbp21->config |= (LNBP21_EN | LNBP21_VSEL);
61		break;
62	default:
63		return -EINVAL;
64	};
65
66	lnbp21->config |= lnbp21->override_or;
67	lnbp21->config &= lnbp21->override_and;
68
69	return (i2c_transfer(lnbp21->i2c, &msg, 1) == 1) ? 0 : -EIO;
70}
71
72static int lnbp21_enable_high_lnb_voltage(struct dvb_frontend *fe, long arg)
73{
74	struct lnbp21 *lnbp21 = (struct lnbp21 *) fe->sec_priv;
75	struct i2c_msg msg = {	.addr = 0x08, .flags = 0,
76				.buf = &lnbp21->config,
77				.len = sizeof(lnbp21->config) };
78
79	if (arg)
80		lnbp21->config |= LNBP21_LLC;
81	else
82		lnbp21->config &= ~LNBP21_LLC;
83
84	lnbp21->config |= lnbp21->override_or;
85	lnbp21->config &= lnbp21->override_and;
86
87	return (i2c_transfer(lnbp21->i2c, &msg, 1) == 1) ? 0 : -EIO;
88}
89
90static void lnbp21_release(struct dvb_frontend *fe)
91{
92	/* LNBP power off */
93	lnbp21_set_voltage(fe, SEC_VOLTAGE_OFF);
94
95	/* free data */
96	kfree(fe->sec_priv);
97	fe->sec_priv = NULL;
98}
99
100struct dvb_frontend *lnbp21_attach(struct dvb_frontend *fe, struct i2c_adapter *i2c, u8 override_set, u8 override_clear)
101{
102	struct lnbp21 *lnbp21 = kmalloc(sizeof(struct lnbp21), GFP_KERNEL);
103	if (!lnbp21)
104		return NULL;
105
106	/* default configuration */
107	lnbp21->config = LNBP21_ISEL;
108	lnbp21->i2c = i2c;
109	fe->sec_priv = lnbp21;
110
111	/* bits which should be forced to '1' */
112	lnbp21->override_or = override_set;
113
114	/* bits which should be forced to '0' */
115	lnbp21->override_and = ~override_clear;
116
117	/* detect if it is present or not */
118	if (lnbp21_set_voltage(fe, SEC_VOLTAGE_OFF)) {
119		kfree(lnbp21);
120		return NULL;
121	}
122
123	/* install release callback */
124	fe->ops.release_sec = lnbp21_release;
125
126	/* override frontend ops */
127	fe->ops.set_voltage = lnbp21_set_voltage;
128	fe->ops.enable_high_lnb_voltage = lnbp21_enable_high_lnb_voltage;
129
130	return fe;
131}
132EXPORT_SYMBOL(lnbp21_attach);
133
134MODULE_DESCRIPTION("Driver for lnb supply and control ic lnbp21");
135MODULE_AUTHOR("Oliver Endriss");
136MODULE_LICENSE("GPL");
137