1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
17
18#include <linux/i2c.h>
19#include <linux/slab.h>
20#include <linux/export.h>
21
22#include "hdpvr.h"
23
24#define CTRL_READ_REQUEST 0xb8
25#define CTRL_WRITE_REQUEST 0x38
26
27#define REQTYPE_I2C_READ 0xb1
28#define REQTYPE_I2C_WRITE 0xb0
29#define REQTYPE_I2C_WRITE_STATT 0xd0
30
31#define Z8F0811_IR_TX_I2C_ADDR 0x70
32#define Z8F0811_IR_RX_I2C_ADDR 0x71
33
34
35struct i2c_client *hdpvr_register_ir_tx_i2c(struct hdpvr_device *dev)
36{
37 struct IR_i2c_init_data *init_data = &dev->ir_i2c_init_data;
38 struct i2c_board_info hdpvr_ir_tx_i2c_board_info = {
39 I2C_BOARD_INFO("ir_tx_z8f0811_hdpvr", Z8F0811_IR_TX_I2C_ADDR),
40 };
41
42 init_data->name = "HD-PVR";
43 hdpvr_ir_tx_i2c_board_info.platform_data = init_data;
44
45 return i2c_new_device(&dev->i2c_adapter, &hdpvr_ir_tx_i2c_board_info);
46}
47
48struct i2c_client *hdpvr_register_ir_rx_i2c(struct hdpvr_device *dev)
49{
50 struct IR_i2c_init_data *init_data = &dev->ir_i2c_init_data;
51 struct i2c_board_info hdpvr_ir_rx_i2c_board_info = {
52 I2C_BOARD_INFO("ir_rx_z8f0811_hdpvr", Z8F0811_IR_RX_I2C_ADDR),
53 };
54
55
56 init_data->ir_codes = RC_MAP_HAUPPAUGE;
57 init_data->internal_get_key_func = IR_KBD_GET_KEY_HAUP_XVR;
58 init_data->type = RC_TYPE_RC5;
59 init_data->name = "HD-PVR";
60 init_data->polling_interval = 405;
61 hdpvr_ir_rx_i2c_board_info.platform_data = init_data;
62
63 return i2c_new_device(&dev->i2c_adapter, &hdpvr_ir_rx_i2c_board_info);
64}
65
66static int hdpvr_i2c_read(struct hdpvr_device *dev, int bus,
67 unsigned char addr, char *wdata, int wlen,
68 char *data, int len)
69{
70 int ret;
71
72 if ((len > sizeof(dev->i2c_buf)) || (wlen > sizeof(dev->i2c_buf)))
73 return -EINVAL;
74
75 if (wlen) {
76 memcpy(&dev->i2c_buf, wdata, wlen);
77 ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
78 REQTYPE_I2C_WRITE, CTRL_WRITE_REQUEST,
79 (bus << 8) | addr, 0, &dev->i2c_buf,
80 wlen, 1000);
81 if (ret < 0)
82 return ret;
83 }
84
85 ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
86 REQTYPE_I2C_READ, CTRL_READ_REQUEST,
87 (bus << 8) | addr, 0, &dev->i2c_buf, len, 1000);
88
89 if (ret == len) {
90 memcpy(data, &dev->i2c_buf, len);
91 ret = 0;
92 } else if (ret >= 0)
93 ret = -EIO;
94
95 return ret;
96}
97
98static int hdpvr_i2c_write(struct hdpvr_device *dev, int bus,
99 unsigned char addr, char *data, int len)
100{
101 int ret;
102
103 if (len > sizeof(dev->i2c_buf))
104 return -EINVAL;
105
106 memcpy(&dev->i2c_buf, data, len);
107 ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
108 REQTYPE_I2C_WRITE, CTRL_WRITE_REQUEST,
109 (bus << 8) | addr, 0, &dev->i2c_buf, len, 1000);
110
111 if (ret < 0)
112 return ret;
113
114 ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
115 REQTYPE_I2C_WRITE_STATT, CTRL_READ_REQUEST,
116 0, 0, &dev->i2c_buf, 2, 1000);
117
118 if ((ret == 2) && (dev->i2c_buf[1] == (len - 1)))
119 ret = 0;
120 else if (ret >= 0)
121 ret = -EIO;
122
123 return ret;
124}
125
126static int hdpvr_transfer(struct i2c_adapter *i2c_adapter, struct i2c_msg *msgs,
127 int num)
128{
129 struct hdpvr_device *dev = i2c_get_adapdata(i2c_adapter);
130 int retval = 0, addr;
131
132 if (num <= 0)
133 return 0;
134
135 mutex_lock(&dev->i2c_mutex);
136
137 addr = msgs[0].addr << 1;
138
139 if (num == 1) {
140 if (msgs[0].flags & I2C_M_RD)
141 retval = hdpvr_i2c_read(dev, 1, addr, NULL, 0,
142 msgs[0].buf, msgs[0].len);
143 else
144 retval = hdpvr_i2c_write(dev, 1, addr, msgs[0].buf,
145 msgs[0].len);
146 } else if (num == 2) {
147 if (msgs[0].addr != msgs[1].addr) {
148 v4l2_warn(&dev->v4l2_dev, "refusing 2-phase i2c xfer "
149 "with conflicting target addresses\n");
150 retval = -EINVAL;
151 goto out;
152 }
153
154 if ((msgs[0].flags & I2C_M_RD) || !(msgs[1].flags & I2C_M_RD)) {
155 v4l2_warn(&dev->v4l2_dev, "refusing complex xfer with "
156 "r0=%d, r1=%d\n", msgs[0].flags & I2C_M_RD,
157 msgs[1].flags & I2C_M_RD);
158 retval = -EINVAL;
159 goto out;
160 }
161
162
163
164
165
166 retval = hdpvr_i2c_read(dev, 1, addr, msgs[0].buf, msgs[0].len,
167 msgs[1].buf, msgs[1].len);
168 } else {
169 v4l2_warn(&dev->v4l2_dev, "refusing %d-phase i2c xfer\n", num);
170 }
171
172out:
173 mutex_unlock(&dev->i2c_mutex);
174
175 return retval ? retval : num;
176}
177
178static u32 hdpvr_functionality(struct i2c_adapter *adapter)
179{
180 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
181}
182
183static struct i2c_algorithm hdpvr_algo = {
184 .master_xfer = hdpvr_transfer,
185 .functionality = hdpvr_functionality,
186};
187
188static struct i2c_adapter hdpvr_i2c_adapter_template = {
189 .name = "Hauppage HD PVR I2C",
190 .owner = THIS_MODULE,
191 .algo = &hdpvr_algo,
192};
193
194static int hdpvr_activate_ir(struct hdpvr_device *dev)
195{
196 char buffer[2];
197
198 mutex_lock(&dev->i2c_mutex);
199
200 hdpvr_i2c_read(dev, 0, 0x54, NULL, 0, buffer, 1);
201
202 buffer[0] = 0;
203 buffer[1] = 0x8;
204 hdpvr_i2c_write(dev, 1, 0x54, buffer, 2);
205
206 buffer[1] = 0x18;
207 hdpvr_i2c_write(dev, 1, 0x54, buffer, 2);
208
209 mutex_unlock(&dev->i2c_mutex);
210
211 return 0;
212}
213
214int hdpvr_register_i2c_adapter(struct hdpvr_device *dev)
215{
216 int retval = -ENOMEM;
217
218 hdpvr_activate_ir(dev);
219
220 memcpy(&dev->i2c_adapter, &hdpvr_i2c_adapter_template,
221 sizeof(struct i2c_adapter));
222 dev->i2c_adapter.dev.parent = &dev->udev->dev;
223
224 i2c_set_adapdata(&dev->i2c_adapter, dev);
225
226 retval = i2c_add_adapter(&dev->i2c_adapter);
227
228 return retval;
229}
230
231#endif
232