xref: /OK3568_Linux_fs/kernel/drivers/media/dvb-frontends/lnbp22.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * lnbp22.h - driver for lnb supply and control ic lnbp22
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2006 Dominik Kuhlen
6*4882a593Smuzhiyun  * Based on lnbp21 driver
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * the project's page is at https://linuxtv.org
9*4882a593Smuzhiyun  */
10*4882a593Smuzhiyun #include <linux/delay.h>
11*4882a593Smuzhiyun #include <linux/errno.h>
12*4882a593Smuzhiyun #include <linux/init.h>
13*4882a593Smuzhiyun #include <linux/kernel.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/moduleparam.h>
16*4882a593Smuzhiyun #include <linux/string.h>
17*4882a593Smuzhiyun #include <linux/slab.h>
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun #include <media/dvb_frontend.h>
20*4882a593Smuzhiyun #include "lnbp22.h"
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun static int debug;
23*4882a593Smuzhiyun module_param(debug, int, 0644);
24*4882a593Smuzhiyun MODULE_PARM_DESC(debug, "Turn on/off debugging (default:off).");
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun #define dprintk(lvl, arg...) if (debug >= (lvl)) printk(arg)
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun struct lnbp22 {
30*4882a593Smuzhiyun 	u8		    config[4];
31*4882a593Smuzhiyun 	struct i2c_adapter *i2c;
32*4882a593Smuzhiyun };
33*4882a593Smuzhiyun 
lnbp22_set_voltage(struct dvb_frontend * fe,enum fe_sec_voltage voltage)34*4882a593Smuzhiyun static int lnbp22_set_voltage(struct dvb_frontend *fe,
35*4882a593Smuzhiyun 			      enum fe_sec_voltage voltage)
36*4882a593Smuzhiyun {
37*4882a593Smuzhiyun 	struct lnbp22 *lnbp22 = (struct lnbp22 *)fe->sec_priv;
38*4882a593Smuzhiyun 	struct i2c_msg msg = {
39*4882a593Smuzhiyun 		.addr = 0x08,
40*4882a593Smuzhiyun 		.flags = 0,
41*4882a593Smuzhiyun 		.buf = (char *)&lnbp22->config,
42*4882a593Smuzhiyun 		.len = sizeof(lnbp22->config),
43*4882a593Smuzhiyun 	};
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun 	dprintk(1, "%s: %d (18V=%d 13V=%d)\n", __func__, voltage,
46*4882a593Smuzhiyun 	       SEC_VOLTAGE_18, SEC_VOLTAGE_13);
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun 	lnbp22->config[3] = 0x60; /* Power down */
49*4882a593Smuzhiyun 	switch (voltage) {
50*4882a593Smuzhiyun 	case SEC_VOLTAGE_OFF:
51*4882a593Smuzhiyun 		break;
52*4882a593Smuzhiyun 	case SEC_VOLTAGE_13:
53*4882a593Smuzhiyun 		lnbp22->config[3] |= LNBP22_EN;
54*4882a593Smuzhiyun 		break;
55*4882a593Smuzhiyun 	case SEC_VOLTAGE_18:
56*4882a593Smuzhiyun 		lnbp22->config[3] |= (LNBP22_EN | LNBP22_VSEL);
57*4882a593Smuzhiyun 		break;
58*4882a593Smuzhiyun 	default:
59*4882a593Smuzhiyun 		return -EINVAL;
60*4882a593Smuzhiyun 	}
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun 	dprintk(1, "%s: 0x%02x)\n", __func__, lnbp22->config[3]);
63*4882a593Smuzhiyun 	return (i2c_transfer(lnbp22->i2c, &msg, 1) == 1) ? 0 : -EIO;
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun 
lnbp22_enable_high_lnb_voltage(struct dvb_frontend * fe,long arg)66*4882a593Smuzhiyun static int lnbp22_enable_high_lnb_voltage(struct dvb_frontend *fe, long arg)
67*4882a593Smuzhiyun {
68*4882a593Smuzhiyun 	struct lnbp22 *lnbp22 = (struct lnbp22 *) fe->sec_priv;
69*4882a593Smuzhiyun 	struct i2c_msg msg = {
70*4882a593Smuzhiyun 		.addr = 0x08,
71*4882a593Smuzhiyun 		.flags = 0,
72*4882a593Smuzhiyun 		.buf = (char *)&lnbp22->config,
73*4882a593Smuzhiyun 		.len = sizeof(lnbp22->config),
74*4882a593Smuzhiyun 	};
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun 	dprintk(1, "%s: %d\n", __func__, (int)arg);
77*4882a593Smuzhiyun 	if (arg)
78*4882a593Smuzhiyun 		lnbp22->config[3] |= LNBP22_LLC;
79*4882a593Smuzhiyun 	else
80*4882a593Smuzhiyun 		lnbp22->config[3] &= ~LNBP22_LLC;
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	return (i2c_transfer(lnbp22->i2c, &msg, 1) == 1) ? 0 : -EIO;
83*4882a593Smuzhiyun }
84*4882a593Smuzhiyun 
lnbp22_release(struct dvb_frontend * fe)85*4882a593Smuzhiyun static void lnbp22_release(struct dvb_frontend *fe)
86*4882a593Smuzhiyun {
87*4882a593Smuzhiyun 	dprintk(1, "%s\n", __func__);
88*4882a593Smuzhiyun 	/* LNBP power off */
89*4882a593Smuzhiyun 	lnbp22_set_voltage(fe, SEC_VOLTAGE_OFF);
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 	/* free data */
92*4882a593Smuzhiyun 	kfree(fe->sec_priv);
93*4882a593Smuzhiyun 	fe->sec_priv = NULL;
94*4882a593Smuzhiyun }
95*4882a593Smuzhiyun 
lnbp22_attach(struct dvb_frontend * fe,struct i2c_adapter * i2c)96*4882a593Smuzhiyun struct dvb_frontend *lnbp22_attach(struct dvb_frontend *fe,
97*4882a593Smuzhiyun 					struct i2c_adapter *i2c)
98*4882a593Smuzhiyun {
99*4882a593Smuzhiyun 	struct lnbp22 *lnbp22 = kmalloc(sizeof(struct lnbp22), GFP_KERNEL);
100*4882a593Smuzhiyun 	if (!lnbp22)
101*4882a593Smuzhiyun 		return NULL;
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 	/* default configuration */
104*4882a593Smuzhiyun 	lnbp22->config[0] = 0x00; /* ? */
105*4882a593Smuzhiyun 	lnbp22->config[1] = 0x28; /* ? */
106*4882a593Smuzhiyun 	lnbp22->config[2] = 0x48; /* ? */
107*4882a593Smuzhiyun 	lnbp22->config[3] = 0x60; /* Power down */
108*4882a593Smuzhiyun 	lnbp22->i2c = i2c;
109*4882a593Smuzhiyun 	fe->sec_priv = lnbp22;
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun 	/* detect if it is present or not */
112*4882a593Smuzhiyun 	if (lnbp22_set_voltage(fe, SEC_VOLTAGE_OFF)) {
113*4882a593Smuzhiyun 		dprintk(0, "%s LNBP22 not found\n", __func__);
114*4882a593Smuzhiyun 		kfree(lnbp22);
115*4882a593Smuzhiyun 		fe->sec_priv = NULL;
116*4882a593Smuzhiyun 		return NULL;
117*4882a593Smuzhiyun 	}
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun 	/* install release callback */
120*4882a593Smuzhiyun 	fe->ops.release_sec = lnbp22_release;
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 	/* override frontend ops */
123*4882a593Smuzhiyun 	fe->ops.set_voltage = lnbp22_set_voltage;
124*4882a593Smuzhiyun 	fe->ops.enable_high_lnb_voltage = lnbp22_enable_high_lnb_voltage;
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun 	return fe;
127*4882a593Smuzhiyun }
128*4882a593Smuzhiyun EXPORT_SYMBOL(lnbp22_attach);
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun MODULE_DESCRIPTION("Driver for lnb supply and control ic lnbp22");
131*4882a593Smuzhiyun MODULE_AUTHOR("Dominik Kuhlen");
132*4882a593Smuzhiyun MODULE_LICENSE("GPL");
133