Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / media / dvb-frontends / a8293.c
1 /*
2  * Allegro A8293 SEC driver
3  *
4  * Copyright (C) 2011 Antti Palosaari <crope@iki.fi>
5  *
6  *    This program is free software; you can redistribute it and/or modify
7  *    it under the terms of the GNU General Public License as published by
8  *    the Free Software Foundation; either version 2 of the License, or
9  *    (at your option) any later version.
10  *
11  *    This program is distributed in the hope that it will be useful,
12  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *    GNU General Public License for more details.
15  *
16  *    You should have received a copy of the GNU General Public License along
17  *    with this program; if not, write to the Free Software Foundation, Inc.,
18  *    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19  */
20
21 #include "dvb_frontend.h"
22 #include "a8293.h"
23
24 struct a8293_priv {
25         struct i2c_adapter *i2c;
26         const struct a8293_config *cfg;
27         u8 reg[2];
28 };
29
30 static int a8293_i2c(struct a8293_priv *priv, u8 *val, int len, bool rd)
31 {
32         int ret;
33         struct i2c_msg msg[1] = {
34                 {
35                         .addr = priv->cfg->i2c_addr,
36                         .len = len,
37                         .buf = val,
38                 }
39         };
40
41         if (rd)
42                 msg[0].flags = I2C_M_RD;
43         else
44                 msg[0].flags = 0;
45
46         ret = i2c_transfer(priv->i2c, msg, 1);
47         if (ret == 1) {
48                 ret = 0;
49         } else {
50                 dev_warn(&priv->i2c->dev, "%s: i2c failed=%d rd=%d\n",
51                                 KBUILD_MODNAME, ret, rd);
52                 ret = -EREMOTEIO;
53         }
54
55         return ret;
56 }
57
58 static int a8293_wr(struct a8293_priv *priv, u8 *val, int len)
59 {
60         return a8293_i2c(priv, val, len, 0);
61 }
62
63 static int a8293_rd(struct a8293_priv *priv, u8 *val, int len)
64 {
65         return a8293_i2c(priv, val, len, 1);
66 }
67
68 static int a8293_set_voltage(struct dvb_frontend *fe,
69         fe_sec_voltage_t fe_sec_voltage)
70 {
71         struct a8293_priv *priv = fe->sec_priv;
72         int ret;
73
74         dev_dbg(&priv->i2c->dev, "%s: fe_sec_voltage=%d\n", __func__,
75                         fe_sec_voltage);
76
77         switch (fe_sec_voltage) {
78         case SEC_VOLTAGE_OFF:
79                 /* ENB=0 */
80                 priv->reg[0] = 0x10;
81                 break;
82         case SEC_VOLTAGE_13:
83                 /* VSEL0=1, VSEL1=0, VSEL2=0, VSEL3=0, ENB=1*/
84                 priv->reg[0] = 0x31;
85                 break;
86         case SEC_VOLTAGE_18:
87                 /* VSEL0=0, VSEL1=0, VSEL2=0, VSEL3=1, ENB=1*/
88                 priv->reg[0] = 0x38;
89                 break;
90         default:
91                 ret = -EINVAL;
92                 goto err;
93         }
94
95         ret = a8293_wr(priv, &priv->reg[0], 1);
96         if (ret)
97                 goto err;
98
99         usleep_range(1500, 50000);
100
101         return ret;
102 err:
103         dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
104         return ret;
105 }
106
107 static void a8293_release_sec(struct dvb_frontend *fe)
108 {
109         a8293_set_voltage(fe, SEC_VOLTAGE_OFF);
110
111         kfree(fe->sec_priv);
112         fe->sec_priv = NULL;
113 }
114
115 struct dvb_frontend *a8293_attach(struct dvb_frontend *fe,
116         struct i2c_adapter *i2c, const struct a8293_config *cfg)
117 {
118         int ret;
119         struct a8293_priv *priv = NULL;
120         u8 buf[2];
121
122         /* allocate memory for the internal priv */
123         priv = kzalloc(sizeof(struct a8293_priv), GFP_KERNEL);
124         if (priv == NULL) {
125                 ret = -ENOMEM;
126                 goto err;
127         }
128
129         /* setup the priv */
130         priv->i2c = i2c;
131         priv->cfg = cfg;
132         fe->sec_priv = priv;
133
134         /* check if the SEC is there */
135         ret = a8293_rd(priv, buf, 2);
136         if (ret)
137                 goto err;
138
139         /* ENB=0 */
140         priv->reg[0] = 0x10;
141         ret = a8293_wr(priv, &priv->reg[0], 1);
142         if (ret)
143                 goto err;
144
145         /* TMODE=0, TGATE=1 */
146         priv->reg[1] = 0x82;
147         ret = a8293_wr(priv, &priv->reg[1], 1);
148         if (ret)
149                 goto err;
150
151         fe->ops.release_sec = a8293_release_sec;
152
153         /* override frontend ops */
154         fe->ops.set_voltage = a8293_set_voltage;
155
156         dev_info(&priv->i2c->dev, "%s: Allegro A8293 SEC attached\n",
157                         KBUILD_MODNAME);
158
159         return fe;
160 err:
161         dev_dbg(&i2c->dev, "%s: failed=%d\n", __func__, ret);
162         kfree(priv);
163         return NULL;
164 }
165 EXPORT_SYMBOL(a8293_attach);
166
167 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
168 MODULE_DESCRIPTION("Allegro A8293 SEC driver");
169 MODULE_LICENSE("GPL");