1// SPDX-License-Identifier: GPL-2.0
2//
3// Driver for LNB supply and control IC STMicroelectronics LNBH29
4//
5// Copyright (c) 2018 Socionext Inc.
6
7#include <linux/module.h>
8#include <linux/init.h>
9#include <linux/slab.h>
10
11#include <media/dvb_frontend.h>
12#include "lnbh29.h"
13
14/**
15 * struct lnbh29_priv - LNBH29 driver private data
16 * @i2c: Pointer to the I2C adapter structure
17 * @i2c_address: I2C address of LNBH29 chip
18 * @config: Registers configuration
19 * offset 0: 1st register address, always 0x01 (DATA)
20 * offset 1: DATA register value
21 */
22struct lnbh29_priv {
23 struct i2c_adapter *i2c;
24 u8 i2c_address;
25 u8 config[2];
26};
27
28#define LNBH29_STATUS_OLF BIT(0)
29#define LNBH29_STATUS_OTF BIT(1)
30#define LNBH29_STATUS_VMON BIT(2)
31#define LNBH29_STATUS_PNG BIT(3)
32#define LNBH29_STATUS_PDO BIT(4)
33#define LNBH29_VSEL_MASK GENMASK(2, 0)
34#define LNBH29_VSEL_0 0x00
35/* Min: 13.188V, Typ: 13.667V, Max:14V */
36#define LNBH29_VSEL_13 0x03
37/* Min: 18.158V, Typ: 18.817V, Max:19.475V */
38#define LNBH29_VSEL_18 0x07
39
40static int lnbh29_read_vmon(struct lnbh29_priv *priv)
41{
42 u8 addr = 0x00;
43 u8 status[2];
44 int ret;
45 struct i2c_msg msg[2] = {
46 {
47 .addr = priv->i2c_address,
48 .flags = 0,
49 .len = 1,
50 .buf = &addr
51 }, {
52 .addr = priv->i2c_address,
53 .flags = I2C_M_RD,
54 .len = sizeof(status),
55 .buf = status
56 }
57 };
58
59 ret = i2c_transfer(adap: priv->i2c, msgs: msg, num: 2);
60 if (ret >= 0 && ret != 2)
61 ret = -EIO;
62 if (ret < 0) {
63 dev_dbg(&priv->i2c->dev, "LNBH29 I2C transfer failed (%d)\n",
64 ret);
65 return ret;
66 }
67
68 if (status[0] & (LNBH29_STATUS_OLF | LNBH29_STATUS_VMON)) {
69 dev_err(&priv->i2c->dev,
70 "LNBH29 voltage in failure state, status reg 0x%x\n",
71 status[0]);
72 return -EIO;
73 }
74
75 return 0;
76}
77
78static int lnbh29_set_voltage(struct dvb_frontend *fe,
79 enum fe_sec_voltage voltage)
80{
81 struct lnbh29_priv *priv = fe->sec_priv;
82 u8 data_reg;
83 int ret;
84 struct i2c_msg msg = {
85 .addr = priv->i2c_address,
86 .flags = 0,
87 .len = sizeof(priv->config),
88 .buf = priv->config
89 };
90
91 switch (voltage) {
92 case SEC_VOLTAGE_OFF:
93 data_reg = LNBH29_VSEL_0;
94 break;
95 case SEC_VOLTAGE_13:
96 data_reg = LNBH29_VSEL_13;
97 break;
98 case SEC_VOLTAGE_18:
99 data_reg = LNBH29_VSEL_18;
100 break;
101 default:
102 return -EINVAL;
103 }
104 priv->config[1] &= ~LNBH29_VSEL_MASK;
105 priv->config[1] |= data_reg;
106
107 ret = i2c_transfer(adap: priv->i2c, msgs: &msg, num: 1);
108 if (ret >= 0 && ret != 1)
109 ret = -EIO;
110 if (ret < 0) {
111 dev_err(&priv->i2c->dev, "LNBH29 I2C transfer error (%d)\n",
112 ret);
113 return ret;
114 }
115
116 /* Soft-start time (Vout 0V to 18V) is Typ. 6ms. */
117 usleep_range(min: 6000, max: 20000);
118
119 if (voltage == SEC_VOLTAGE_OFF)
120 return 0;
121
122 return lnbh29_read_vmon(priv);
123}
124
125static void lnbh29_release(struct dvb_frontend *fe)
126{
127 lnbh29_set_voltage(fe, voltage: SEC_VOLTAGE_OFF);
128 kfree(objp: fe->sec_priv);
129 fe->sec_priv = NULL;
130}
131
132struct dvb_frontend *lnbh29_attach(struct dvb_frontend *fe,
133 struct lnbh29_config *cfg,
134 struct i2c_adapter *i2c)
135{
136 struct lnbh29_priv *priv;
137
138 priv = kzalloc(size: sizeof(*priv), GFP_KERNEL);
139 if (!priv)
140 return NULL;
141
142 priv->i2c_address = (cfg->i2c_address >> 1);
143 priv->i2c = i2c;
144 priv->config[0] = 0x01;
145 priv->config[1] = cfg->data_config;
146 fe->sec_priv = priv;
147
148 if (lnbh29_set_voltage(fe, voltage: SEC_VOLTAGE_OFF)) {
149 dev_err(&i2c->dev, "no LNBH29 found at I2C addr 0x%02x\n",
150 priv->i2c_address);
151 kfree(objp: priv);
152 fe->sec_priv = NULL;
153 return NULL;
154 }
155
156 fe->ops.release_sec = lnbh29_release;
157 fe->ops.set_voltage = lnbh29_set_voltage;
158
159 dev_info(&i2c->dev, "LNBH29 attached at I2C addr 0x%02x\n",
160 priv->i2c_address);
161
162 return fe;
163}
164EXPORT_SYMBOL(lnbh29_attach);
165
166MODULE_AUTHOR("Katsuhiro Suzuki <suzuki.katsuhiro@socionext.com>");
167MODULE_DESCRIPTION("STMicroelectronics LNBH29 driver");
168MODULE_LICENSE("GPL v2");
169

source code of linux/drivers/media/dvb-frontends/lnbh29.c