diff options
-rw-r--r-- | drivers/media/dvb/Kconfig | 2 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/Kconfig | 26 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/Makefile | 17 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/avc.c | 1051 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/avc.h | 432 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/cmp.c | 171 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/cmp.h | 9 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-1394.c | 332 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-avc.c | 1315 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-ci.c | 93 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-ci.h | 9 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-dvb.c | 328 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-fe.c | 61 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-iso.c | 111 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-rc.c | 1 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv-rc.h | 11 | ||||
-rw-r--r-- | drivers/media/dvb/firewire/firedtv.h | 257 |
17 files changed, 1895 insertions, 2331 deletions
diff --git a/drivers/media/dvb/Kconfig b/drivers/media/dvb/Kconfig index 5a74c5c62f15..b0198691892a 100644 --- a/drivers/media/dvb/Kconfig +++ b/drivers/media/dvb/Kconfig | |||
@@ -51,6 +51,8 @@ comment "Supported SDMC DM1105 Adapters" | |||
51 | depends on DVB_CORE && PCI && I2C | 51 | depends on DVB_CORE && PCI && I2C |
52 | source "drivers/media/dvb/dm1105/Kconfig" | 52 | source "drivers/media/dvb/dm1105/Kconfig" |
53 | 53 | ||
54 | comment "Supported FireWire (IEEE 1394) Adapters" | ||
55 | depends on DVB_CORE && IEEE1394 | ||
54 | source "drivers/media/dvb/firewire/Kconfig" | 56 | source "drivers/media/dvb/firewire/Kconfig" |
55 | 57 | ||
56 | comment "Supported DVB Frontends" | 58 | comment "Supported DVB Frontends" |
diff --git a/drivers/media/dvb/firewire/Kconfig b/drivers/media/dvb/firewire/Kconfig index 03d25ad10350..69028253e984 100644 --- a/drivers/media/dvb/firewire/Kconfig +++ b/drivers/media/dvb/firewire/Kconfig | |||
@@ -1,12 +1,22 @@ | |||
1 | config DVB_FIREDTV | 1 | config DVB_FIREDTV |
2 | tristate "FireDTV (FireWire attached DVB receivers)" | 2 | tristate "FireDTV and FloppyDTV" |
3 | depends on DVB_CORE && IEEE1394 && INPUT | 3 | depends on DVB_CORE && IEEE1394 |
4 | help | 4 | help |
5 | Support for DVB receivers from Digital Everywhere, known as FireDTV | 5 | Support for DVB receivers from Digital Everywhere |
6 | and FloppyDTV, which are connected via IEEE 1394 (FireWire). | 6 | which are connected via IEEE 1394 (FireWire). |
7 | 7 | ||
8 | These devices don't have an MPEG decoder built in, so you need | 8 | These devices don't have an MPEG decoder built in, |
9 | an external software decoder to watch TV. | 9 | so you need an external software decoder to watch TV. |
10 | 10 | ||
11 | To compile this driver as a module, say M here: the module will be | 11 | To compile this driver as a module, say M here: |
12 | called firedtv. | 12 | the module will be called firedtv. |
13 | |||
14 | if DVB_FIREDTV | ||
15 | |||
16 | config DVB_FIREDTV_IEEE1394 | ||
17 | def_bool IEEE1394 | ||
18 | |||
19 | config DVB_FIREDTV_INPUT | ||
20 | def_bool INPUT = y || (INPUT = m && DVB_FIREDTV = m) | ||
21 | |||
22 | endif # DVB_FIREDTV | ||
diff --git a/drivers/media/dvb/firewire/Makefile b/drivers/media/dvb/firewire/Makefile index 628dacd10daf..2034695ba194 100644 --- a/drivers/media/dvb/firewire/Makefile +++ b/drivers/media/dvb/firewire/Makefile | |||
@@ -1,13 +1,8 @@ | |||
1 | firedtv-objs := firedtv-1394.o \ | ||
2 | firedtv-dvb.o \ | ||
3 | firedtv-fe.o \ | ||
4 | firedtv-iso.o \ | ||
5 | avc.o \ | ||
6 | cmp.o \ | ||
7 | firedtv-rc.o \ | ||
8 | firedtv-ci.o | ||
9 | |||
10 | obj-$(CONFIG_DVB_FIREDTV) += firedtv.o | 1 | obj-$(CONFIG_DVB_FIREDTV) += firedtv.o |
11 | 2 | ||
12 | EXTRA_CFLAGS := -Idrivers/ieee1394 | 3 | firedtv-y := firedtv-avc.o firedtv-ci.o firedtv-dvb.o firedtv-fe.o |
13 | EXTRA_CFLAGS += -Idrivers/media/dvb/dvb-core | 4 | firedtv-$(CONFIG_DVB_FIREDTV_IEEE1394) += firedtv-1394.o |
5 | firedtv-$(CONFIG_DVB_FIREDTV_INPUT) += firedtv-rc.o | ||
6 | |||
7 | ccflags-y += -Idrivers/media/dvb/dvb-core | ||
8 | ccflags-$(CONFIG_DVB_FIREDTV_IEEE1394) += -Idrivers/ieee1394 | ||
diff --git a/drivers/media/dvb/firewire/avc.c b/drivers/media/dvb/firewire/avc.c deleted file mode 100644 index 847a537b1f58..000000000000 --- a/drivers/media/dvb/firewire/avc.c +++ /dev/null | |||
@@ -1,1051 +0,0 @@ | |||
1 | /* | ||
2 | * FireDTV driver (formerly known as FireSAT) | ||
3 | * | ||
4 | * Copyright (C) 2004 Andreas Monitzer <andy@monitzer.com> | ||
5 | * Copyright (C) 2008 Ben Backx <ben@bbackx.com> | ||
6 | * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or | ||
9 | * modify it under the terms of the GNU General Public License as | ||
10 | * published by the Free Software Foundation; either version 2 of | ||
11 | * the License, or (at your option) any later version. | ||
12 | */ | ||
13 | |||
14 | #include <linux/bug.h> | ||
15 | #include <linux/crc32.h> | ||
16 | #include <linux/delay.h> | ||
17 | #include <linux/device.h> | ||
18 | #include <linux/kernel.h> | ||
19 | #include <linux/moduleparam.h> | ||
20 | #include <linux/mutex.h> | ||
21 | #include <linux/string.h> | ||
22 | #include <linux/wait.h> | ||
23 | #include <linux/workqueue.h> | ||
24 | |||
25 | #include <ieee1394_transactions.h> | ||
26 | #include <nodemgr.h> | ||
27 | |||
28 | #include "avc.h" | ||
29 | #include "firedtv.h" | ||
30 | #include "firedtv-rc.h" | ||
31 | |||
32 | #define FCP_COMMAND_REGISTER 0xfffff0000b00ULL | ||
33 | |||
34 | static int __avc_write(struct firedtv *fdtv, | ||
35 | const AVCCmdFrm *CmdFrm, AVCRspFrm *RspFrm) | ||
36 | { | ||
37 | int err, retry; | ||
38 | |||
39 | if (RspFrm) | ||
40 | fdtv->avc_reply_received = false; | ||
41 | |||
42 | for (retry = 0; retry < 6; retry++) { | ||
43 | err = hpsb_node_write(fdtv->ud->ne, FCP_COMMAND_REGISTER, | ||
44 | (quadlet_t *)CmdFrm, CmdFrm->length); | ||
45 | if (err) { | ||
46 | fdtv->avc_reply_received = true; | ||
47 | dev_err(&fdtv->ud->device, | ||
48 | "FCP command write failed\n"); | ||
49 | return err; | ||
50 | } | ||
51 | |||
52 | if (!RspFrm) | ||
53 | return 0; | ||
54 | |||
55 | /* | ||
56 | * AV/C specs say that answers should be sent within 150 ms. | ||
57 | * Time out after 200 ms. | ||
58 | */ | ||
59 | if (wait_event_timeout(fdtv->avc_wait, | ||
60 | fdtv->avc_reply_received, | ||
61 | HZ / 5) != 0) { | ||
62 | memcpy(RspFrm, fdtv->respfrm, fdtv->resp_length); | ||
63 | RspFrm->length = fdtv->resp_length; | ||
64 | |||
65 | return 0; | ||
66 | } | ||
67 | } | ||
68 | dev_err(&fdtv->ud->device, "FCP response timed out\n"); | ||
69 | return -ETIMEDOUT; | ||
70 | } | ||
71 | |||
72 | static int avc_write(struct firedtv *fdtv, | ||
73 | const AVCCmdFrm *CmdFrm, AVCRspFrm *RspFrm) | ||
74 | { | ||
75 | int ret; | ||
76 | |||
77 | if (mutex_lock_interruptible(&fdtv->avc_mutex)) | ||
78 | return -EINTR; | ||
79 | |||
80 | ret = __avc_write(fdtv, CmdFrm, RspFrm); | ||
81 | |||
82 | mutex_unlock(&fdtv->avc_mutex); | ||
83 | return ret; | ||
84 | } | ||
85 | |||
86 | int avc_recv(struct firedtv *fdtv, u8 *data, size_t length) | ||
87 | { | ||
88 | AVCRspFrm *RspFrm = (AVCRspFrm *)data; | ||
89 | |||
90 | if (length >= 8 && | ||
91 | RspFrm->operand[0] == SFE_VENDOR_DE_COMPANYID_0 && | ||
92 | RspFrm->operand[1] == SFE_VENDOR_DE_COMPANYID_1 && | ||
93 | RspFrm->operand[2] == SFE_VENDOR_DE_COMPANYID_2 && | ||
94 | RspFrm->operand[3] == SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL) { | ||
95 | if (RspFrm->resp == CHANGED) { | ||
96 | fdtv_handle_rc(fdtv, | ||
97 | RspFrm->operand[4] << 8 | RspFrm->operand[5]); | ||
98 | schedule_work(&fdtv->remote_ctrl_work); | ||
99 | } else if (RspFrm->resp != INTERIM) { | ||
100 | dev_info(&fdtv->ud->device, | ||
101 | "remote control result = %d\n", RspFrm->resp); | ||
102 | } | ||
103 | return 0; | ||
104 | } | ||
105 | |||
106 | if (fdtv->avc_reply_received) { | ||
107 | dev_err(&fdtv->ud->device, | ||
108 | "received out-of-order AVC response, ignored\n"); | ||
109 | return -EIO; | ||
110 | } | ||
111 | |||
112 | memcpy(fdtv->respfrm, data, length); | ||
113 | fdtv->resp_length = length; | ||
114 | |||
115 | fdtv->avc_reply_received = true; | ||
116 | wake_up(&fdtv->avc_wait); | ||
117 | |||
118 | return 0; | ||
119 | } | ||
120 | |||
121 | /* | ||
122 | * tuning command for setting the relative LNB frequency | ||
123 | * (not supported by the AVC standard) | ||
124 | */ | ||
125 | static void avc_tuner_tuneqpsk(struct firedtv *fdtv, | ||
126 | struct dvb_frontend_parameters *params, AVCCmdFrm *CmdFrm) | ||
127 | { | ||
128 | CmdFrm->opcode = VENDOR; | ||
129 | |||
130 | CmdFrm->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
131 | CmdFrm->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
132 | CmdFrm->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
133 | CmdFrm->operand[3] = SFE_VENDOR_OPCODE_TUNE_QPSK; | ||
134 | |||
135 | CmdFrm->operand[4] = (params->frequency >> 24) & 0xff; | ||
136 | CmdFrm->operand[5] = (params->frequency >> 16) & 0xff; | ||
137 | CmdFrm->operand[6] = (params->frequency >> 8) & 0xff; | ||
138 | CmdFrm->operand[7] = params->frequency & 0xff; | ||
139 | |||
140 | CmdFrm->operand[8] = ((params->u.qpsk.symbol_rate / 1000) >> 8) & 0xff; | ||
141 | CmdFrm->operand[9] = (params->u.qpsk.symbol_rate / 1000) & 0xff; | ||
142 | |||
143 | switch(params->u.qpsk.fec_inner) { | ||
144 | case FEC_1_2: | ||
145 | CmdFrm->operand[10] = 0x1; break; | ||
146 | case FEC_2_3: | ||
147 | CmdFrm->operand[10] = 0x2; break; | ||
148 | case FEC_3_4: | ||
149 | CmdFrm->operand[10] = 0x3; break; | ||
150 | case FEC_5_6: | ||
151 | CmdFrm->operand[10] = 0x4; break; | ||
152 | case FEC_7_8: | ||
153 | CmdFrm->operand[10] = 0x5; break; | ||
154 | case FEC_4_5: | ||
155 | case FEC_8_9: | ||
156 | case FEC_AUTO: | ||
157 | default: | ||
158 | CmdFrm->operand[10] = 0x0; | ||
159 | } | ||
160 | |||
161 | if (fdtv->voltage == 0xff) | ||
162 | CmdFrm->operand[11] = 0xff; | ||
163 | else if (fdtv->voltage == SEC_VOLTAGE_18) /* polarisation */ | ||
164 | CmdFrm->operand[11] = 0; | ||
165 | else | ||
166 | CmdFrm->operand[11] = 1; | ||
167 | |||
168 | if (fdtv->tone == 0xff) | ||
169 | CmdFrm->operand[12] = 0xff; | ||
170 | else if (fdtv->tone == SEC_TONE_ON) /* band */ | ||
171 | CmdFrm->operand[12] = 1; | ||
172 | else | ||
173 | CmdFrm->operand[12] = 0; | ||
174 | |||
175 | if (fdtv->type == FIREDTV_DVB_S2) { | ||
176 | CmdFrm->operand[13] = 0x1; | ||
177 | CmdFrm->operand[14] = 0xff; | ||
178 | CmdFrm->operand[15] = 0xff; | ||
179 | CmdFrm->length = 20; | ||
180 | } else { | ||
181 | CmdFrm->length = 16; | ||
182 | } | ||
183 | } | ||
184 | |||
185 | static void avc_tuner_dsd_dvb_c(struct dvb_frontend_parameters *params, | ||
186 | AVCCmdFrm *CmdFrm) | ||
187 | { | ||
188 | M_VALID_FLAGS flags; | ||
189 | |||
190 | flags.Bits.Modulation = params->u.qam.modulation != QAM_AUTO; | ||
191 | flags.Bits.FEC_inner = params->u.qam.fec_inner != FEC_AUTO; | ||
192 | flags.Bits.FEC_outer = 0; | ||
193 | flags.Bits.Symbol_Rate = 1; | ||
194 | flags.Bits.Frequency = 1; | ||
195 | flags.Bits.Orbital_Pos = 0; | ||
196 | flags.Bits.Polarisation = 0; | ||
197 | flags.Bits.reserved_fields = 0; | ||
198 | flags.Bits.reserved1 = 0; | ||
199 | flags.Bits.Network_ID = 0; | ||
200 | |||
201 | CmdFrm->opcode = DSD; | ||
202 | |||
203 | CmdFrm->operand[0] = 0; /* source plug */ | ||
204 | CmdFrm->operand[1] = 0xd2; /* subfunction replace */ | ||
205 | CmdFrm->operand[2] = 0x20; /* system id = DVB */ | ||
206 | CmdFrm->operand[3] = 0x00; /* antenna number */ | ||
207 | /* system_specific_multiplex selection_length */ | ||
208 | CmdFrm->operand[4] = 0x11; | ||
209 | CmdFrm->operand[5] = flags.Valid_Word.ByteHi; /* valid_flags [0] */ | ||
210 | CmdFrm->operand[6] = flags.Valid_Word.ByteLo; /* valid_flags [1] */ | ||
211 | CmdFrm->operand[7] = 0x00; | ||
212 | CmdFrm->operand[8] = 0x00; | ||
213 | CmdFrm->operand[9] = 0x00; | ||
214 | CmdFrm->operand[10] = 0x00; | ||
215 | |||
216 | CmdFrm->operand[11] = | ||
217 | (((params->frequency / 4000) >> 16) & 0xff) | (2 << 6); | ||
218 | CmdFrm->operand[12] = | ||
219 | ((params->frequency / 4000) >> 8) & 0xff; | ||
220 | CmdFrm->operand[13] = (params->frequency / 4000) & 0xff; | ||
221 | CmdFrm->operand[14] = | ||
222 | ((params->u.qpsk.symbol_rate / 1000) >> 12) & 0xff; | ||
223 | CmdFrm->operand[15] = | ||
224 | ((params->u.qpsk.symbol_rate / 1000) >> 4) & 0xff; | ||
225 | CmdFrm->operand[16] = | ||
226 | ((params->u.qpsk.symbol_rate / 1000) << 4) & 0xf0; | ||
227 | CmdFrm->operand[17] = 0x00; | ||
228 | |||
229 | switch (params->u.qpsk.fec_inner) { | ||
230 | case FEC_1_2: | ||
231 | CmdFrm->operand[18] = 0x1; break; | ||
232 | case FEC_2_3: | ||
233 | CmdFrm->operand[18] = 0x2; break; | ||
234 | case FEC_3_4: | ||
235 | CmdFrm->operand[18] = 0x3; break; | ||
236 | case FEC_5_6: | ||
237 | CmdFrm->operand[18] = 0x4; break; | ||
238 | case FEC_7_8: | ||
239 | CmdFrm->operand[18] = 0x5; break; | ||
240 | case FEC_8_9: | ||
241 | CmdFrm->operand[18] = 0x6; break; | ||
242 | case FEC_4_5: | ||
243 | CmdFrm->operand[18] = 0x8; break; | ||
244 | case FEC_AUTO: | ||
245 | default: | ||
246 | CmdFrm->operand[18] = 0x0; | ||
247 | } | ||
248 | switch (params->u.qam.modulation) { | ||
249 | case QAM_16: | ||
250 | CmdFrm->operand[19] = 0x08; break; | ||
251 | case QAM_32: | ||
252 | CmdFrm->operand[19] = 0x10; break; | ||
253 | case QAM_64: | ||
254 | CmdFrm->operand[19] = 0x18; break; | ||
255 | case QAM_128: | ||
256 | CmdFrm->operand[19] = 0x20; break; | ||
257 | case QAM_256: | ||
258 | CmdFrm->operand[19] = 0x28; break; | ||
259 | case QAM_AUTO: | ||
260 | default: | ||
261 | CmdFrm->operand[19] = 0x00; | ||
262 | } | ||
263 | CmdFrm->operand[20] = 0x00; | ||
264 | CmdFrm->operand[21] = 0x00; | ||
265 | /* Nr_of_dsd_sel_specs = 0 -> no PIDs are transmitted */ | ||
266 | CmdFrm->operand[22] = 0x00; | ||
267 | |||
268 | CmdFrm->length = 28; | ||
269 | } | ||
270 | |||
271 | static void avc_tuner_dsd_dvb_t(struct dvb_frontend_parameters *params, | ||
272 | AVCCmdFrm *CmdFrm) | ||
273 | { | ||
274 | M_VALID_FLAGS flags; | ||
275 | |||
276 | flags.Bits_T.GuardInterval = | ||
277 | params->u.ofdm.guard_interval != GUARD_INTERVAL_AUTO; | ||
278 | flags.Bits_T.CodeRateLPStream = | ||
279 | params->u.ofdm.code_rate_LP != FEC_AUTO; | ||
280 | flags.Bits_T.CodeRateHPStream = | ||
281 | params->u.ofdm.code_rate_HP != FEC_AUTO; | ||
282 | flags.Bits_T.HierarchyInfo = | ||
283 | params->u.ofdm.hierarchy_information != HIERARCHY_AUTO; | ||
284 | flags.Bits_T.Constellation = | ||
285 | params->u.ofdm.constellation != QAM_AUTO; | ||
286 | flags.Bits_T.Bandwidth = | ||
287 | params->u.ofdm.bandwidth != BANDWIDTH_AUTO; | ||
288 | flags.Bits_T.CenterFrequency = 1; | ||
289 | flags.Bits_T.reserved1 = 0; | ||
290 | flags.Bits_T.reserved2 = 0; | ||
291 | flags.Bits_T.OtherFrequencyFlag = 0; | ||
292 | flags.Bits_T.TransmissionMode = | ||
293 | params->u.ofdm.transmission_mode != TRANSMISSION_MODE_AUTO; | ||
294 | flags.Bits_T.NetworkId = 0; | ||
295 | |||
296 | CmdFrm->opcode = DSD; | ||
297 | |||
298 | CmdFrm->operand[0] = 0; /* source plug */ | ||
299 | CmdFrm->operand[1] = 0xd2; /* subfunction replace */ | ||
300 | CmdFrm->operand[2] = 0x20; /* system id = DVB */ | ||
301 | CmdFrm->operand[3] = 0x00; /* antenna number */ | ||
302 | /* system_specific_multiplex selection_length */ | ||
303 | CmdFrm->operand[4] = 0x0c; | ||
304 | CmdFrm->operand[5] = flags.Valid_Word.ByteHi; /* valid_flags [0] */ | ||
305 | CmdFrm->operand[6] = flags.Valid_Word.ByteLo; /* valid_flags [1] */ | ||
306 | CmdFrm->operand[7] = 0x0; | ||
307 | CmdFrm->operand[8] = (params->frequency / 10) >> 24; | ||
308 | CmdFrm->operand[9] = ((params->frequency / 10) >> 16) & 0xff; | ||
309 | CmdFrm->operand[10] = ((params->frequency / 10) >> 8) & 0xff; | ||
310 | CmdFrm->operand[11] = (params->frequency / 10) & 0xff; | ||
311 | |||
312 | switch (params->u.ofdm.bandwidth) { | ||
313 | case BANDWIDTH_7_MHZ: | ||
314 | CmdFrm->operand[12] = 0x20; break; | ||
315 | case BANDWIDTH_8_MHZ: | ||
316 | case BANDWIDTH_6_MHZ: /* not defined by AVC spec */ | ||
317 | case BANDWIDTH_AUTO: | ||
318 | default: | ||
319 | CmdFrm->operand[12] = 0x00; | ||
320 | } | ||
321 | switch (params->u.ofdm.constellation) { | ||
322 | case QAM_16: | ||
323 | CmdFrm->operand[13] = 1 << 6; break; | ||
324 | case QAM_64: | ||
325 | CmdFrm->operand[13] = 2 << 6; break; | ||
326 | case QPSK: | ||
327 | default: | ||
328 | CmdFrm->operand[13] = 0x00; | ||
329 | } | ||
330 | switch (params->u.ofdm.hierarchy_information) { | ||
331 | case HIERARCHY_1: | ||
332 | CmdFrm->operand[13] |= 1 << 3; break; | ||
333 | case HIERARCHY_2: | ||
334 | CmdFrm->operand[13] |= 2 << 3; break; | ||
335 | case HIERARCHY_4: | ||
336 | CmdFrm->operand[13] |= 3 << 3; break; | ||
337 | case HIERARCHY_AUTO: | ||
338 | case HIERARCHY_NONE: | ||
339 | default: | ||
340 | break; | ||
341 | } | ||
342 | switch (params->u.ofdm.code_rate_HP) { | ||
343 | case FEC_2_3: | ||
344 | CmdFrm->operand[13] |= 1; break; | ||
345 | case FEC_3_4: | ||
346 | CmdFrm->operand[13] |= 2; break; | ||
347 | case FEC_5_6: | ||
348 | CmdFrm->operand[13] |= 3; break; | ||
349 | case FEC_7_8: | ||
350 | CmdFrm->operand[13] |= 4; break; | ||
351 | case FEC_1_2: | ||
352 | default: | ||
353 | break; | ||
354 | } | ||
355 | switch (params->u.ofdm.code_rate_LP) { | ||
356 | case FEC_2_3: | ||
357 | CmdFrm->operand[14] = 1 << 5; break; | ||
358 | case FEC_3_4: | ||
359 | CmdFrm->operand[14] = 2 << 5; break; | ||
360 | case FEC_5_6: | ||
361 | CmdFrm->operand[14] = 3 << 5; break; | ||
362 | case FEC_7_8: | ||
363 | CmdFrm->operand[14] = 4 << 5; break; | ||
364 | case FEC_1_2: | ||
365 | default: | ||
366 | CmdFrm->operand[14] = 0x00; break; | ||
367 | } | ||
368 | switch (params->u.ofdm.guard_interval) { | ||
369 | case GUARD_INTERVAL_1_16: | ||
370 | CmdFrm->operand[14] |= 1 << 3; break; | ||
371 | case GUARD_INTERVAL_1_8: | ||
372 | CmdFrm->operand[14] |= 2 << 3; break; | ||
373 | case GUARD_INTERVAL_1_4: | ||
374 | CmdFrm->operand[14] |= 3 << 3; break; | ||
375 | case GUARD_INTERVAL_1_32: | ||
376 | case GUARD_INTERVAL_AUTO: | ||
377 | default: | ||
378 | break; | ||
379 | } | ||
380 | switch (params->u.ofdm.transmission_mode) { | ||
381 | case TRANSMISSION_MODE_8K: | ||
382 | CmdFrm->operand[14] |= 1 << 1; break; | ||
383 | case TRANSMISSION_MODE_2K: | ||
384 | case TRANSMISSION_MODE_AUTO: | ||
385 | default: | ||
386 | break; | ||
387 | } | ||
388 | |||
389 | CmdFrm->operand[15] = 0x00; /* network_ID[0] */ | ||
390 | CmdFrm->operand[16] = 0x00; /* network_ID[1] */ | ||
391 | /* Nr_of_dsd_sel_specs = 0 -> no PIDs are transmitted */ | ||
392 | CmdFrm->operand[17] = 0x00; | ||
393 | |||
394 | CmdFrm->length = 24; | ||
395 | } | ||
396 | |||
397 | int avc_tuner_dsd(struct firedtv *fdtv, | ||
398 | struct dvb_frontend_parameters *params) | ||
399 | { | ||
400 | AVCCmdFrm CmdFrm; | ||
401 | AVCRspFrm RspFrm; | ||
402 | |||
403 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
404 | |||
405 | CmdFrm.cts = AVC; | ||
406 | CmdFrm.ctype = CONTROL; | ||
407 | CmdFrm.sutyp = 0x5; | ||
408 | CmdFrm.suid = fdtv->subunit; | ||
409 | |||
410 | switch (fdtv->type) { | ||
411 | case FIREDTV_DVB_S: | ||
412 | case FIREDTV_DVB_S2: | ||
413 | avc_tuner_tuneqpsk(fdtv, params, &CmdFrm); break; | ||
414 | case FIREDTV_DVB_C: | ||
415 | avc_tuner_dsd_dvb_c(params, &CmdFrm); break; | ||
416 | case FIREDTV_DVB_T: | ||
417 | avc_tuner_dsd_dvb_t(params, &CmdFrm); break; | ||
418 | default: | ||
419 | BUG(); | ||
420 | } | ||
421 | |||
422 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
423 | return -EIO; | ||
424 | |||
425 | msleep(500); | ||
426 | #if 0 | ||
427 | /* FIXME: */ | ||
428 | /* u8 *status was an out-parameter of avc_tuner_dsd, unused by caller */ | ||
429 | if(status) | ||
430 | *status=RspFrm.operand[2]; | ||
431 | #endif | ||
432 | return 0; | ||
433 | } | ||
434 | |||
435 | int avc_tuner_set_pids(struct firedtv *fdtv, unsigned char pidc, u16 pid[]) | ||
436 | { | ||
437 | AVCCmdFrm CmdFrm; | ||
438 | AVCRspFrm RspFrm; | ||
439 | int pos, k; | ||
440 | |||
441 | if (pidc > 16 && pidc != 0xff) | ||
442 | return -EINVAL; | ||
443 | |||
444 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
445 | |||
446 | CmdFrm.cts = AVC; | ||
447 | CmdFrm.ctype = CONTROL; | ||
448 | CmdFrm.sutyp = 0x5; | ||
449 | CmdFrm.suid = fdtv->subunit; | ||
450 | CmdFrm.opcode = DSD; | ||
451 | |||
452 | CmdFrm.operand[0] = 0; // source plug | ||
453 | CmdFrm.operand[1] = 0xD2; // subfunction replace | ||
454 | CmdFrm.operand[2] = 0x20; // system id = DVB | ||
455 | CmdFrm.operand[3] = 0x00; // antenna number | ||
456 | CmdFrm.operand[4] = 0x00; // system_specific_multiplex selection_length | ||
457 | CmdFrm.operand[5] = pidc; // Nr_of_dsd_sel_specs | ||
458 | |||
459 | pos = 6; | ||
460 | if (pidc != 0xff) | ||
461 | for (k = 0; k < pidc; k++) { | ||
462 | CmdFrm.operand[pos++] = 0x13; // flowfunction relay | ||
463 | CmdFrm.operand[pos++] = 0x80; // dsd_sel_spec_valid_flags -> PID | ||
464 | CmdFrm.operand[pos++] = (pid[k] >> 8) & 0x1F; | ||
465 | CmdFrm.operand[pos++] = pid[k] & 0xFF; | ||
466 | CmdFrm.operand[pos++] = 0x00; // tableID | ||
467 | CmdFrm.operand[pos++] = 0x00; // filter_length | ||
468 | } | ||
469 | |||
470 | CmdFrm.length = ALIGN(3 + pos, 4); | ||
471 | |||
472 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
473 | return -EIO; | ||
474 | |||
475 | msleep(50); | ||
476 | return 0; | ||
477 | } | ||
478 | |||
479 | int avc_tuner_get_ts(struct firedtv *fdtv) | ||
480 | { | ||
481 | AVCCmdFrm CmdFrm; | ||
482 | AVCRspFrm RspFrm; | ||
483 | |||
484 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
485 | |||
486 | CmdFrm.cts = AVC; | ||
487 | CmdFrm.ctype = CONTROL; | ||
488 | CmdFrm.sutyp = 0x5; | ||
489 | CmdFrm.suid = fdtv->subunit; | ||
490 | CmdFrm.opcode = DSIT; | ||
491 | |||
492 | CmdFrm.operand[0] = 0; // source plug | ||
493 | CmdFrm.operand[1] = 0xD2; // subfunction replace | ||
494 | CmdFrm.operand[2] = 0xFF; //status | ||
495 | CmdFrm.operand[3] = 0x20; // system id = DVB | ||
496 | CmdFrm.operand[4] = 0x00; // antenna number | ||
497 | CmdFrm.operand[5] = 0x0; // system_specific_search_flags | ||
498 | CmdFrm.operand[6] = (fdtv->type == FIREDTV_DVB_T)?0x0c:0x11; // system_specific_multiplex selection_length | ||
499 | CmdFrm.operand[7] = 0x00; // valid_flags [0] | ||
500 | CmdFrm.operand[8] = 0x00; // valid_flags [1] | ||
501 | CmdFrm.operand[7 + (fdtv->type == FIREDTV_DVB_T)?0x0c:0x11] = 0x00; // nr_of_dsit_sel_specs (always 0) | ||
502 | |||
503 | CmdFrm.length = (fdtv->type == FIREDTV_DVB_T)?24:28; | ||
504 | |||
505 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
506 | return -EIO; | ||
507 | |||
508 | msleep(250); | ||
509 | return 0; | ||
510 | } | ||
511 | |||
512 | int avc_identify_subunit(struct firedtv *fdtv) | ||
513 | { | ||
514 | AVCCmdFrm CmdFrm; | ||
515 | AVCRspFrm RspFrm; | ||
516 | |||
517 | memset(&CmdFrm,0,sizeof(AVCCmdFrm)); | ||
518 | |||
519 | CmdFrm.cts = AVC; | ||
520 | CmdFrm.ctype = CONTROL; | ||
521 | CmdFrm.sutyp = 0x5; // tuner | ||
522 | CmdFrm.suid = fdtv->subunit; | ||
523 | CmdFrm.opcode = READ_DESCRIPTOR; | ||
524 | |||
525 | CmdFrm.operand[0]=DESCRIPTOR_SUBUNIT_IDENTIFIER; | ||
526 | CmdFrm.operand[1]=0xff; | ||
527 | CmdFrm.operand[2]=0x00; | ||
528 | CmdFrm.operand[3]=0x00; // length highbyte | ||
529 | CmdFrm.operand[4]=0x08; // length lowbyte | ||
530 | CmdFrm.operand[5]=0x00; // offset highbyte | ||
531 | CmdFrm.operand[6]=0x0d; // offset lowbyte | ||
532 | |||
533 | CmdFrm.length=12; | ||
534 | |||
535 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
536 | return -EIO; | ||
537 | |||
538 | if ((RspFrm.resp != STABLE && RspFrm.resp != ACCEPTED) || | ||
539 | (RspFrm.operand[3] << 8) + RspFrm.operand[4] != 8) { | ||
540 | dev_err(&fdtv->ud->device, | ||
541 | "cannot read subunit identifier\n"); | ||
542 | return -EINVAL; | ||
543 | } | ||
544 | return 0; | ||
545 | } | ||
546 | |||
547 | int avc_tuner_status(struct firedtv *fdtv, | ||
548 | ANTENNA_INPUT_INFO *antenna_input_info) | ||
549 | { | ||
550 | AVCCmdFrm CmdFrm; | ||
551 | AVCRspFrm RspFrm; | ||
552 | int length; | ||
553 | |||
554 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
555 | |||
556 | CmdFrm.cts=AVC; | ||
557 | CmdFrm.ctype=CONTROL; | ||
558 | CmdFrm.sutyp=0x05; // tuner | ||
559 | CmdFrm.suid=fdtv->subunit; | ||
560 | CmdFrm.opcode=READ_DESCRIPTOR; | ||
561 | |||
562 | CmdFrm.operand[0]=DESCRIPTOR_TUNER_STATUS; | ||
563 | CmdFrm.operand[1]=0xff; //read_result_status | ||
564 | CmdFrm.operand[2]=0x00; // reserver | ||
565 | CmdFrm.operand[3]=0;//sizeof(ANTENNA_INPUT_INFO) >> 8; | ||
566 | CmdFrm.operand[4]=0;//sizeof(ANTENNA_INPUT_INFO) & 0xFF; | ||
567 | CmdFrm.operand[5]=0x00; | ||
568 | CmdFrm.operand[6]=0x00; | ||
569 | CmdFrm.length=12; | ||
570 | |||
571 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
572 | return -EIO; | ||
573 | |||
574 | if (RspFrm.resp != STABLE && RspFrm.resp != ACCEPTED) { | ||
575 | dev_err(&fdtv->ud->device, "cannot read tuner status\n"); | ||
576 | return -EINVAL; | ||
577 | } | ||
578 | |||
579 | length = RspFrm.operand[9]; | ||
580 | if (RspFrm.operand[1] != 0x10 || length != sizeof(ANTENNA_INPUT_INFO)) { | ||
581 | dev_err(&fdtv->ud->device, "got invalid tuner status\n"); | ||
582 | return -EINVAL; | ||
583 | } | ||
584 | |||
585 | memcpy(antenna_input_info, &RspFrm.operand[10], length); | ||
586 | return 0; | ||
587 | } | ||
588 | |||
589 | int avc_lnb_control(struct firedtv *fdtv, char voltage, char burst, | ||
590 | char conttone, char nrdiseq, | ||
591 | struct dvb_diseqc_master_cmd *diseqcmd) | ||
592 | { | ||
593 | AVCCmdFrm CmdFrm; | ||
594 | AVCRspFrm RspFrm; | ||
595 | int i, j, k; | ||
596 | |||
597 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
598 | |||
599 | CmdFrm.cts=AVC; | ||
600 | CmdFrm.ctype=CONTROL; | ||
601 | CmdFrm.sutyp=0x05; | ||
602 | CmdFrm.suid=fdtv->subunit; | ||
603 | CmdFrm.opcode=VENDOR; | ||
604 | |||
605 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
606 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
607 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
608 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_LNB_CONTROL; | ||
609 | |||
610 | CmdFrm.operand[4]=voltage; | ||
611 | CmdFrm.operand[5]=nrdiseq; | ||
612 | |||
613 | i=6; | ||
614 | |||
615 | for (j = 0; j < nrdiseq; j++) { | ||
616 | CmdFrm.operand[i++] = diseqcmd[j].msg_len; | ||
617 | |||
618 | for (k = 0; k < diseqcmd[j].msg_len; k++) | ||
619 | CmdFrm.operand[i++] = diseqcmd[j].msg[k]; | ||
620 | } | ||
621 | |||
622 | CmdFrm.operand[i++]=burst; | ||
623 | CmdFrm.operand[i++]=conttone; | ||
624 | |||
625 | CmdFrm.length = ALIGN(3 + i, 4); | ||
626 | |||
627 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
628 | return -EIO; | ||
629 | |||
630 | if (RspFrm.resp != ACCEPTED) { | ||
631 | dev_err(&fdtv->ud->device, "LNB control failed\n"); | ||
632 | return -EINVAL; | ||
633 | } | ||
634 | |||
635 | return 0; | ||
636 | } | ||
637 | |||
638 | int avc_register_remote_control(struct firedtv *fdtv) | ||
639 | { | ||
640 | AVCCmdFrm CmdFrm; | ||
641 | |||
642 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
643 | |||
644 | CmdFrm.cts = AVC; | ||
645 | CmdFrm.ctype = NOTIFY; | ||
646 | CmdFrm.sutyp = 0x1f; | ||
647 | CmdFrm.suid = 0x7; | ||
648 | CmdFrm.opcode = VENDOR; | ||
649 | |||
650 | CmdFrm.operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
651 | CmdFrm.operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
652 | CmdFrm.operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
653 | CmdFrm.operand[3] = SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL; | ||
654 | |||
655 | CmdFrm.length = 8; | ||
656 | |||
657 | return avc_write(fdtv, &CmdFrm, NULL); | ||
658 | } | ||
659 | |||
660 | void avc_remote_ctrl_work(struct work_struct *work) | ||
661 | { | ||
662 | struct firedtv *fdtv = | ||
663 | container_of(work, struct firedtv, remote_ctrl_work); | ||
664 | |||
665 | /* Should it be rescheduled in failure cases? */ | ||
666 | avc_register_remote_control(fdtv); | ||
667 | } | ||
668 | |||
669 | #if 0 /* FIXME: unused */ | ||
670 | int avc_tuner_host2ca(struct firedtv *fdtv) | ||
671 | { | ||
672 | AVCCmdFrm CmdFrm; | ||
673 | AVCRspFrm RspFrm; | ||
674 | |||
675 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
676 | CmdFrm.cts = AVC; | ||
677 | CmdFrm.ctype = CONTROL; | ||
678 | CmdFrm.sutyp = 0x5; | ||
679 | CmdFrm.suid = fdtv->subunit; | ||
680 | CmdFrm.opcode = VENDOR; | ||
681 | |||
682 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
683 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
684 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
685 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_HOST2CA; | ||
686 | CmdFrm.operand[4] = 0; // slot | ||
687 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; // ca tag | ||
688 | CmdFrm.operand[6] = 0; // more/last | ||
689 | CmdFrm.operand[7] = 0; // length | ||
690 | CmdFrm.length = 12; | ||
691 | |||
692 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
693 | return -EIO; | ||
694 | |||
695 | return 0; | ||
696 | } | ||
697 | #endif | ||
698 | |||
699 | static int get_ca_object_pos(AVCRspFrm *RspFrm) | ||
700 | { | ||
701 | int length = 1; | ||
702 | |||
703 | /* Check length of length field */ | ||
704 | if (RspFrm->operand[7] & 0x80) | ||
705 | length = (RspFrm->operand[7] & 0x7f) + 1; | ||
706 | return length + 7; | ||
707 | } | ||
708 | |||
709 | static int get_ca_object_length(AVCRspFrm *RspFrm) | ||
710 | { | ||
711 | #if 0 /* FIXME: unused */ | ||
712 | int size = 0; | ||
713 | int i; | ||
714 | |||
715 | if (RspFrm->operand[7] & 0x80) | ||
716 | for (i = 0; i < (RspFrm->operand[7] & 0x7f); i++) { | ||
717 | size <<= 8; | ||
718 | size += RspFrm->operand[8 + i]; | ||
719 | } | ||
720 | #endif | ||
721 | return RspFrm->operand[7]; | ||
722 | } | ||
723 | |||
724 | int avc_ca_app_info(struct firedtv *fdtv, char *app_info, unsigned int *len) | ||
725 | { | ||
726 | AVCCmdFrm CmdFrm; | ||
727 | AVCRspFrm RspFrm; | ||
728 | int pos; | ||
729 | |||
730 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
731 | CmdFrm.cts = AVC; | ||
732 | CmdFrm.ctype = STATUS; | ||
733 | CmdFrm.sutyp = 0x5; | ||
734 | CmdFrm.suid = fdtv->subunit; | ||
735 | CmdFrm.opcode = VENDOR; | ||
736 | |||
737 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
738 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
739 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
740 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_CA2HOST; | ||
741 | CmdFrm.operand[4] = 0; // slot | ||
742 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; // ca tag | ||
743 | CmdFrm.length = 12; | ||
744 | |||
745 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
746 | return -EIO; | ||
747 | |||
748 | /* FIXME: check response code and validate response data */ | ||
749 | |||
750 | pos = get_ca_object_pos(&RspFrm); | ||
751 | app_info[0] = (TAG_APP_INFO >> 16) & 0xFF; | ||
752 | app_info[1] = (TAG_APP_INFO >> 8) & 0xFF; | ||
753 | app_info[2] = (TAG_APP_INFO >> 0) & 0xFF; | ||
754 | app_info[3] = 6 + RspFrm.operand[pos + 4]; | ||
755 | app_info[4] = 0x01; | ||
756 | memcpy(&app_info[5], &RspFrm.operand[pos], 5 + RspFrm.operand[pos + 4]); | ||
757 | *len = app_info[3] + 4; | ||
758 | |||
759 | return 0; | ||
760 | } | ||
761 | |||
762 | int avc_ca_info(struct firedtv *fdtv, char *app_info, unsigned int *len) | ||
763 | { | ||
764 | AVCCmdFrm CmdFrm; | ||
765 | AVCRspFrm RspFrm; | ||
766 | int pos; | ||
767 | |||
768 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
769 | CmdFrm.cts = AVC; | ||
770 | CmdFrm.ctype = STATUS; | ||
771 | CmdFrm.sutyp = 0x5; | ||
772 | CmdFrm.suid = fdtv->subunit; | ||
773 | CmdFrm.opcode = VENDOR; | ||
774 | |||
775 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
776 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
777 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
778 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_CA2HOST; | ||
779 | CmdFrm.operand[4] = 0; // slot | ||
780 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; // ca tag | ||
781 | CmdFrm.length = 12; | ||
782 | |||
783 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
784 | return -EIO; | ||
785 | |||
786 | pos = get_ca_object_pos(&RspFrm); | ||
787 | app_info[0] = (TAG_CA_INFO >> 16) & 0xFF; | ||
788 | app_info[1] = (TAG_CA_INFO >> 8) & 0xFF; | ||
789 | app_info[2] = (TAG_CA_INFO >> 0) & 0xFF; | ||
790 | app_info[3] = 2; | ||
791 | app_info[4] = RspFrm.operand[pos + 0]; | ||
792 | app_info[5] = RspFrm.operand[pos + 1]; | ||
793 | *len = app_info[3] + 4; | ||
794 | |||
795 | return 0; | ||
796 | } | ||
797 | |||
798 | int avc_ca_reset(struct firedtv *fdtv) | ||
799 | { | ||
800 | AVCCmdFrm CmdFrm; | ||
801 | AVCRspFrm RspFrm; | ||
802 | |||
803 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
804 | CmdFrm.cts = AVC; | ||
805 | CmdFrm.ctype = CONTROL; | ||
806 | CmdFrm.sutyp = 0x5; | ||
807 | CmdFrm.suid = fdtv->subunit; | ||
808 | CmdFrm.opcode = VENDOR; | ||
809 | |||
810 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
811 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
812 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
813 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_HOST2CA; | ||
814 | CmdFrm.operand[4] = 0; // slot | ||
815 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_RESET; // ca tag | ||
816 | CmdFrm.operand[6] = 0; // more/last | ||
817 | CmdFrm.operand[7] = 1; // length | ||
818 | CmdFrm.operand[8] = 0; // force hardware reset | ||
819 | CmdFrm.length = 12; | ||
820 | |||
821 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
822 | return -EIO; | ||
823 | |||
824 | return 0; | ||
825 | } | ||
826 | |||
827 | int avc_ca_pmt(struct firedtv *fdtv, char *msg, int length) | ||
828 | { | ||
829 | AVCCmdFrm CmdFrm; | ||
830 | AVCRspFrm RspFrm; | ||
831 | int list_management; | ||
832 | int program_info_length; | ||
833 | int pmt_cmd_id; | ||
834 | int read_pos; | ||
835 | int write_pos; | ||
836 | int es_info_length; | ||
837 | int crc32_csum; | ||
838 | |||
839 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
840 | CmdFrm.cts = AVC; | ||
841 | CmdFrm.ctype = CONTROL; | ||
842 | CmdFrm.sutyp = 0x5; | ||
843 | CmdFrm.suid = fdtv->subunit; | ||
844 | CmdFrm.opcode = VENDOR; | ||
845 | |||
846 | if (msg[0] != LIST_MANAGEMENT_ONLY) { | ||
847 | dev_info(&fdtv->ud->device, | ||
848 | "forcing list_management to ONLY\n"); | ||
849 | msg[0] = LIST_MANAGEMENT_ONLY; | ||
850 | } | ||
851 | // We take the cmd_id from the programme level only! | ||
852 | list_management = msg[0]; | ||
853 | program_info_length = ((msg[4] & 0x0F) << 8) + msg[5]; | ||
854 | if (program_info_length > 0) | ||
855 | program_info_length--; // Remove pmt_cmd_id | ||
856 | pmt_cmd_id = msg[6]; | ||
857 | |||
858 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
859 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
860 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
861 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_HOST2CA; | ||
862 | CmdFrm.operand[4] = 0; // slot | ||
863 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_PMT; // ca tag | ||
864 | CmdFrm.operand[6] = 0; // more/last | ||
865 | //CmdFrm.operand[7] = XXXprogram_info_length + 17; // length | ||
866 | CmdFrm.operand[8] = list_management; | ||
867 | CmdFrm.operand[9] = 0x01; // pmt_cmd=OK_descramble | ||
868 | |||
869 | // TS program map table | ||
870 | |||
871 | // Table id=2 | ||
872 | CmdFrm.operand[10] = 0x02; | ||
873 | // Section syntax + length | ||
874 | CmdFrm.operand[11] = 0x80; | ||
875 | //CmdFrm.operand[12] = XXXprogram_info_length + 12; | ||
876 | // Program number | ||
877 | CmdFrm.operand[13] = msg[1]; | ||
878 | CmdFrm.operand[14] = msg[2]; | ||
879 | // Version number=0 + current/next=1 | ||
880 | CmdFrm.operand[15] = 0x01; | ||
881 | // Section number=0 | ||
882 | CmdFrm.operand[16] = 0x00; | ||
883 | // Last section number=0 | ||
884 | CmdFrm.operand[17] = 0x00; | ||
885 | // PCR_PID=1FFF | ||
886 | CmdFrm.operand[18] = 0x1F; | ||
887 | CmdFrm.operand[19] = 0xFF; | ||
888 | // Program info length | ||
889 | CmdFrm.operand[20] = (program_info_length >> 8); | ||
890 | CmdFrm.operand[21] = (program_info_length & 0xFF); | ||
891 | // CA descriptors at programme level | ||
892 | read_pos = 6; | ||
893 | write_pos = 22; | ||
894 | if (program_info_length > 0) { | ||
895 | pmt_cmd_id = msg[read_pos++]; | ||
896 | if (pmt_cmd_id != 1 && pmt_cmd_id != 4) | ||
897 | dev_err(&fdtv->ud->device, | ||
898 | "invalid pmt_cmd_id %d\n", pmt_cmd_id); | ||
899 | |||
900 | memcpy(&CmdFrm.operand[write_pos], &msg[read_pos], | ||
901 | program_info_length); | ||
902 | read_pos += program_info_length; | ||
903 | write_pos += program_info_length; | ||
904 | } | ||
905 | while (read_pos < length) { | ||
906 | CmdFrm.operand[write_pos++] = msg[read_pos++]; | ||
907 | CmdFrm.operand[write_pos++] = msg[read_pos++]; | ||
908 | CmdFrm.operand[write_pos++] = msg[read_pos++]; | ||
909 | es_info_length = | ||
910 | ((msg[read_pos] & 0x0F) << 8) + msg[read_pos + 1]; | ||
911 | read_pos += 2; | ||
912 | if (es_info_length > 0) | ||
913 | es_info_length--; // Remove pmt_cmd_id | ||
914 | CmdFrm.operand[write_pos++] = es_info_length >> 8; | ||
915 | CmdFrm.operand[write_pos++] = es_info_length & 0xFF; | ||
916 | if (es_info_length > 0) { | ||
917 | pmt_cmd_id = msg[read_pos++]; | ||
918 | if (pmt_cmd_id != 1 && pmt_cmd_id != 4) | ||
919 | dev_err(&fdtv->ud->device, | ||
920 | "invalid pmt_cmd_id %d " | ||
921 | "at stream level\n", pmt_cmd_id); | ||
922 | |||
923 | memcpy(&CmdFrm.operand[write_pos], &msg[read_pos], | ||
924 | es_info_length); | ||
925 | read_pos += es_info_length; | ||
926 | write_pos += es_info_length; | ||
927 | } | ||
928 | } | ||
929 | |||
930 | // CRC | ||
931 | CmdFrm.operand[write_pos++] = 0x00; | ||
932 | CmdFrm.operand[write_pos++] = 0x00; | ||
933 | CmdFrm.operand[write_pos++] = 0x00; | ||
934 | CmdFrm.operand[write_pos++] = 0x00; | ||
935 | |||
936 | CmdFrm.operand[7] = write_pos - 8; | ||
937 | CmdFrm.operand[12] = write_pos - 13; | ||
938 | |||
939 | crc32_csum = crc32_be(0, &CmdFrm.operand[10], | ||
940 | CmdFrm.operand[12] - 1); | ||
941 | CmdFrm.operand[write_pos - 4] = (crc32_csum >> 24) & 0xFF; | ||
942 | CmdFrm.operand[write_pos - 3] = (crc32_csum >> 16) & 0xFF; | ||
943 | CmdFrm.operand[write_pos - 2] = (crc32_csum >> 8) & 0xFF; | ||
944 | CmdFrm.operand[write_pos - 1] = (crc32_csum >> 0) & 0xFF; | ||
945 | |||
946 | CmdFrm.length = ALIGN(3 + write_pos, 4); | ||
947 | |||
948 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
949 | return -EIO; | ||
950 | |||
951 | if (RspFrm.resp != ACCEPTED) { | ||
952 | dev_err(&fdtv->ud->device, | ||
953 | "CA PMT failed with response 0x%x\n", RspFrm.resp); | ||
954 | return -EFAULT; | ||
955 | } | ||
956 | |||
957 | return 0; | ||
958 | } | ||
959 | |||
960 | int avc_ca_get_time_date(struct firedtv *fdtv, int *interval) | ||
961 | { | ||
962 | AVCCmdFrm CmdFrm; | ||
963 | AVCRspFrm RspFrm; | ||
964 | |||
965 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
966 | CmdFrm.cts = AVC; | ||
967 | CmdFrm.ctype = STATUS; | ||
968 | CmdFrm.sutyp = 0x5; | ||
969 | CmdFrm.suid = fdtv->subunit; | ||
970 | CmdFrm.opcode = VENDOR; | ||
971 | |||
972 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
973 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
974 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
975 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_CA2HOST; | ||
976 | CmdFrm.operand[4] = 0; // slot | ||
977 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_DATE_TIME; // ca tag | ||
978 | CmdFrm.operand[6] = 0; // more/last | ||
979 | CmdFrm.operand[7] = 0; // length | ||
980 | CmdFrm.length = 12; | ||
981 | |||
982 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
983 | return -EIO; | ||
984 | |||
985 | /* FIXME: check response code and validate response data */ | ||
986 | |||
987 | *interval = RspFrm.operand[get_ca_object_pos(&RspFrm)]; | ||
988 | |||
989 | return 0; | ||
990 | } | ||
991 | |||
992 | int avc_ca_enter_menu(struct firedtv *fdtv) | ||
993 | { | ||
994 | AVCCmdFrm CmdFrm; | ||
995 | AVCRspFrm RspFrm; | ||
996 | |||
997 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
998 | CmdFrm.cts = AVC; | ||
999 | CmdFrm.ctype = STATUS; | ||
1000 | CmdFrm.sutyp = 0x5; | ||
1001 | CmdFrm.suid = fdtv->subunit; | ||
1002 | CmdFrm.opcode = VENDOR; | ||
1003 | |||
1004 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
1005 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
1006 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
1007 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_HOST2CA; | ||
1008 | CmdFrm.operand[4] = 0; // slot | ||
1009 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_ENTER_MENU; | ||
1010 | CmdFrm.operand[6] = 0; // more/last | ||
1011 | CmdFrm.operand[7] = 0; // length | ||
1012 | CmdFrm.length = 12; | ||
1013 | |||
1014 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
1015 | return -EIO; | ||
1016 | |||
1017 | return 0; | ||
1018 | } | ||
1019 | |||
1020 | int avc_ca_get_mmi(struct firedtv *fdtv, char *mmi_object, unsigned int *len) | ||
1021 | { | ||
1022 | AVCCmdFrm CmdFrm; | ||
1023 | AVCRspFrm RspFrm; | ||
1024 | |||
1025 | memset(&CmdFrm, 0, sizeof(AVCCmdFrm)); | ||
1026 | CmdFrm.cts = AVC; | ||
1027 | CmdFrm.ctype = STATUS; | ||
1028 | CmdFrm.sutyp = 0x5; | ||
1029 | CmdFrm.suid = fdtv->subunit; | ||
1030 | CmdFrm.opcode = VENDOR; | ||
1031 | |||
1032 | CmdFrm.operand[0]=SFE_VENDOR_DE_COMPANYID_0; | ||
1033 | CmdFrm.operand[1]=SFE_VENDOR_DE_COMPANYID_1; | ||
1034 | CmdFrm.operand[2]=SFE_VENDOR_DE_COMPANYID_2; | ||
1035 | CmdFrm.operand[3]=SFE_VENDOR_OPCODE_CA2HOST; | ||
1036 | CmdFrm.operand[4] = 0; // slot | ||
1037 | CmdFrm.operand[5] = SFE_VENDOR_TAG_CA_MMI; | ||
1038 | CmdFrm.operand[6] = 0; // more/last | ||
1039 | CmdFrm.operand[7] = 0; // length | ||
1040 | CmdFrm.length = 12; | ||
1041 | |||
1042 | if (avc_write(fdtv, &CmdFrm, &RspFrm) < 0) | ||
1043 | return -EIO; | ||
1044 | |||
1045 | /* FIXME: check response code and validate response data */ | ||
1046 | |||
1047 | *len = get_ca_object_length(&RspFrm); | ||
1048 | memcpy(mmi_object, &RspFrm.operand[get_ca_object_pos(&RspFrm)], *len); | ||
1049 | |||
1050 | return 0; | ||
1051 | } | ||
diff --git a/drivers/media/dvb/firewire/avc.h b/drivers/media/dvb/firewire/avc.h deleted file mode 100644 index 168f371dbde0..000000000000 --- a/drivers/media/dvb/firewire/avc.h +++ /dev/null | |||
@@ -1,432 +0,0 @@ | |||
1 | /* | ||
2 | * AV/C API | ||
3 | * | ||
4 | * Copyright (C) 2000 Manfred Weihs | ||
5 | * Copyright (C) 2003 Philipp Gutgsell <0014guph@edu.fh-kaernten.ac.at> | ||
6 | * Copyright (C) 2004 Andreas Monitzer <andy@monitzer.com> | ||
7 | * Copyright (C) 2008 Ben Backx <ben@bbackx.com> | ||
8 | * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> | ||
9 | * | ||
10 | * This is based on code written by Peter Halwachs, Thomas Groiss and | ||
11 | * Andreas Monitzer. | ||
12 | * | ||
13 | * This program is free software; you can redistribute it and/or | ||
14 | * modify it under the terms of the GNU General Public License as | ||
15 | * published by the Free Software Foundation; either version 2 of | ||
16 | * the License, or (at your option) any later version. | ||
17 | */ | ||
18 | |||
19 | #ifndef _AVC_API_H | ||
20 | #define _AVC_API_H | ||
21 | |||
22 | #include <linux/types.h> | ||
23 | |||
24 | /************************************************************* | ||
25 | Constants from EN510221 | ||
26 | **************************************************************/ | ||
27 | #define LIST_MANAGEMENT_ONLY 0x03 | ||
28 | |||
29 | /************************************************************ | ||
30 | definition of structures | ||
31 | *************************************************************/ | ||
32 | typedef struct { | ||
33 | int Nr_SourcePlugs; | ||
34 | int Nr_DestinationPlugs; | ||
35 | } TunerInfo; | ||
36 | |||
37 | |||
38 | /*********************************************** | ||
39 | |||
40 | supported cts | ||
41 | |||
42 | ************************************************/ | ||
43 | |||
44 | #define AVC 0x0 | ||
45 | |||
46 | // FCP command frame with ctype = 0x0 is AVC command frame | ||
47 | |||
48 | #ifdef __LITTLE_ENDIAN | ||
49 | |||
50 | // Definition FCP Command Frame | ||
51 | typedef struct _AVCCmdFrm | ||
52 | { | ||
53 | // AV/C command frame | ||
54 | __u8 ctype : 4 ; // command type | ||
55 | __u8 cts : 4 ; // always 0x0 for AVC | ||
56 | __u8 suid : 3 ; // subunit ID | ||
57 | __u8 sutyp : 5 ; // subunit_typ | ||
58 | __u8 opcode : 8 ; // opcode | ||
59 | __u8 operand[509] ; // array of operands [1-507] | ||
60 | int length; //length of the command frame | ||
61 | } AVCCmdFrm ; | ||
62 | |||
63 | // Definition FCP Response Frame | ||
64 | typedef struct _AVCRspFrm | ||
65 | { | ||
66 | // AV/C response frame | ||
67 | __u8 resp : 4 ; // response type | ||
68 | __u8 cts : 4 ; // always 0x0 for AVC | ||
69 | __u8 suid : 3 ; // subunit ID | ||
70 | __u8 sutyp : 5 ; // subunit_typ | ||
71 | __u8 opcode : 8 ; // opcode | ||
72 | __u8 operand[509] ; // array of operands [1-507] | ||
73 | int length; //length of the response frame | ||
74 | } AVCRspFrm ; | ||
75 | |||
76 | #else | ||
77 | |||
78 | typedef struct _AVCCmdFrm | ||
79 | { | ||
80 | __u8 cts:4; | ||
81 | __u8 ctype:4; | ||
82 | __u8 sutyp:5; | ||
83 | __u8 suid:3; | ||
84 | __u8 opcode; | ||
85 | __u8 operand[509]; | ||
86 | int length; | ||
87 | } AVCCmdFrm; | ||
88 | |||
89 | typedef struct _AVCRspFrm | ||
90 | { | ||
91 | __u8 cts:4; | ||
92 | __u8 resp:4; | ||
93 | __u8 sutyp:5; | ||
94 | __u8 suid:3; | ||
95 | __u8 opcode; | ||
96 | __u8 operand[509]; | ||
97 | int length; | ||
98 | } AVCRspFrm; | ||
99 | |||
100 | #endif | ||
101 | |||
102 | /************************************************************* | ||
103 | AVC command types (ctype) | ||
104 | **************************************************************/// | ||
105 | #define CONTROL 0x00 | ||
106 | #define STATUS 0x01 | ||
107 | #define INQUIRY 0x02 | ||
108 | #define NOTIFY 0x03 | ||
109 | |||
110 | /************************************************************* | ||
111 | AVC respond types | ||
112 | **************************************************************/// | ||
113 | #define NOT_IMPLEMENTED 0x8 | ||
114 | #define ACCEPTED 0x9 | ||
115 | #define REJECTED 0xA | ||
116 | #define STABLE 0xC | ||
117 | #define CHANGED 0xD | ||
118 | #define INTERIM 0xF | ||
119 | |||
120 | /************************************************************* | ||
121 | AVC opcodes | ||
122 | **************************************************************/// | ||
123 | #define CONNECT 0x24 | ||
124 | #define DISCONNECT 0x25 | ||
125 | #define UNIT_INFO 0x30 | ||
126 | #define SUBUNIT_Info 0x31 | ||
127 | #define VENDOR 0x00 | ||
128 | |||
129 | #define PLUG_INFO 0x02 | ||
130 | #define OPEN_DESCRIPTOR 0x08 | ||
131 | #define READ_DESCRIPTOR 0x09 | ||
132 | #define OBJECT_NUMBER_SELECT 0x0D | ||
133 | |||
134 | /************************************************************* | ||
135 | AVCTuner opcodes | ||
136 | **************************************************************/ | ||
137 | |||
138 | #define DSIT 0xC8 | ||
139 | #define DSD 0xCB | ||
140 | #define DESCRIPTOR_TUNER_STATUS 0x80 | ||
141 | #define DESCRIPTOR_SUBUNIT_IDENTIFIER 0x00 | ||
142 | |||
143 | /************************************************************* | ||
144 | AVCTuner list types | ||
145 | **************************************************************/ | ||
146 | #define Multiplex_List 0x80 | ||
147 | #define Service_List 0x82 | ||
148 | |||
149 | /************************************************************* | ||
150 | AVCTuner object entries | ||
151 | **************************************************************/ | ||
152 | #define Multiplex 0x80 | ||
153 | #define Service 0x82 | ||
154 | #define Service_with_specified_components 0x83 | ||
155 | #define Preferred_components 0x90 | ||
156 | #define Component 0x84 | ||
157 | |||
158 | /************************************************************* | ||
159 | Vendor-specific commands | ||
160 | **************************************************************/ | ||
161 | |||
162 | // digital everywhere vendor ID | ||
163 | #define SFE_VENDOR_DE_COMPANYID_0 0x00 | ||
164 | #define SFE_VENDOR_DE_COMPANYID_1 0x12 | ||
165 | #define SFE_VENDOR_DE_COMPANYID_2 0x87 | ||
166 | |||
167 | #define SFE_VENDOR_MAX_NR_COMPONENTS 0x4 | ||
168 | #define SFE_VENDOR_MAX_NR_SERVICES 0x3 | ||
169 | #define SFE_VENDOR_MAX_NR_DSD_ELEMENTS 0x10 | ||
170 | |||
171 | // vendor commands | ||
172 | #define SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL 0x0A | ||
173 | #define SFE_VENDOR_OPCODE_LNB_CONTROL 0x52 | ||
174 | #define SFE_VENDOR_OPCODE_TUNE_QPSK 0x58 // QPSK command for DVB-S | ||
175 | |||
176 | // TODO: following vendor specific commands needs to be implemented | ||
177 | #define SFE_VENDOR_OPCODE_GET_FIRMWARE_VERSION 0x00 | ||
178 | #define SFE_VENDOR_OPCODE_HOST2CA 0x56 | ||
179 | #define SFE_VENDOR_OPCODE_CA2HOST 0x57 | ||
180 | #define SFE_VENDOR_OPCODE_CISTATUS 0x59 | ||
181 | #define SFE_VENDOR_OPCODE_TUNE_QPSK2 0x60 // QPSK command for DVB-S2 devices | ||
182 | |||
183 | // CA Tags | ||
184 | #define SFE_VENDOR_TAG_CA_RESET 0x00 | ||
185 | #define SFE_VENDOR_TAG_CA_APPLICATION_INFO 0x01 | ||
186 | #define SFE_VENDOR_TAG_CA_PMT 0x02 | ||
187 | #define SFE_VENDOR_TAG_CA_DATE_TIME 0x04 | ||
188 | #define SFE_VENDOR_TAG_CA_MMI 0x05 | ||
189 | #define SFE_VENDOR_TAG_CA_ENTER_MENU 0x07 | ||
190 | |||
191 | |||
192 | //AVCTuner DVB identifier service_ID | ||
193 | #define DVB 0x20 | ||
194 | |||
195 | /************************************************************* | ||
196 | AVC descriptor types | ||
197 | **************************************************************/ | ||
198 | |||
199 | #define Subunit_Identifier_Descriptor 0x00 | ||
200 | #define Tuner_Status_Descriptor 0x80 | ||
201 | |||
202 | typedef struct { | ||
203 | __u8 Subunit_Type; | ||
204 | __u8 Max_Subunit_ID; | ||
205 | } SUBUNIT_INFO; | ||
206 | |||
207 | /************************************************************* | ||
208 | |||
209 | AVCTuner DVB object IDs are 6 byte long | ||
210 | |||
211 | **************************************************************/ | ||
212 | |||
213 | typedef struct { | ||
214 | __u8 Byte0; | ||
215 | __u8 Byte1; | ||
216 | __u8 Byte2; | ||
217 | __u8 Byte3; | ||
218 | __u8 Byte4; | ||
219 | __u8 Byte5; | ||
220 | }OBJECT_ID; | ||
221 | |||
222 | /************************************************************* | ||
223 | MULIPLEX Structs | ||
224 | **************************************************************/ | ||
225 | typedef struct | ||
226 | { | ||
227 | #ifdef __LITTLE_ENDIAN | ||
228 | __u8 RF_frequency_hByte:6; | ||
229 | __u8 raster_Frequency:2;//Bit7,6 raster frequency | ||
230 | #else | ||
231 | __u8 raster_Frequency:2; | ||
232 | __u8 RF_frequency_hByte:6; | ||
233 | #endif | ||
234 | __u8 RF_frequency_mByte; | ||
235 | __u8 RF_frequency_lByte; | ||
236 | |||
237 | }FREQUENCY; | ||
238 | |||
239 | #ifdef __LITTLE_ENDIAN | ||
240 | |||
241 | typedef struct | ||
242 | { | ||
243 | __u8 Modulation :1; | ||
244 | __u8 FEC_inner :1; | ||
245 | __u8 FEC_outer :1; | ||
246 | __u8 Symbol_Rate :1; | ||
247 | __u8 Frequency :1; | ||
248 | __u8 Orbital_Pos :1; | ||
249 | __u8 Polarisation :1; | ||
250 | __u8 reserved_fields :1; | ||
251 | __u8 reserved1 :7; | ||
252 | __u8 Network_ID :1; | ||
253 | |||
254 | }MULTIPLEX_VALID_FLAGS; | ||
255 | |||
256 | typedef struct | ||
257 | { | ||
258 | __u8 GuardInterval:1; | ||
259 | __u8 CodeRateLPStream:1; | ||
260 | __u8 CodeRateHPStream:1; | ||
261 | __u8 HierarchyInfo:1; | ||
262 | __u8 Constellation:1; | ||
263 | __u8 Bandwidth:1; | ||
264 | __u8 CenterFrequency:1; | ||
265 | __u8 reserved1:1; | ||
266 | __u8 reserved2:5; | ||
267 | __u8 OtherFrequencyFlag:1; | ||
268 | __u8 TransmissionMode:1; | ||
269 | __u8 NetworkId:1; | ||
270 | }MULTIPLEX_VALID_FLAGS_DVBT; | ||
271 | |||
272 | #else | ||
273 | |||
274 | typedef struct { | ||
275 | __u8 reserved_fields:1; | ||
276 | __u8 Polarisation:1; | ||
277 | __u8 Orbital_Pos:1; | ||
278 | __u8 Frequency:1; | ||
279 | __u8 Symbol_Rate:1; | ||
280 | __u8 FEC_outer:1; | ||
281 | __u8 FEC_inner:1; | ||
282 | __u8 Modulation:1; | ||
283 | __u8 Network_ID:1; | ||
284 | __u8 reserved1:7; | ||
285 | }MULTIPLEX_VALID_FLAGS; | ||
286 | |||
287 | typedef struct { | ||
288 | __u8 reserved1:1; | ||
289 | __u8 CenterFrequency:1; | ||
290 | __u8 Bandwidth:1; | ||
291 | __u8 Constellation:1; | ||
292 | __u8 HierarchyInfo:1; | ||
293 | __u8 CodeRateHPStream:1; | ||
294 | __u8 CodeRateLPStream:1; | ||
295 | __u8 GuardInterval:1; | ||
296 | __u8 NetworkId:1; | ||
297 | __u8 TransmissionMode:1; | ||
298 | __u8 OtherFrequencyFlag:1; | ||
299 | __u8 reserved2:5; | ||
300 | }MULTIPLEX_VALID_FLAGS_DVBT; | ||
301 | |||
302 | #endif | ||
303 | |||
304 | typedef union { | ||
305 | MULTIPLEX_VALID_FLAGS Bits; | ||
306 | MULTIPLEX_VALID_FLAGS_DVBT Bits_T; | ||
307 | struct { | ||
308 | __u8 ByteHi; | ||
309 | __u8 ByteLo; | ||
310 | } Valid_Word; | ||
311 | } M_VALID_FLAGS; | ||
312 | |||
313 | typedef struct | ||
314 | { | ||
315 | #ifdef __LITTLE_ENDIAN | ||
316 | __u8 ActiveSystem; | ||
317 | __u8 reserved:5; | ||
318 | __u8 NoRF:1; | ||
319 | __u8 Moving:1; | ||
320 | __u8 Searching:1; | ||
321 | |||
322 | __u8 SelectedAntenna:7; | ||
323 | __u8 Input:1; | ||
324 | |||
325 | __u8 BER[4]; | ||
326 | |||
327 | __u8 SignalStrength; | ||
328 | FREQUENCY Frequency; | ||
329 | |||
330 | __u8 ManDepInfoLength; | ||
331 | |||
332 | __u8 PowerSupply:1; | ||
333 | __u8 FrontEndPowerStatus:1; | ||
334 | __u8 reserved3:1; | ||
335 | __u8 AntennaError:1; | ||
336 | __u8 FrontEndError:1; | ||
337 | __u8 reserved2:3; | ||
338 | |||
339 | __u8 CarrierNoiseRatio[2]; | ||
340 | __u8 reserved4[2]; | ||
341 | __u8 PowerSupplyVoltage; | ||
342 | __u8 AntennaVoltage; | ||
343 | __u8 FirewireBusVoltage; | ||
344 | |||
345 | __u8 CaMmi:1; | ||
346 | __u8 reserved5:7; | ||
347 | |||
348 | __u8 reserved6:1; | ||
349 | __u8 CaInitializationStatus:1; | ||
350 | __u8 CaErrorFlag:1; | ||
351 | __u8 CaDvbFlag:1; | ||
352 | __u8 CaModulePresentStatus:1; | ||
353 | __u8 CaApplicationInfo:1; | ||
354 | __u8 CaDateTimeRequest:1; | ||
355 | __u8 CaPmtReply:1; | ||
356 | |||
357 | #else | ||
358 | __u8 ActiveSystem; | ||
359 | __u8 Searching:1; | ||
360 | __u8 Moving:1; | ||
361 | __u8 NoRF:1; | ||
362 | __u8 reserved:5; | ||
363 | |||
364 | __u8 Input:1; | ||
365 | __u8 SelectedAntenna:7; | ||
366 | |||
367 | __u8 BER[4]; | ||
368 | |||
369 | __u8 SignalStrength; | ||
370 | FREQUENCY Frequency; | ||
371 | |||
372 | __u8 ManDepInfoLength; | ||
373 | |||
374 | __u8 reserved2:3; | ||
375 | __u8 FrontEndError:1; | ||
376 | __u8 AntennaError:1; | ||
377 | __u8 reserved3:1; | ||
378 | __u8 FrontEndPowerStatus:1; | ||
379 | __u8 PowerSupply:1; | ||
380 | |||
381 | __u8 CarrierNoiseRatio[2]; | ||
382 | __u8 reserved4[2]; | ||
383 | __u8 PowerSupplyVoltage; | ||
384 | __u8 AntennaVoltage; | ||
385 | __u8 FirewireBusVoltage; | ||
386 | |||
387 | __u8 reserved5:7; | ||
388 | __u8 CaMmi:1; | ||
389 | __u8 CaPmtReply:1; | ||
390 | __u8 CaDateTimeRequest:1; | ||
391 | __u8 CaApplicationInfo:1; | ||
392 | __u8 CaModulePresentStatus:1; | ||
393 | __u8 CaDvbFlag:1; | ||
394 | __u8 CaErrorFlag:1; | ||
395 | __u8 CaInitializationStatus:1; | ||
396 | __u8 reserved6:1; | ||
397 | |||
398 | #endif | ||
399 | } ANTENNA_INPUT_INFO; // 22 Byte | ||
400 | |||
401 | #define LNBCONTROL_DONTCARE 0xff | ||
402 | |||
403 | struct dvb_diseqc_master_cmd; | ||
404 | struct dvb_frontend_parameters; | ||
405 | struct firedtv; | ||
406 | |||
407 | int avc_recv(struct firedtv *fdtv, u8 *data, size_t length); | ||
408 | |||
409 | int AVCTuner_DSIT(struct firedtv *fdtv, int Source_Plug, | ||
410 | struct dvb_frontend_parameters *params, __u8 *status); | ||
411 | |||
412 | int avc_tuner_status(struct firedtv *fdtv, | ||
413 | ANTENNA_INPUT_INFO *antenna_input_info); | ||
414 | int avc_tuner_dsd(struct firedtv *fdtv, | ||
415 | struct dvb_frontend_parameters *params); | ||
416 | int avc_tuner_set_pids(struct firedtv *fdtv, unsigned char pidc, u16 pid[]); | ||
417 | int avc_tuner_get_ts(struct firedtv *fdtv); | ||
418 | int avc_identify_subunit(struct firedtv *fdtv); | ||
419 | int avc_lnb_control(struct firedtv *fdtv, char voltage, char burst, | ||
420 | char conttone, char nrdiseq, | ||
421 | struct dvb_diseqc_master_cmd *diseqcmd); | ||
422 | void avc_remote_ctrl_work(struct work_struct *work); | ||
423 | int avc_register_remote_control(struct firedtv *fdtv); | ||
424 | int avc_ca_app_info(struct firedtv *fdtv, char *app_info, unsigned int *len); | ||
425 | int avc_ca_info(struct firedtv *fdtv, char *app_info, unsigned int *len); | ||
426 | int avc_ca_reset(struct firedtv *fdtv); | ||
427 | int avc_ca_pmt(struct firedtv *fdtv, char *app_info, int length); | ||
428 | int avc_ca_get_time_date(struct firedtv *fdtv, int *interval); | ||
429 | int avc_ca_enter_menu(struct firedtv *fdtv); | ||
430 | int avc_ca_get_mmi(struct firedtv *fdtv, char *mmi_object, unsigned int *len); | ||
431 | |||
432 | #endif /* _AVC_API_H */ | ||
diff --git a/drivers/media/dvb/firewire/cmp.c b/drivers/media/dvb/firewire/cmp.c deleted file mode 100644 index 821e033d8195..000000000000 --- a/drivers/media/dvb/firewire/cmp.c +++ /dev/null | |||
@@ -1,171 +0,0 @@ | |||
1 | /* | ||
2 | * FireDTV driver (formerly known as FireSAT) | ||
3 | * | ||
4 | * Copyright (C) 2004 Andreas Monitzer <andy@monitzer.com> | ||
5 | * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or | ||
8 | * modify it under the terms of the GNU General Public License as | ||
9 | * published by the Free Software Foundation; either version 2 of | ||
10 | * the License, or (at your option) any later version. | ||
11 | */ | ||
12 | |||
13 | #include <linux/device.h> | ||
14 | #include <linux/kernel.h> | ||
15 | #include <linux/mutex.h> | ||
16 | #include <linux/types.h> | ||
17 | |||
18 | #include <asm/byteorder.h> | ||
19 | |||
20 | #include <ieee1394.h> | ||
21 | #include <nodemgr.h> | ||
22 | |||
23 | #include "avc.h" | ||
24 | #include "cmp.h" | ||
25 | #include "firedtv.h" | ||
26 | |||
27 | #define CMP_OUTPUT_PLUG_CONTROL_REG_0 0xfffff0000904ULL | ||
28 | |||
29 | static int cmp_read(struct firedtv *fdtv, void *buf, u64 addr, size_t len) | ||
30 | { | ||
31 | int ret; | ||
32 | |||
33 | if (mutex_lock_interruptible(&fdtv->avc_mutex)) | ||
34 | return -EINTR; | ||
35 | |||
36 | ret = hpsb_node_read(fdtv->ud->ne, addr, buf, len); | ||
37 | if (ret < 0) | ||
38 | dev_err(&fdtv->ud->device, "CMP: read I/O error\n"); | ||
39 | |||
40 | mutex_unlock(&fdtv->avc_mutex); | ||
41 | return ret; | ||
42 | } | ||
43 | |||
44 | static int cmp_lock(struct firedtv *fdtv, void *data, u64 addr, __be32 arg, | ||
45 | int ext_tcode) | ||
46 | { | ||
47 | int ret; | ||
48 | |||
49 | if (mutex_lock_interruptible(&fdtv->avc_mutex)) | ||
50 | return -EINTR; | ||
51 | |||
52 | ret = hpsb_node_lock(fdtv->ud->ne, addr, ext_tcode, data, | ||
53 | (__force quadlet_t)arg); | ||
54 | if (ret < 0) | ||
55 | dev_err(&fdtv->ud->device, "CMP: lock I/O error\n"); | ||
56 | |||
57 | mutex_unlock(&fdtv->avc_mutex); | ||
58 | return ret; | ||
59 | } | ||
60 | |||
61 | static inline u32 get_opcr(__be32 opcr, u32 mask, u32 shift) | ||
62 | { | ||
63 | return (be32_to_cpu(opcr) >> shift) & mask; | ||
64 | } | ||
65 | |||
66 | static inline void set_opcr(__be32 *opcr, u32 value, u32 mask, u32 shift) | ||
67 | { | ||
68 | *opcr &= ~cpu_to_be32(mask << shift); | ||
69 | *opcr |= cpu_to_be32((value & mask) << shift); | ||
70 | } | ||
71 | |||
72 | #define get_opcr_online(v) get_opcr((v), 0x1, 31) | ||
73 | #define get_opcr_p2p_connections(v) get_opcr((v), 0x3f, 24) | ||
74 | #define get_opcr_channel(v) get_opcr((v), 0x3f, 16) | ||
75 | |||
76 | #define set_opcr_p2p_connections(p, v) set_opcr((p), (v), 0x3f, 24) | ||
77 | #define set_opcr_channel(p, v) set_opcr((p), (v), 0x3f, 16) | ||
78 | #define set_opcr_data_rate(p, v) set_opcr((p), (v), 0x3, 14) | ||
79 | #define set_opcr_overhead_id(p, v) set_opcr((p), (v), 0xf, 10) | ||
80 | |||
81 | int cmp_establish_pp_connection(struct firedtv *fdtv, int plug, int channel) | ||
82 | { | ||
83 | __be32 old_opcr, opcr; | ||
84 | u64 opcr_address = CMP_OUTPUT_PLUG_CONTROL_REG_0 + (plug << 2); | ||
85 | int attempts = 0; | ||
86 | int ret; | ||
87 | |||
88 | ret = cmp_read(fdtv, &opcr, opcr_address, 4); | ||
89 | if (ret < 0) | ||
90 | return ret; | ||
91 | |||
92 | repeat: | ||
93 | if (!get_opcr_online(opcr)) { | ||
94 | dev_err(&fdtv->ud->device, "CMP: output offline\n"); | ||
95 | return -EBUSY; | ||
96 | } | ||
97 | |||
98 | old_opcr = opcr; | ||
99 | |||
100 | if (get_opcr_p2p_connections(opcr)) { | ||
101 | if (get_opcr_channel(opcr) != channel) { | ||
102 | dev_err(&fdtv->ud->device, | ||
103 | "CMP: cannot change channel\n"); | ||
104 | return -EBUSY; | ||
105 | } | ||
106 | dev_info(&fdtv->ud->device, | ||
107 | "CMP: overlaying existing connection\n"); | ||
108 | |||
109 | /* We don't allocate isochronous resources. */ | ||
110 | } else { | ||
111 | set_opcr_channel(&opcr, channel); | ||
112 | set_opcr_data_rate(&opcr, IEEE1394_SPEED_400); | ||
113 | |||
114 | /* FIXME: this is for the worst case - optimize */ | ||
115 | set_opcr_overhead_id(&opcr, 0); | ||
116 | |||
117 | /* FIXME: allocate isochronous channel and bandwidth at IRM */ | ||
118 | } | ||
119 | |||
120 | set_opcr_p2p_connections(&opcr, get_opcr_p2p_connections(opcr) + 1); | ||
121 | |||
122 | ret = cmp_lock(fdtv, &opcr, opcr_address, old_opcr, 2); | ||
123 | if (ret < 0) | ||
124 | return ret; | ||
125 | |||
126 | if (old_opcr != opcr) { | ||
127 | /* | ||
128 | * FIXME: if old_opcr.P2P_Connections > 0, | ||
129 | * deallocate isochronous channel and bandwidth at IRM | ||
130 | */ | ||
131 | |||
132 | if (++attempts < 6) /* arbitrary limit */ | ||
133 | goto repeat; | ||
134 | return -EBUSY; | ||
135 | } | ||
136 | |||
137 | return 0; | ||
138 | } | ||
139 | |||
140 | void cmp_break_pp_connection(struct firedtv *fdtv, int plug, int channel) | ||
141 | { | ||
142 | __be32 old_opcr, opcr; | ||
143 | u64 opcr_address = CMP_OUTPUT_PLUG_CONTROL_REG_0 + (plug << 2); | ||
144 | int attempts = 0; | ||
145 | |||
146 | if (cmp_read(fdtv, &opcr, opcr_address, 4) < 0) | ||
147 | return; | ||
148 | |||
149 | repeat: | ||
150 | if (!get_opcr_online(opcr) || !get_opcr_p2p_connections(opcr) || | ||
151 | get_opcr_channel(opcr) != channel) { | ||
152 | dev_err(&fdtv->ud->device, "CMP: no connection to break\n"); | ||
153 | return; | ||
154 | } | ||
155 | |||
156 | old_opcr = opcr; | ||
157 | set_opcr_p2p_connections(&opcr, get_opcr_p2p_connections(opcr) - 1); | ||
158 | |||
159 | if (cmp_lock(fdtv, &opcr, opcr_address, old_opcr, 2) < 0) | ||
160 | return; | ||
161 | |||
162 | if (old_opcr != opcr) { | ||
163 | /* | ||
164 | * FIXME: if old_opcr.P2P_Connections == 1, i.e. we were last | ||
165 | * owner, deallocate isochronous channel and bandwidth at IRM | ||
166 | */ | ||
167 | |||
168 | if (++attempts < 6) /* arbitrary limit */ | ||
169 | goto repeat; | ||
170 | } | ||
171 | } | ||
diff --git a/drivers/media/dvb/firewire/cmp.h b/drivers/media/dvb/firewire/cmp.h deleted file mode 100644 index 17e182cf29a9..000000000000 --- a/drivers/media/dvb/firewire/cmp.h +++ /dev/null | |||
@@ -1,9 +0,0 @@ | |||
1 | #ifndef _CMP_H | ||
2 | #define _CMP_H | ||
3 | |||
4 | struct firedtv; | ||
5 | |||
6 | int cmp_establish_pp_connection(struct firedtv *fdtv, int plug, int channel); | ||
7 | void cmp_break_pp_connection(struct firedtv *fdtv, int plug, int channel); | ||
8 | |||
9 | #endif /* _CMP_H */ | ||
diff --git a/drivers/media/dvb/firewire/firedtv-1394.c b/drivers/media/dvb/firewire/firedtv-1394.c index 953618246e8e..4e207658c5d9 100644 --- a/drivers/media/dvb/firewire/firedtv-1394.c +++ b/drivers/media/dvb/firewire/firedtv-1394.c | |||
@@ -15,162 +15,181 @@ | |||
15 | #include <linux/errno.h> | 15 | #include <linux/errno.h> |
16 | #include <linux/kernel.h> | 16 | #include <linux/kernel.h> |
17 | #include <linux/list.h> | 17 | #include <linux/list.h> |
18 | #include <linux/module.h> | ||
19 | #include <linux/mutex.h> | ||
20 | #include <linux/slab.h> | ||
21 | #include <linux/spinlock.h> | 18 | #include <linux/spinlock.h> |
22 | #include <linux/string.h> | ||
23 | #include <linux/types.h> | 19 | #include <linux/types.h> |
24 | 20 | ||
25 | #include <dmxdev.h> | 21 | #include <dma.h> |
26 | #include <dvb_demux.h> | ||
27 | #include <dvb_frontend.h> | ||
28 | #include <dvbdev.h> | ||
29 | |||
30 | #include <csr1212.h> | 22 | #include <csr1212.h> |
31 | #include <highlevel.h> | 23 | #include <highlevel.h> |
32 | #include <hosts.h> | 24 | #include <hosts.h> |
33 | #include <ieee1394_hotplug.h> | 25 | #include <ieee1394.h> |
26 | #include <iso.h> | ||
34 | #include <nodemgr.h> | 27 | #include <nodemgr.h> |
35 | 28 | ||
36 | #include "avc.h" | ||
37 | #include "cmp.h" | ||
38 | #include "firedtv.h" | 29 | #include "firedtv.h" |
39 | #include "firedtv-ci.h" | ||
40 | #include "firedtv-rc.h" | ||
41 | |||
42 | #define MATCH_FLAGS IEEE1394_MATCH_VENDOR_ID | IEEE1394_MATCH_MODEL_ID | \ | ||
43 | IEEE1394_MATCH_SPECIFIER_ID | IEEE1394_MATCH_VERSION | ||
44 | #define DIGITAL_EVERYWHERE_OUI 0x001287 | ||
45 | |||
46 | static struct ieee1394_device_id fdtv_id_table[] = { | ||
47 | |||
48 | { | ||
49 | /* FloppyDTV S/CI and FloppyDTV S2 */ | ||
50 | .match_flags = MATCH_FLAGS, | ||
51 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
52 | .model_id = 0x000024, | ||
53 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
54 | .version = AVC_SW_VERSION_ENTRY, | ||
55 | },{ | ||
56 | /* FloppyDTV T/CI */ | ||
57 | .match_flags = MATCH_FLAGS, | ||
58 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
59 | .model_id = 0x000025, | ||
60 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
61 | .version = AVC_SW_VERSION_ENTRY, | ||
62 | },{ | ||
63 | /* FloppyDTV C/CI */ | ||
64 | .match_flags = MATCH_FLAGS, | ||
65 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
66 | .model_id = 0x000026, | ||
67 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
68 | .version = AVC_SW_VERSION_ENTRY, | ||
69 | },{ | ||
70 | /* FireDTV S/CI and FloppyDTV S2 */ | ||
71 | .match_flags = MATCH_FLAGS, | ||
72 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
73 | .model_id = 0x000034, | ||
74 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
75 | .version = AVC_SW_VERSION_ENTRY, | ||
76 | },{ | ||
77 | /* FireDTV T/CI */ | ||
78 | .match_flags = MATCH_FLAGS, | ||
79 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
80 | .model_id = 0x000035, | ||
81 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
82 | .version = AVC_SW_VERSION_ENTRY, | ||
83 | },{ | ||
84 | /* FireDTV C/CI */ | ||
85 | .match_flags = MATCH_FLAGS, | ||
86 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
87 | .model_id = 0x000036, | ||
88 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
89 | .version = AVC_SW_VERSION_ENTRY, | ||
90 | }, { } | ||
91 | }; | ||
92 | 30 | ||
93 | MODULE_DEVICE_TABLE(ieee1394, fdtv_id_table); | 31 | static LIST_HEAD(node_list); |
32 | static DEFINE_SPINLOCK(node_list_lock); | ||
94 | 33 | ||
95 | /* list of all firedtv devices */ | 34 | #define FIREWIRE_HEADER_SIZE 4 |
96 | LIST_HEAD(fdtv_list); | 35 | #define CIP_HEADER_SIZE 8 |
97 | DEFINE_SPINLOCK(fdtv_list_lock); | ||
98 | 36 | ||
99 | static void fcp_request(struct hpsb_host *host, | 37 | static void rawiso_activity_cb(struct hpsb_iso *iso) |
100 | int nodeid, | ||
101 | int direction, | ||
102 | int cts, | ||
103 | u8 *data, | ||
104 | size_t length) | ||
105 | { | 38 | { |
106 | struct firedtv *fdtv = NULL; | 39 | struct firedtv *f, *fdtv = NULL; |
107 | struct firedtv *fdtv_entry; | 40 | unsigned int i, num, packet; |
41 | unsigned char *buf; | ||
108 | unsigned long flags; | 42 | unsigned long flags; |
43 | int count; | ||
44 | |||
45 | spin_lock_irqsave(&node_list_lock, flags); | ||
46 | list_for_each_entry(f, &node_list, list) | ||
47 | if (f->backend_data == iso) { | ||
48 | fdtv = f; | ||
49 | break; | ||
50 | } | ||
51 | spin_unlock_irqrestore(&node_list_lock, flags); | ||
52 | |||
53 | packet = iso->first_packet; | ||
54 | num = hpsb_iso_n_ready(iso); | ||
55 | |||
56 | if (!fdtv) { | ||
57 | dev_err(fdtv->device, "received at unknown iso channel\n"); | ||
58 | goto out; | ||
59 | } | ||
109 | 60 | ||
110 | if (length > 0 && ((data[0] & 0xf0) >> 4) == 0) { | 61 | for (i = 0; i < num; i++, packet = (packet + 1) % iso->buf_packets) { |
111 | 62 | buf = dma_region_i(&iso->data_buf, unsigned char, | |
112 | spin_lock_irqsave(&fdtv_list_lock, flags); | 63 | iso->infos[packet].offset + CIP_HEADER_SIZE); |
113 | list_for_each_entry(fdtv_entry,&fdtv_list,list) { | 64 | count = (iso->infos[packet].len - CIP_HEADER_SIZE) / |
114 | if (fdtv_entry->ud->ne->host == host && | 65 | (188 + FIREWIRE_HEADER_SIZE); |
115 | fdtv_entry->ud->ne->nodeid == nodeid && | 66 | |
116 | (fdtv_entry->subunit == (data[1]&0x7) || | 67 | /* ignore empty packet */ |
117 | (fdtv_entry->subunit == 0 && | 68 | if (iso->infos[packet].len <= CIP_HEADER_SIZE) |
118 | (data[1]&0x7) == 0x7))) { | 69 | continue; |
119 | fdtv=fdtv_entry; | 70 | |
120 | break; | 71 | while (count--) { |
121 | } | 72 | if (buf[FIREWIRE_HEADER_SIZE] == 0x47) |
73 | dvb_dmx_swfilter_packets(&fdtv->demux, | ||
74 | &buf[FIREWIRE_HEADER_SIZE], 1); | ||
75 | else | ||
76 | dev_err(fdtv->device, | ||
77 | "skipping invalid packet\n"); | ||
78 | buf += 188 + FIREWIRE_HEADER_SIZE; | ||
122 | } | 79 | } |
123 | spin_unlock_irqrestore(&fdtv_list_lock, flags); | 80 | } |
81 | out: | ||
82 | hpsb_iso_recv_release_packets(iso, num); | ||
83 | } | ||
84 | |||
85 | static inline struct node_entry *node_of(struct firedtv *fdtv) | ||
86 | { | ||
87 | return container_of(fdtv->device, struct unit_directory, device)->ne; | ||
88 | } | ||
89 | |||
90 | static int node_lock(struct firedtv *fdtv, u64 addr, void *data, __be32 arg) | ||
91 | { | ||
92 | return hpsb_node_lock(node_of(fdtv), addr, EXTCODE_COMPARE_SWAP, data, | ||
93 | (__force quadlet_t)arg); | ||
94 | } | ||
95 | |||
96 | static int node_read(struct firedtv *fdtv, u64 addr, void *data, size_t len) | ||
97 | { | ||
98 | return hpsb_node_read(node_of(fdtv), addr, data, len); | ||
99 | } | ||
100 | |||
101 | static int node_write(struct firedtv *fdtv, u64 addr, void *data, size_t len) | ||
102 | { | ||
103 | return hpsb_node_write(node_of(fdtv), addr, data, len); | ||
104 | } | ||
105 | |||
106 | #define FDTV_ISO_BUFFER_PACKETS 256 | ||
107 | #define FDTV_ISO_BUFFER_SIZE (FDTV_ISO_BUFFER_PACKETS * 200) | ||
108 | |||
109 | static int start_iso(struct firedtv *fdtv) | ||
110 | { | ||
111 | struct hpsb_iso *iso_handle; | ||
112 | int ret; | ||
113 | |||
114 | iso_handle = hpsb_iso_recv_init(node_of(fdtv)->host, | ||
115 | FDTV_ISO_BUFFER_SIZE, FDTV_ISO_BUFFER_PACKETS, | ||
116 | fdtv->isochannel, HPSB_ISO_DMA_DEFAULT, | ||
117 | -1, /* stat.config.irq_interval */ | ||
118 | rawiso_activity_cb); | ||
119 | if (iso_handle == NULL) { | ||
120 | dev_err(fdtv->device, "cannot initialize iso receive\n"); | ||
121 | return -ENOMEM; | ||
122 | } | ||
123 | fdtv->backend_data = iso_handle; | ||
124 | |||
125 | ret = hpsb_iso_recv_start(iso_handle, -1, -1, 0); | ||
126 | if (ret != 0) { | ||
127 | dev_err(fdtv->device, "cannot start iso receive\n"); | ||
128 | hpsb_iso_shutdown(iso_handle); | ||
129 | fdtv->backend_data = NULL; | ||
130 | } | ||
131 | return ret; | ||
132 | } | ||
133 | |||
134 | static void stop_iso(struct firedtv *fdtv) | ||
135 | { | ||
136 | struct hpsb_iso *iso_handle = fdtv->backend_data; | ||
124 | 137 | ||
125 | if (fdtv) | 138 | if (iso_handle != NULL) { |
126 | avc_recv(fdtv, data, length); | 139 | hpsb_iso_stop(iso_handle); |
140 | hpsb_iso_shutdown(iso_handle); | ||
127 | } | 141 | } |
142 | fdtv->backend_data = NULL; | ||
128 | } | 143 | } |
129 | 144 | ||
130 | const char *fdtv_model_names[] = { | 145 | static const struct firedtv_backend fdtv_1394_backend = { |
131 | [FIREDTV_UNKNOWN] = "unknown type", | 146 | .lock = node_lock, |
132 | [FIREDTV_DVB_S] = "FireDTV S/CI", | 147 | .read = node_read, |
133 | [FIREDTV_DVB_C] = "FireDTV C/CI", | 148 | .write = node_write, |
134 | [FIREDTV_DVB_T] = "FireDTV T/CI", | 149 | .start_iso = start_iso, |
135 | [FIREDTV_DVB_S2] = "FireDTV S2 ", | 150 | .stop_iso = stop_iso, |
136 | }; | 151 | }; |
137 | 152 | ||
138 | static int fdtv_probe(struct device *dev) | 153 | static void fcp_request(struct hpsb_host *host, int nodeid, int direction, |
154 | int cts, u8 *data, size_t length) | ||
139 | { | 155 | { |
140 | struct unit_directory *ud = | 156 | struct firedtv *f, *fdtv = NULL; |
141 | container_of(dev, struct unit_directory, device); | ||
142 | struct firedtv *fdtv; | ||
143 | unsigned long flags; | 157 | unsigned long flags; |
144 | int kv_len; | 158 | int su; |
145 | void *kv_str; | ||
146 | int i; | ||
147 | int err = -ENOMEM; | ||
148 | 159 | ||
149 | fdtv = kzalloc(sizeof(*fdtv), GFP_KERNEL); | 160 | if (length == 0 || (data[0] & 0xf0) != 0) |
150 | if (!fdtv) | 161 | return; |
151 | return -ENOMEM; | ||
152 | 162 | ||
153 | dev->driver_data = fdtv; | 163 | su = data[1] & 0x7; |
154 | fdtv->ud = ud; | 164 | |
155 | fdtv->subunit = 0; | 165 | spin_lock_irqsave(&node_list_lock, flags); |
156 | fdtv->isochannel = -1; | 166 | list_for_each_entry(f, &node_list, list) |
157 | fdtv->tone = 0xff; | 167 | if (node_of(f)->host == host && |
158 | fdtv->voltage = 0xff; | 168 | node_of(f)->nodeid == nodeid && |
169 | (f->subunit == su || (f->subunit == 0 && su == 0x7))) { | ||
170 | fdtv = f; | ||
171 | break; | ||
172 | } | ||
173 | spin_unlock_irqrestore(&node_list_lock, flags); | ||
159 | 174 | ||
160 | mutex_init(&fdtv->avc_mutex); | 175 | if (fdtv) |
161 | init_waitqueue_head(&fdtv->avc_wait); | 176 | avc_recv(fdtv, data, length); |
162 | fdtv->avc_reply_received = true; | 177 | } |
163 | mutex_init(&fdtv->demux_mutex); | 178 | |
164 | INIT_WORK(&fdtv->remote_ctrl_work, avc_remote_ctrl_work); | 179 | static int node_probe(struct device *dev) |
180 | { | ||
181 | struct unit_directory *ud = | ||
182 | container_of(dev, struct unit_directory, device); | ||
183 | struct firedtv *fdtv; | ||
184 | int kv_len, err; | ||
185 | void *kv_str; | ||
165 | 186 | ||
166 | /* Reading device model from ROM */ | ||
167 | kv_len = (ud->model_name_kv->value.leaf.len - 2) * sizeof(quadlet_t); | 187 | kv_len = (ud->model_name_kv->value.leaf.len - 2) * sizeof(quadlet_t); |
168 | kv_str = CSR1212_TEXTUAL_DESCRIPTOR_LEAF_DATA(ud->model_name_kv); | 188 | kv_str = CSR1212_TEXTUAL_DESCRIPTOR_LEAF_DATA(ud->model_name_kv); |
169 | for (i = ARRAY_SIZE(fdtv_model_names); --i;) | 189 | |
170 | if (strlen(fdtv_model_names[i]) <= kv_len && | 190 | fdtv = fdtv_alloc(dev, &fdtv_1394_backend, kv_str, kv_len); |
171 | strncmp(kv_str, fdtv_model_names[i], kv_len) == 0) | 191 | if (!fdtv) |
172 | break; | 192 | return -ENOMEM; |
173 | fdtv->type = i; | ||
174 | 193 | ||
175 | /* | 194 | /* |
176 | * Work around a bug in udev's path_id script: Use the fw-host's dev | 195 | * Work around a bug in udev's path_id script: Use the fw-host's dev |
@@ -180,50 +199,39 @@ static int fdtv_probe(struct device *dev) | |||
180 | if (err) | 199 | if (err) |
181 | goto fail_free; | 200 | goto fail_free; |
182 | 201 | ||
183 | INIT_LIST_HEAD(&fdtv->list); | 202 | spin_lock_irq(&node_list_lock); |
184 | spin_lock_irqsave(&fdtv_list_lock, flags); | 203 | list_add_tail(&fdtv->list, &node_list); |
185 | list_add_tail(&fdtv->list, &fdtv_list); | 204 | spin_unlock_irq(&node_list_lock); |
186 | spin_unlock_irqrestore(&fdtv_list_lock, flags); | ||
187 | 205 | ||
188 | err = avc_identify_subunit(fdtv); | 206 | err = avc_identify_subunit(fdtv); |
189 | if (err) | 207 | if (err) |
190 | goto fail; | 208 | goto fail; |
191 | 209 | ||
192 | err = fdtv_dvbdev_init(fdtv, dev); | 210 | err = fdtv_dvb_register(fdtv); |
193 | if (err) | 211 | if (err) |
194 | goto fail; | 212 | goto fail; |
195 | 213 | ||
196 | avc_register_remote_control(fdtv); | 214 | avc_register_remote_control(fdtv); |
197 | return 0; | 215 | return 0; |
198 | |||
199 | fail: | 216 | fail: |
200 | spin_lock_irqsave(&fdtv_list_lock, flags); | 217 | spin_lock_irq(&node_list_lock); |
201 | list_del(&fdtv->list); | 218 | list_del(&fdtv->list); |
202 | spin_unlock_irqrestore(&fdtv_list_lock, flags); | 219 | spin_unlock_irq(&node_list_lock); |
203 | fdtv_unregister_rc(fdtv); | 220 | fdtv_unregister_rc(fdtv); |
204 | fail_free: | 221 | fail_free: |
205 | kfree(fdtv); | 222 | kfree(fdtv); |
206 | return err; | 223 | return err; |
207 | } | 224 | } |
208 | 225 | ||
209 | static int fdtv_remove(struct device *dev) | 226 | static int node_remove(struct device *dev) |
210 | { | 227 | { |
211 | struct firedtv *fdtv = dev->driver_data; | 228 | struct firedtv *fdtv = dev->driver_data; |
212 | unsigned long flags; | ||
213 | 229 | ||
214 | fdtv_ca_release(fdtv); | 230 | fdtv_dvb_unregister(fdtv); |
215 | dvb_unregister_frontend(&fdtv->fe); | 231 | |
216 | dvb_net_release(&fdtv->dvbnet); | 232 | spin_lock_irq(&node_list_lock); |
217 | fdtv->demux.dmx.close(&fdtv->demux.dmx); | ||
218 | fdtv->demux.dmx.remove_frontend(&fdtv->demux.dmx, | ||
219 | &fdtv->frontend); | ||
220 | dvb_dmxdev_release(&fdtv->dmxdev); | ||
221 | dvb_dmx_release(&fdtv->demux); | ||
222 | dvb_unregister_adapter(&fdtv->adapter); | ||
223 | |||
224 | spin_lock_irqsave(&fdtv_list_lock, flags); | ||
225 | list_del(&fdtv->list); | 233 | list_del(&fdtv->list); |
226 | spin_unlock_irqrestore(&fdtv_list_lock, flags); | 234 | spin_unlock_irq(&node_list_lock); |
227 | 235 | ||
228 | cancel_work_sync(&fdtv->remote_ctrl_work); | 236 | cancel_work_sync(&fdtv->remote_ctrl_work); |
229 | fdtv_unregister_rc(fdtv); | 237 | fdtv_unregister_rc(fdtv); |
@@ -232,7 +240,7 @@ static int fdtv_remove(struct device *dev) | |||
232 | return 0; | 240 | return 0; |
233 | } | 241 | } |
234 | 242 | ||
235 | static int fdtv_update(struct unit_directory *ud) | 243 | static int node_update(struct unit_directory *ud) |
236 | { | 244 | { |
237 | struct firedtv *fdtv = ud->device.driver_data; | 245 | struct firedtv *fdtv = ud->device.driver_data; |
238 | 246 | ||
@@ -243,17 +251,11 @@ static int fdtv_update(struct unit_directory *ud) | |||
243 | } | 251 | } |
244 | 252 | ||
245 | static struct hpsb_protocol_driver fdtv_driver = { | 253 | static struct hpsb_protocol_driver fdtv_driver = { |
246 | |||
247 | .name = "firedtv", | 254 | .name = "firedtv", |
248 | .id_table = fdtv_id_table, | 255 | .update = node_update, |
249 | .update = fdtv_update, | ||
250 | |||
251 | .driver = { | 256 | .driver = { |
252 | //.name and .bus are filled in for us in more recent linux versions | 257 | .probe = node_probe, |
253 | //.name = "FireDTV", | 258 | .remove = node_remove, |
254 | //.bus = &ieee1394_bus_type, | ||
255 | .probe = fdtv_probe, | ||
256 | .remove = fdtv_remove, | ||
257 | }, | 259 | }, |
258 | }; | 260 | }; |
259 | 261 | ||
@@ -262,11 +264,12 @@ static struct hpsb_highlevel fdtv_highlevel = { | |||
262 | .fcp_request = fcp_request, | 264 | .fcp_request = fcp_request, |
263 | }; | 265 | }; |
264 | 266 | ||
265 | static int __init fdtv_init(void) | 267 | int __init fdtv_1394_init(struct ieee1394_device_id id_table[]) |
266 | { | 268 | { |
267 | int ret; | 269 | int ret; |
268 | 270 | ||
269 | hpsb_register_highlevel(&fdtv_highlevel); | 271 | hpsb_register_highlevel(&fdtv_highlevel); |
272 | fdtv_driver.id_table = id_table; | ||
270 | ret = hpsb_register_protocol(&fdtv_driver); | 273 | ret = hpsb_register_protocol(&fdtv_driver); |
271 | if (ret) { | 274 | if (ret) { |
272 | printk(KERN_ERR "firedtv: failed to register protocol\n"); | 275 | printk(KERN_ERR "firedtv: failed to register protocol\n"); |
@@ -275,17 +278,8 @@ static int __init fdtv_init(void) | |||
275 | return ret; | 278 | return ret; |
276 | } | 279 | } |
277 | 280 | ||
278 | static void __exit fdtv_exit(void) | 281 | void __exit fdtv_1394_exit(void) |
279 | { | 282 | { |
280 | hpsb_unregister_protocol(&fdtv_driver); | 283 | hpsb_unregister_protocol(&fdtv_driver); |
281 | hpsb_unregister_highlevel(&fdtv_highlevel); | 284 | hpsb_unregister_highlevel(&fdtv_highlevel); |
282 | } | 285 | } |
283 | |||
284 | module_init(fdtv_init); | ||
285 | module_exit(fdtv_exit); | ||
286 | |||
287 | MODULE_AUTHOR("Andreas Monitzer <andy@monitzer.com>"); | ||
288 | MODULE_AUTHOR("Ben Backx <ben@bbackx.com>"); | ||
289 | MODULE_DESCRIPTION("FireDTV DVB Driver"); | ||
290 | MODULE_LICENSE("GPL"); | ||
291 | MODULE_SUPPORTED_DEVICE("FireDTV DVB"); | ||
diff --git a/drivers/media/dvb/firewire/firedtv-avc.c b/drivers/media/dvb/firewire/firedtv-avc.c new file mode 100644 index 000000000000..b55d9ccaf33e --- /dev/null +++ b/drivers/media/dvb/firewire/firedtv-avc.c | |||
@@ -0,0 +1,1315 @@ | |||
1 | /* | ||
2 | * FireDTV driver (formerly known as FireSAT) | ||
3 | * | ||
4 | * Copyright (C) 2004 Andreas Monitzer <andy@monitzer.com> | ||
5 | * Copyright (C) 2008 Ben Backx <ben@bbackx.com> | ||
6 | * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or | ||
9 | * modify it under the terms of the GNU General Public License as | ||
10 | * published by the Free Software Foundation; either version 2 of | ||
11 | * the License, or (at your option) any later version. | ||
12 | */ | ||
13 | |||
14 | #include <linux/bug.h> | ||
15 | #include <linux/crc32.h> | ||
16 | #include <linux/delay.h> | ||
17 | #include <linux/device.h> | ||
18 | #include <linux/jiffies.h> | ||
19 | #include <linux/kernel.h> | ||
20 | #include <linux/moduleparam.h> | ||
21 | #include <linux/mutex.h> | ||
22 | #include <linux/string.h> | ||
23 | #include <linux/stringify.h> | ||
24 | #include <linux/wait.h> | ||
25 | #include <linux/workqueue.h> | ||
26 | |||
27 | #include "firedtv.h" | ||
28 | |||
29 | #define FCP_COMMAND_REGISTER 0xfffff0000b00ULL | ||
30 | |||
31 | #define AVC_CTYPE_CONTROL 0x0 | ||
32 | #define AVC_CTYPE_STATUS 0x1 | ||
33 | #define AVC_CTYPE_NOTIFY 0x3 | ||
34 | |||
35 | #define AVC_RESPONSE_ACCEPTED 0x9 | ||
36 | #define AVC_RESPONSE_STABLE 0xc | ||
37 | #define AVC_RESPONSE_CHANGED 0xd | ||
38 | #define AVC_RESPONSE_INTERIM 0xf | ||
39 | |||
40 | #define AVC_SUBUNIT_TYPE_TUNER (0x05 << 3) | ||
41 | #define AVC_SUBUNIT_TYPE_UNIT (0x1f << 3) | ||
42 | |||
43 | #define AVC_OPCODE_VENDOR 0x00 | ||
44 | #define AVC_OPCODE_READ_DESCRIPTOR 0x09 | ||
45 | #define AVC_OPCODE_DSIT 0xc8 | ||
46 | #define AVC_OPCODE_DSD 0xcb | ||
47 | |||
48 | #define DESCRIPTOR_TUNER_STATUS 0x80 | ||
49 | #define DESCRIPTOR_SUBUNIT_IDENTIFIER 0x00 | ||
50 | |||
51 | #define SFE_VENDOR_DE_COMPANYID_0 0x00 /* OUI of Digital Everywhere */ | ||
52 | #define SFE_VENDOR_DE_COMPANYID_1 0x12 | ||
53 | #define SFE_VENDOR_DE_COMPANYID_2 0x87 | ||
54 | |||
55 | #define SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL 0x0a | ||
56 | #define SFE_VENDOR_OPCODE_LNB_CONTROL 0x52 | ||
57 | #define SFE_VENDOR_OPCODE_TUNE_QPSK 0x58 /* for DVB-S */ | ||
58 | |||
59 | #define SFE_VENDOR_OPCODE_GET_FIRMWARE_VERSION 0x00 | ||
60 | #define SFE_VENDOR_OPCODE_HOST2CA 0x56 | ||
61 | #define SFE_VENDOR_OPCODE_CA2HOST 0x57 | ||
62 | #define SFE_VENDOR_OPCODE_CISTATUS 0x59 | ||
63 | #define SFE_VENDOR_OPCODE_TUNE_QPSK2 0x60 /* for DVB-S2 */ | ||
64 | |||
65 | #define SFE_VENDOR_TAG_CA_RESET 0x00 | ||
66 | #define SFE_VENDOR_TAG_CA_APPLICATION_INFO 0x01 | ||
67 | #define SFE_VENDOR_TAG_CA_PMT 0x02 | ||
68 | #define SFE_VENDOR_TAG_CA_DATE_TIME 0x04 | ||
69 | #define SFE_VENDOR_TAG_CA_MMI 0x05 | ||
70 | #define SFE_VENDOR_TAG_CA_ENTER_MENU 0x07 | ||
71 | |||
72 | #define EN50221_LIST_MANAGEMENT_ONLY 0x03 | ||
73 | #define EN50221_TAG_APP_INFO 0x9f8021 | ||
74 | #define EN50221_TAG_CA_INFO 0x9f8031 | ||
75 | |||
76 | struct avc_command_frame { | ||
77 | int length; | ||
78 | u8 ctype; | ||
79 | u8 subunit; | ||
80 | u8 opcode; | ||
81 | u8 operand[509]; | ||
82 | }; | ||
83 | |||
84 | struct avc_response_frame { | ||
85 | int length; | ||
86 | u8 response; | ||
87 | u8 subunit; | ||
88 | u8 opcode; | ||
89 | u8 operand[509]; | ||
90 | }; | ||
91 | |||
92 | #define AVC_DEBUG_FCP_SUBACTIONS 1 | ||
93 | #define AVC_DEBUG_FCP_PAYLOADS 2 | ||
94 | |||
95 | static int avc_debug; | ||
96 | module_param_named(debug, avc_debug, int, 0644); | ||
97 | MODULE_PARM_DESC(debug, "Verbose logging (default = 0" | ||
98 | ", FCP subactions = " __stringify(AVC_DEBUG_FCP_SUBACTIONS) | ||
99 | ", FCP payloads = " __stringify(AVC_DEBUG_FCP_PAYLOADS) | ||
100 | ", or all = -1)"); | ||
101 | |||
102 | static const char *debug_fcp_ctype(unsigned int ctype) | ||
103 | { | ||
104 | static const char *ctypes[] = { | ||
105 | [0x0] = "CONTROL", [0x1] = "STATUS", | ||
106 | [0x2] = "SPECIFIC INQUIRY", [0x3] = "NOTIFY", | ||
107 | [0x4] = "GENERAL INQUIRY", [0x8] = "NOT IMPLEMENTED", | ||
108 | [0x9] = "ACCEPTED", [0xa] = "REJECTED", | ||
109 | [0xb] = "IN TRANSITION", [0xc] = "IMPLEMENTED/STABLE", | ||
110 | [0xd] = "CHANGED", [0xf] = "INTERIM", | ||
111 | }; | ||
112 | const char *ret = ctype < ARRAY_SIZE(ctypes) ? ctypes[ctype] : NULL; | ||
113 | |||
114 | return ret ? ret : "?"; | ||
115 | } | ||
116 | |||
117 | static const char *debug_fcp_opcode(unsigned int opcode, | ||
118 | const u8 *data, size_t length) | ||
119 | { | ||
120 | switch (opcode) { | ||
121 | case AVC_OPCODE_VENDOR: break; | ||
122 | case AVC_OPCODE_READ_DESCRIPTOR: return "ReadDescriptor"; | ||
123 | case AVC_OPCODE_DSIT: return "DirectSelectInfo.Type"; | ||
124 | case AVC_OPCODE_DSD: return "DirectSelectData"; | ||
125 | default: return "?"; | ||
126 | } | ||
127 | |||
128 | if (length < 7 || | ||
129 | data[3] != SFE_VENDOR_DE_COMPANYID_0 || | ||
130 | data[4] != SFE_VENDOR_DE_COMPANYID_1 || | ||
131 | data[5] != SFE_VENDOR_DE_COMPANYID_2) | ||
132 | return "Vendor"; | ||
133 | |||
134 | switch (data[6]) { | ||
135 | case SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL: return "RegisterRC"; | ||
136 | case SFE_VENDOR_OPCODE_LNB_CONTROL: return "LNBControl"; | ||
137 | case SFE_VENDOR_OPCODE_TUNE_QPSK: return "TuneQPSK"; | ||
138 | case SFE_VENDOR_OPCODE_HOST2CA: return "Host2CA"; | ||
139 | case SFE_VENDOR_OPCODE_CA2HOST: return "CA2Host"; | ||
140 | } | ||
141 | return "Vendor"; | ||
142 | } | ||
143 | |||
144 | static void debug_fcp(const u8 *data, size_t length) | ||
145 | { | ||
146 | unsigned int subunit_type, subunit_id, op; | ||
147 | const char *prefix = data[0] > 7 ? "FCP <- " : "FCP -> "; | ||
148 | |||
149 | if (avc_debug & AVC_DEBUG_FCP_SUBACTIONS) { | ||
150 | subunit_type = data[1] >> 3; | ||
151 | subunit_id = data[1] & 7; | ||
152 | op = subunit_type == 0x1e || subunit_id == 5 ? ~0 : data[2]; | ||
153 | printk(KERN_INFO "%ssu=%x.%x l=%d: %-8s - %s\n", | ||
154 | prefix, subunit_type, subunit_id, length, | ||
155 | debug_fcp_ctype(data[0]), | ||
156 | debug_fcp_opcode(op, data, length)); | ||
157 | } | ||
158 | |||
159 | if (avc_debug & AVC_DEBUG_FCP_PAYLOADS) | ||
160 | print_hex_dump(KERN_INFO, prefix, DUMP_PREFIX_NONE, 16, 1, | ||
161 | data, length, false); | ||
162 | } | ||
163 | |||
164 | static int __avc_write(struct firedtv *fdtv, | ||
165 | const struct avc_command_frame *c, struct avc_response_frame *r) | ||
166 | { | ||
167 | int err, retry; | ||
168 | |||
169 | if (r) | ||
170 | fdtv->avc_reply_received = false; | ||
171 | |||
172 | for (retry = 0; retry < 6; retry++) { | ||
173 | if (unlikely(avc_debug)) | ||
174 | debug_fcp(&c->ctype, c->length); | ||
175 | |||
176 | err = fdtv->backend->write(fdtv, FCP_COMMAND_REGISTER, | ||
177 | (void *)&c->ctype, c->length); | ||
178 | if (err) { | ||
179 | fdtv->avc_reply_received = true; | ||
180 | dev_err(fdtv->device, "FCP command write failed\n"); | ||
181 | return err; | ||
182 | } | ||
183 | |||
184 | if (!r) | ||
185 | return 0; | ||
186 | |||
187 | /* | ||
188 | * AV/C specs say that answers should be sent within 150 ms. | ||
189 | * Time out after 200 ms. | ||
190 | */ | ||
191 | if (wait_event_timeout(fdtv->avc_wait, | ||
192 | fdtv->avc_reply_received, | ||
193 | msecs_to_jiffies(200)) != 0) { | ||
194 | r->length = fdtv->response_length; | ||
195 | memcpy(&r->response, fdtv->response, r->length); | ||
196 | |||
197 | return 0; | ||
198 | } | ||
199 | } | ||
200 | dev_err(fdtv->device, "FCP response timed out\n"); | ||
201 | return -ETIMEDOUT; | ||
202 | } | ||
203 | |||
204 | static int avc_write(struct firedtv *fdtv, | ||
205 | const struct avc_command_frame *c, struct avc_response_frame *r) | ||
206 | { | ||
207 | int ret; | ||
208 | |||
209 | if (mutex_lock_interruptible(&fdtv->avc_mutex)) | ||
210 | return -EINTR; | ||
211 | |||
212 | ret = __avc_write(fdtv, c, r); | ||
213 | |||
214 | mutex_unlock(&fdtv->avc_mutex); | ||
215 | return ret; | ||
216 | } | ||
217 | |||
218 | int avc_recv(struct firedtv *fdtv, void *data, size_t length) | ||
219 | { | ||
220 | struct avc_response_frame *r = | ||
221 | data - offsetof(struct avc_response_frame, response); | ||
222 | |||
223 | if (unlikely(avc_debug)) | ||
224 | debug_fcp(data, length); | ||
225 | |||
226 | if (length >= 8 && | ||
227 | r->operand[0] == SFE_VENDOR_DE_COMPANYID_0 && | ||
228 | r->operand[1] == SFE_VENDOR_DE_COMPANYID_1 && | ||
229 | r->operand[2] == SFE_VENDOR_DE_COMPANYID_2 && | ||
230 | r->operand[3] == SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL) { | ||
231 | if (r->response == AVC_RESPONSE_CHANGED) { | ||
232 | fdtv_handle_rc(fdtv, | ||
233 | r->operand[4] << 8 | r->operand[5]); | ||
234 | schedule_work(&fdtv->remote_ctrl_work); | ||
235 | } else if (r->response != AVC_RESPONSE_INTERIM) { | ||
236 | dev_info(fdtv->device, | ||
237 | "remote control result = %d\n", r->response); | ||
238 | } | ||
239 | return 0; | ||
240 | } | ||
241 | |||
242 | if (fdtv->avc_reply_received) { | ||
243 | dev_err(fdtv->device, "out-of-order AVC response, ignored\n"); | ||
244 | return -EIO; | ||
245 | } | ||
246 | |||
247 | memcpy(fdtv->response, data, length); | ||
248 | fdtv->response_length = length; | ||
249 | |||
250 | fdtv->avc_reply_received = true; | ||
251 | wake_up(&fdtv->avc_wait); | ||
252 | |||
253 | return 0; | ||
254 | } | ||
255 | |||
256 | /* | ||
257 | * tuning command for setting the relative LNB frequency | ||
258 | * (not supported by the AVC standard) | ||
259 | */ | ||
260 | static void avc_tuner_tuneqpsk(struct firedtv *fdtv, | ||
261 | struct dvb_frontend_parameters *params, | ||
262 | struct avc_command_frame *c) | ||
263 | { | ||
264 | c->opcode = AVC_OPCODE_VENDOR; | ||
265 | |||
266 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
267 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
268 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
269 | c->operand[3] = SFE_VENDOR_OPCODE_TUNE_QPSK; | ||
270 | |||
271 | c->operand[4] = (params->frequency >> 24) & 0xff; | ||
272 | c->operand[5] = (params->frequency >> 16) & 0xff; | ||
273 | c->operand[6] = (params->frequency >> 8) & 0xff; | ||
274 | c->operand[7] = params->frequency & 0xff; | ||
275 | |||
276 | c->operand[8] = ((params->u.qpsk.symbol_rate / 1000) >> 8) & 0xff; | ||
277 | c->operand[9] = (params->u.qpsk.symbol_rate / 1000) & 0xff; | ||
278 | |||
279 | switch (params->u.qpsk.fec_inner) { | ||
280 | case FEC_1_2: c->operand[10] = 0x1; break; | ||
281 | case FEC_2_3: c->operand[10] = 0x2; break; | ||
282 | case FEC_3_4: c->operand[10] = 0x3; break; | ||
283 | case FEC_5_6: c->operand[10] = 0x4; break; | ||
284 | case FEC_7_8: c->operand[10] = 0x5; break; | ||
285 | case FEC_4_5: | ||
286 | case FEC_8_9: | ||
287 | case FEC_AUTO: | ||
288 | default: c->operand[10] = 0x0; | ||
289 | } | ||
290 | |||
291 | if (fdtv->voltage == 0xff) | ||
292 | c->operand[11] = 0xff; | ||
293 | else if (fdtv->voltage == SEC_VOLTAGE_18) /* polarisation */ | ||
294 | c->operand[11] = 0; | ||
295 | else | ||
296 | c->operand[11] = 1; | ||
297 | |||
298 | if (fdtv->tone == 0xff) | ||
299 | c->operand[12] = 0xff; | ||
300 | else if (fdtv->tone == SEC_TONE_ON) /* band */ | ||
301 | c->operand[12] = 1; | ||
302 | else | ||
303 | c->operand[12] = 0; | ||
304 | |||
305 | if (fdtv->type == FIREDTV_DVB_S2) { | ||
306 | c->operand[13] = 0x1; | ||
307 | c->operand[14] = 0xff; | ||
308 | c->operand[15] = 0xff; | ||
309 | c->length = 20; | ||
310 | } else { | ||
311 | c->length = 16; | ||
312 | } | ||
313 | } | ||
314 | |||
315 | static void avc_tuner_dsd_dvb_c(struct dvb_frontend_parameters *params, | ||
316 | struct avc_command_frame *c) | ||
317 | { | ||
318 | c->opcode = AVC_OPCODE_DSD; | ||
319 | |||
320 | c->operand[0] = 0; /* source plug */ | ||
321 | c->operand[1] = 0xd2; /* subfunction replace */ | ||
322 | c->operand[2] = 0x20; /* system id = DVB */ | ||
323 | c->operand[3] = 0x00; /* antenna number */ | ||
324 | c->operand[4] = 0x11; /* system_specific_multiplex selection_length */ | ||
325 | |||
326 | /* multiplex_valid_flags, high byte */ | ||
327 | c->operand[5] = 0 << 7 /* reserved */ | ||
328 | | 0 << 6 /* Polarisation */ | ||
329 | | 0 << 5 /* Orbital_Pos */ | ||
330 | | 1 << 4 /* Frequency */ | ||
331 | | 1 << 3 /* Symbol_Rate */ | ||
332 | | 0 << 2 /* FEC_outer */ | ||
333 | | (params->u.qam.fec_inner != FEC_AUTO ? 1 << 1 : 0) | ||
334 | | (params->u.qam.modulation != QAM_AUTO ? 1 << 0 : 0); | ||
335 | |||
336 | /* multiplex_valid_flags, low byte */ | ||
337 | c->operand[6] = 0 << 7 /* NetworkID */ | ||
338 | | 0 << 0 /* reserved */ ; | ||
339 | |||
340 | c->operand[7] = 0x00; | ||
341 | c->operand[8] = 0x00; | ||
342 | c->operand[9] = 0x00; | ||
343 | c->operand[10] = 0x00; | ||
344 | |||
345 | c->operand[11] = (((params->frequency / 4000) >> 16) & 0xff) | (2 << 6); | ||
346 | c->operand[12] = ((params->frequency / 4000) >> 8) & 0xff; | ||
347 | c->operand[13] = (params->frequency / 4000) & 0xff; | ||
348 | c->operand[14] = ((params->u.qpsk.symbol_rate / 1000) >> 12) & 0xff; | ||
349 | c->operand[15] = ((params->u.qpsk.symbol_rate / 1000) >> 4) & 0xff; | ||
350 | c->operand[16] = ((params->u.qpsk.symbol_rate / 1000) << 4) & 0xf0; | ||
351 | c->operand[17] = 0x00; | ||
352 | |||
353 | switch (params->u.qpsk.fec_inner) { | ||
354 | case FEC_1_2: c->operand[18] = 0x1; break; | ||
355 | case FEC_2_3: c->operand[18] = 0x2; break; | ||
356 | case FEC_3_4: c->operand[18] = 0x3; break; | ||
357 | case FEC_5_6: c->operand[18] = 0x4; break; | ||
358 | case FEC_7_8: c->operand[18] = 0x5; break; | ||
359 | case FEC_8_9: c->operand[18] = 0x6; break; | ||
360 | case FEC_4_5: c->operand[18] = 0x8; break; | ||
361 | case FEC_AUTO: | ||
362 | default: c->operand[18] = 0x0; | ||
363 | } | ||
364 | |||
365 | switch (params->u.qam.modulation) { | ||
366 | case QAM_16: c->operand[19] = 0x08; break; | ||
367 | case QAM_32: c->operand[19] = 0x10; break; | ||
368 | case QAM_64: c->operand[19] = 0x18; break; | ||
369 | case QAM_128: c->operand[19] = 0x20; break; | ||
370 | case QAM_256: c->operand[19] = 0x28; break; | ||
371 | case QAM_AUTO: | ||
372 | default: c->operand[19] = 0x00; | ||
373 | } | ||
374 | |||
375 | c->operand[20] = 0x00; | ||
376 | c->operand[21] = 0x00; | ||
377 | /* Nr_of_dsd_sel_specs = 0 -> no PIDs are transmitted */ | ||
378 | c->operand[22] = 0x00; | ||
379 | |||
380 | c->length = 28; | ||
381 | } | ||
382 | |||
383 | static void avc_tuner_dsd_dvb_t(struct dvb_frontend_parameters *params, | ||
384 | struct avc_command_frame *c) | ||
385 | { | ||
386 | struct dvb_ofdm_parameters *ofdm = ¶ms->u.ofdm; | ||
387 | |||
388 | c->opcode = AVC_OPCODE_DSD; | ||
389 | |||
390 | c->operand[0] = 0; /* source plug */ | ||
391 | c->operand[1] = 0xd2; /* subfunction replace */ | ||
392 | c->operand[2] = 0x20; /* system id = DVB */ | ||
393 | c->operand[3] = 0x00; /* antenna number */ | ||
394 | c->operand[4] = 0x0c; /* system_specific_multiplex selection_length */ | ||
395 | |||
396 | /* multiplex_valid_flags, high byte */ | ||
397 | c->operand[5] = | ||
398 | 0 << 7 /* reserved */ | ||
399 | | 1 << 6 /* CenterFrequency */ | ||
400 | | (ofdm->bandwidth != BANDWIDTH_AUTO ? 1 << 5 : 0) | ||
401 | | (ofdm->constellation != QAM_AUTO ? 1 << 4 : 0) | ||
402 | | (ofdm->hierarchy_information != HIERARCHY_AUTO ? 1 << 3 : 0) | ||
403 | | (ofdm->code_rate_HP != FEC_AUTO ? 1 << 2 : 0) | ||
404 | | (ofdm->code_rate_LP != FEC_AUTO ? 1 << 1 : 0) | ||
405 | | (ofdm->guard_interval != GUARD_INTERVAL_AUTO ? 1 << 0 : 0); | ||
406 | |||
407 | /* multiplex_valid_flags, low byte */ | ||
408 | c->operand[6] = | ||
409 | 0 << 7 /* NetworkID */ | ||
410 | | (ofdm->transmission_mode != TRANSMISSION_MODE_AUTO ? 1 << 6 : 0) | ||
411 | | 0 << 5 /* OtherFrequencyFlag */ | ||
412 | | 0 << 0 /* reserved */ ; | ||
413 | |||
414 | c->operand[7] = 0x0; | ||
415 | c->operand[8] = (params->frequency / 10) >> 24; | ||
416 | c->operand[9] = ((params->frequency / 10) >> 16) & 0xff; | ||
417 | c->operand[10] = ((params->frequency / 10) >> 8) & 0xff; | ||
418 | c->operand[11] = (params->frequency / 10) & 0xff; | ||
419 | |||
420 | switch (ofdm->bandwidth) { | ||
421 | case BANDWIDTH_7_MHZ: c->operand[12] = 0x20; break; | ||
422 | case BANDWIDTH_8_MHZ: | ||
423 | case BANDWIDTH_6_MHZ: /* not defined by AVC spec */ | ||
424 | case BANDWIDTH_AUTO: | ||
425 | default: c->operand[12] = 0x00; | ||
426 | } | ||
427 | |||
428 | switch (ofdm->constellation) { | ||
429 | case QAM_16: c->operand[13] = 1 << 6; break; | ||
430 | case QAM_64: c->operand[13] = 2 << 6; break; | ||
431 | case QPSK: | ||
432 | default: c->operand[13] = 0x00; | ||
433 | } | ||
434 | |||
435 | switch (ofdm->hierarchy_information) { | ||
436 | case HIERARCHY_1: c->operand[13] |= 1 << 3; break; | ||
437 | case HIERARCHY_2: c->operand[13] |= 2 << 3; break; | ||
438 | case HIERARCHY_4: c->operand[13] |= 3 << 3; break; | ||
439 | case HIERARCHY_AUTO: | ||
440 | case HIERARCHY_NONE: | ||
441 | default: break; | ||
442 | } | ||
443 | |||
444 | switch (ofdm->code_rate_HP) { | ||
445 | case FEC_2_3: c->operand[13] |= 1; break; | ||
446 | case FEC_3_4: c->operand[13] |= 2; break; | ||
447 | case FEC_5_6: c->operand[13] |= 3; break; | ||
448 | case FEC_7_8: c->operand[13] |= 4; break; | ||
449 | case FEC_1_2: | ||
450 | default: break; | ||
451 | } | ||
452 | |||
453 | switch (ofdm->code_rate_LP) { | ||
454 | case FEC_2_3: c->operand[14] = 1 << 5; break; | ||
455 | case FEC_3_4: c->operand[14] = 2 << 5; break; | ||
456 | case FEC_5_6: c->operand[14] = 3 << 5; break; | ||
457 | case FEC_7_8: c->operand[14] = 4 << 5; break; | ||
458 | case FEC_1_2: | ||
459 | default: c->operand[14] = 0x00; break; | ||
460 | } | ||
461 | |||
462 | switch (ofdm->guard_interval) { | ||
463 | case GUARD_INTERVAL_1_16: c->operand[14] |= 1 << 3; break; | ||
464 | case GUARD_INTERVAL_1_8: c->operand[14] |= 2 << 3; break; | ||
465 | case GUARD_INTERVAL_1_4: c->operand[14] |= 3 << 3; break; | ||
466 | case GUARD_INTERVAL_1_32: | ||
467 | case GUARD_INTERVAL_AUTO: | ||
468 | default: break; | ||
469 | } | ||
470 | |||
471 | switch (ofdm->transmission_mode) { | ||
472 | case TRANSMISSION_MODE_8K: c->operand[14] |= 1 << 1; break; | ||
473 | case TRANSMISSION_MODE_2K: | ||
474 | case TRANSMISSION_MODE_AUTO: | ||
475 | default: break; | ||
476 | } | ||
477 | |||
478 | c->operand[15] = 0x00; /* network_ID[0] */ | ||
479 | c->operand[16] = 0x00; /* network_ID[1] */ | ||
480 | /* Nr_of_dsd_sel_specs = 0 -> no PIDs are transmitted */ | ||
481 | c->operand[17] = 0x00; | ||
482 | |||
483 | c->length = 24; | ||
484 | } | ||
485 | |||
486 | int avc_tuner_dsd(struct firedtv *fdtv, | ||
487 | struct dvb_frontend_parameters *params) | ||
488 | { | ||
489 | char buffer[sizeof(struct avc_command_frame)]; | ||
490 | struct avc_command_frame *c = (void *)buffer; | ||
491 | struct avc_response_frame *r = (void *)buffer; /* FIXME: unused */ | ||
492 | |||
493 | memset(c, 0, sizeof(*c)); | ||
494 | |||
495 | c->ctype = AVC_CTYPE_CONTROL; | ||
496 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
497 | |||
498 | switch (fdtv->type) { | ||
499 | case FIREDTV_DVB_S: | ||
500 | case FIREDTV_DVB_S2: avc_tuner_tuneqpsk(fdtv, params, c); break; | ||
501 | case FIREDTV_DVB_C: avc_tuner_dsd_dvb_c(params, c); break; | ||
502 | case FIREDTV_DVB_T: avc_tuner_dsd_dvb_t(params, c); break; | ||
503 | default: | ||
504 | BUG(); | ||
505 | } | ||
506 | |||
507 | if (avc_write(fdtv, c, r) < 0) | ||
508 | return -EIO; | ||
509 | |||
510 | msleep(500); | ||
511 | #if 0 | ||
512 | /* FIXME: */ | ||
513 | /* u8 *status was an out-parameter of avc_tuner_dsd, unused by caller */ | ||
514 | if (status) | ||
515 | *status = r->operand[2]; | ||
516 | #endif | ||
517 | return 0; | ||
518 | } | ||
519 | |||
520 | int avc_tuner_set_pids(struct firedtv *fdtv, unsigned char pidc, u16 pid[]) | ||
521 | { | ||
522 | char buffer[sizeof(struct avc_command_frame)]; | ||
523 | struct avc_command_frame *c = (void *)buffer; | ||
524 | struct avc_response_frame *r = (void *)buffer; /* FIXME: unused */ | ||
525 | int pos, k; | ||
526 | |||
527 | if (pidc > 16 && pidc != 0xff) | ||
528 | return -EINVAL; | ||
529 | |||
530 | memset(c, 0, sizeof(*c)); | ||
531 | |||
532 | c->ctype = AVC_CTYPE_CONTROL; | ||
533 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
534 | c->opcode = AVC_OPCODE_DSD; | ||
535 | |||
536 | c->operand[0] = 0; /* source plug */ | ||
537 | c->operand[1] = 0xd2; /* subfunction replace */ | ||
538 | c->operand[2] = 0x20; /* system id = DVB */ | ||
539 | c->operand[3] = 0x00; /* antenna number */ | ||
540 | c->operand[4] = 0x00; /* system_specific_multiplex selection_length */ | ||
541 | c->operand[5] = pidc; /* Nr_of_dsd_sel_specs */ | ||
542 | |||
543 | pos = 6; | ||
544 | if (pidc != 0xff) | ||
545 | for (k = 0; k < pidc; k++) { | ||
546 | c->operand[pos++] = 0x13; /* flowfunction relay */ | ||
547 | c->operand[pos++] = 0x80; /* dsd_sel_spec_valid_flags -> PID */ | ||
548 | c->operand[pos++] = (pid[k] >> 8) & 0x1f; | ||
549 | c->operand[pos++] = pid[k] & 0xff; | ||
550 | c->operand[pos++] = 0x00; /* tableID */ | ||
551 | c->operand[pos++] = 0x00; /* filter_length */ | ||
552 | } | ||
553 | |||
554 | c->length = ALIGN(3 + pos, 4); | ||
555 | |||
556 | if (avc_write(fdtv, c, r) < 0) | ||
557 | return -EIO; | ||
558 | |||
559 | msleep(50); | ||
560 | return 0; | ||
561 | } | ||
562 | |||
563 | int avc_tuner_get_ts(struct firedtv *fdtv) | ||
564 | { | ||
565 | char buffer[sizeof(struct avc_command_frame)]; | ||
566 | struct avc_command_frame *c = (void *)buffer; | ||
567 | struct avc_response_frame *r = (void *)buffer; /* FIXME: unused */ | ||
568 | int sl; | ||
569 | |||
570 | memset(c, 0, sizeof(*c)); | ||
571 | |||
572 | c->ctype = AVC_CTYPE_CONTROL; | ||
573 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
574 | c->opcode = AVC_OPCODE_DSIT; | ||
575 | |||
576 | sl = fdtv->type == FIREDTV_DVB_T ? 0x0c : 0x11; | ||
577 | |||
578 | c->operand[0] = 0; /* source plug */ | ||
579 | c->operand[1] = 0xd2; /* subfunction replace */ | ||
580 | c->operand[2] = 0xff; /* status */ | ||
581 | c->operand[3] = 0x20; /* system id = DVB */ | ||
582 | c->operand[4] = 0x00; /* antenna number */ | ||
583 | c->operand[5] = 0x0; /* system_specific_search_flags */ | ||
584 | c->operand[6] = sl; /* system_specific_multiplex selection_length */ | ||
585 | c->operand[7] = 0x00; /* valid_flags [0] */ | ||
586 | c->operand[8] = 0x00; /* valid_flags [1] */ | ||
587 | c->operand[7 + sl] = 0x00; /* nr_of_dsit_sel_specs (always 0) */ | ||
588 | |||
589 | c->length = fdtv->type == FIREDTV_DVB_T ? 24 : 28; | ||
590 | |||
591 | if (avc_write(fdtv, c, r) < 0) | ||
592 | return -EIO; | ||
593 | |||
594 | msleep(250); | ||
595 | return 0; | ||
596 | } | ||
597 | |||
598 | int avc_identify_subunit(struct firedtv *fdtv) | ||
599 | { | ||
600 | char buffer[sizeof(struct avc_command_frame)]; | ||
601 | struct avc_command_frame *c = (void *)buffer; | ||
602 | struct avc_response_frame *r = (void *)buffer; | ||
603 | |||
604 | memset(c, 0, sizeof(*c)); | ||
605 | |||
606 | c->ctype = AVC_CTYPE_CONTROL; | ||
607 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
608 | c->opcode = AVC_OPCODE_READ_DESCRIPTOR; | ||
609 | |||
610 | c->operand[0] = DESCRIPTOR_SUBUNIT_IDENTIFIER; | ||
611 | c->operand[1] = 0xff; | ||
612 | c->operand[2] = 0x00; | ||
613 | c->operand[3] = 0x00; /* length highbyte */ | ||
614 | c->operand[4] = 0x08; /* length lowbyte */ | ||
615 | c->operand[5] = 0x00; /* offset highbyte */ | ||
616 | c->operand[6] = 0x0d; /* offset lowbyte */ | ||
617 | |||
618 | c->length = 12; | ||
619 | |||
620 | if (avc_write(fdtv, c, r) < 0) | ||
621 | return -EIO; | ||
622 | |||
623 | if ((r->response != AVC_RESPONSE_STABLE && | ||
624 | r->response != AVC_RESPONSE_ACCEPTED) || | ||
625 | (r->operand[3] << 8) + r->operand[4] != 8) { | ||
626 | dev_err(fdtv->device, "cannot read subunit identifier\n"); | ||
627 | return -EINVAL; | ||
628 | } | ||
629 | return 0; | ||
630 | } | ||
631 | |||
632 | #define SIZEOF_ANTENNA_INPUT_INFO 22 | ||
633 | |||
634 | int avc_tuner_status(struct firedtv *fdtv, struct firedtv_tuner_status *stat) | ||
635 | { | ||
636 | char buffer[sizeof(struct avc_command_frame)]; | ||
637 | struct avc_command_frame *c = (void *)buffer; | ||
638 | struct avc_response_frame *r = (void *)buffer; | ||
639 | int length; | ||
640 | |||
641 | memset(c, 0, sizeof(*c)); | ||
642 | |||
643 | c->ctype = AVC_CTYPE_CONTROL; | ||
644 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
645 | c->opcode = AVC_OPCODE_READ_DESCRIPTOR; | ||
646 | |||
647 | c->operand[0] = DESCRIPTOR_TUNER_STATUS; | ||
648 | c->operand[1] = 0xff; /* read_result_status */ | ||
649 | c->operand[2] = 0x00; /* reserved */ | ||
650 | c->operand[3] = 0; /* SIZEOF_ANTENNA_INPUT_INFO >> 8; */ | ||
651 | c->operand[4] = 0; /* SIZEOF_ANTENNA_INPUT_INFO & 0xff; */ | ||
652 | c->operand[5] = 0x00; | ||
653 | c->operand[6] = 0x00; | ||
654 | |||
655 | c->length = 12; | ||
656 | |||
657 | if (avc_write(fdtv, c, r) < 0) | ||
658 | return -EIO; | ||
659 | |||
660 | if (r->response != AVC_RESPONSE_STABLE && | ||
661 | r->response != AVC_RESPONSE_ACCEPTED) { | ||
662 | dev_err(fdtv->device, "cannot read tuner status\n"); | ||
663 | return -EINVAL; | ||
664 | } | ||
665 | |||
666 | length = r->operand[9]; | ||
667 | if (r->operand[1] != 0x10 || length != SIZEOF_ANTENNA_INPUT_INFO) { | ||
668 | dev_err(fdtv->device, "got invalid tuner status\n"); | ||
669 | return -EINVAL; | ||
670 | } | ||
671 | |||
672 | stat->active_system = r->operand[10]; | ||
673 | stat->searching = r->operand[11] >> 7 & 1; | ||
674 | stat->moving = r->operand[11] >> 6 & 1; | ||
675 | stat->no_rf = r->operand[11] >> 5 & 1; | ||
676 | stat->input = r->operand[12] >> 7 & 1; | ||
677 | stat->selected_antenna = r->operand[12] & 0x7f; | ||
678 | stat->ber = r->operand[13] << 24 | | ||
679 | r->operand[14] << 16 | | ||
680 | r->operand[15] << 8 | | ||
681 | r->operand[16]; | ||
682 | stat->signal_strength = r->operand[17]; | ||
683 | stat->raster_frequency = r->operand[18] >> 6 & 2; | ||
684 | stat->rf_frequency = (r->operand[18] & 0x3f) << 16 | | ||
685 | r->operand[19] << 8 | | ||
686 | r->operand[20]; | ||
687 | stat->man_dep_info_length = r->operand[21]; | ||
688 | stat->front_end_error = r->operand[22] >> 4 & 1; | ||
689 | stat->antenna_error = r->operand[22] >> 3 & 1; | ||
690 | stat->front_end_power_status = r->operand[22] >> 1 & 1; | ||
691 | stat->power_supply = r->operand[22] & 1; | ||
692 | stat->carrier_noise_ratio = r->operand[23] << 8 | | ||
693 | r->operand[24]; | ||
694 | stat->power_supply_voltage = r->operand[27]; | ||
695 | stat->antenna_voltage = r->operand[28]; | ||
696 | stat->firewire_bus_voltage = r->operand[29]; | ||
697 | stat->ca_mmi = r->operand[30] & 1; | ||
698 | stat->ca_pmt_reply = r->operand[31] >> 7 & 1; | ||
699 | stat->ca_date_time_request = r->operand[31] >> 6 & 1; | ||
700 | stat->ca_application_info = r->operand[31] >> 5 & 1; | ||
701 | stat->ca_module_present_status = r->operand[31] >> 4 & 1; | ||
702 | stat->ca_dvb_flag = r->operand[31] >> 3 & 1; | ||
703 | stat->ca_error_flag = r->operand[31] >> 2 & 1; | ||
704 | stat->ca_initialization_status = r->operand[31] >> 1 & 1; | ||
705 | |||
706 | return 0; | ||
707 | } | ||
708 | |||
709 | int avc_lnb_control(struct firedtv *fdtv, char voltage, char burst, | ||
710 | char conttone, char nrdiseq, | ||
711 | struct dvb_diseqc_master_cmd *diseqcmd) | ||
712 | { | ||
713 | char buffer[sizeof(struct avc_command_frame)]; | ||
714 | struct avc_command_frame *c = (void *)buffer; | ||
715 | struct avc_response_frame *r = (void *)buffer; | ||
716 | int i, j, k; | ||
717 | |||
718 | memset(c, 0, sizeof(*c)); | ||
719 | |||
720 | c->ctype = AVC_CTYPE_CONTROL; | ||
721 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
722 | c->opcode = AVC_OPCODE_VENDOR; | ||
723 | |||
724 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
725 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
726 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
727 | c->operand[3] = SFE_VENDOR_OPCODE_LNB_CONTROL; | ||
728 | |||
729 | c->operand[4] = voltage; | ||
730 | c->operand[5] = nrdiseq; | ||
731 | |||
732 | i = 6; | ||
733 | |||
734 | for (j = 0; j < nrdiseq; j++) { | ||
735 | c->operand[i++] = diseqcmd[j].msg_len; | ||
736 | |||
737 | for (k = 0; k < diseqcmd[j].msg_len; k++) | ||
738 | c->operand[i++] = diseqcmd[j].msg[k]; | ||
739 | } | ||
740 | |||
741 | c->operand[i++] = burst; | ||
742 | c->operand[i++] = conttone; | ||
743 | |||
744 | c->length = ALIGN(3 + i, 4); | ||
745 | |||
746 | if (avc_write(fdtv, c, r) < 0) | ||
747 | return -EIO; | ||
748 | |||
749 | if (r->response != AVC_RESPONSE_ACCEPTED) { | ||
750 | dev_err(fdtv->device, "LNB control failed\n"); | ||
751 | return -EINVAL; | ||
752 | } | ||
753 | |||
754 | return 0; | ||
755 | } | ||
756 | |||
757 | int avc_register_remote_control(struct firedtv *fdtv) | ||
758 | { | ||
759 | char buffer[sizeof(struct avc_command_frame)]; | ||
760 | struct avc_command_frame *c = (void *)buffer; | ||
761 | |||
762 | memset(c, 0, sizeof(*c)); | ||
763 | |||
764 | c->ctype = AVC_CTYPE_NOTIFY; | ||
765 | c->subunit = AVC_SUBUNIT_TYPE_UNIT | 7; | ||
766 | c->opcode = AVC_OPCODE_VENDOR; | ||
767 | |||
768 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
769 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
770 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
771 | c->operand[3] = SFE_VENDOR_OPCODE_REGISTER_REMOTE_CONTROL; | ||
772 | |||
773 | c->length = 8; | ||
774 | |||
775 | return avc_write(fdtv, c, NULL); | ||
776 | } | ||
777 | |||
778 | void avc_remote_ctrl_work(struct work_struct *work) | ||
779 | { | ||
780 | struct firedtv *fdtv = | ||
781 | container_of(work, struct firedtv, remote_ctrl_work); | ||
782 | |||
783 | /* Should it be rescheduled in failure cases? */ | ||
784 | avc_register_remote_control(fdtv); | ||
785 | } | ||
786 | |||
787 | #if 0 /* FIXME: unused */ | ||
788 | int avc_tuner_host2ca(struct firedtv *fdtv) | ||
789 | { | ||
790 | char buffer[sizeof(struct avc_command_frame)]; | ||
791 | struct avc_command_frame *c = (void *)buffer; | ||
792 | struct avc_response_frame *r = (void *)buffer; /* FIXME: unused */ | ||
793 | |||
794 | memset(c, 0, sizeof(*c)); | ||
795 | |||
796 | c->ctype = AVC_CTYPE_CONTROL; | ||
797 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
798 | c->opcode = AVC_OPCODE_VENDOR; | ||
799 | |||
800 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
801 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
802 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
803 | c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; | ||
804 | c->operand[4] = 0; /* slot */ | ||
805 | c->operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; /* ca tag */ | ||
806 | c->operand[6] = 0; /* more/last */ | ||
807 | c->operand[7] = 0; /* length */ | ||
808 | |||
809 | c->length = 12; | ||
810 | |||
811 | if (avc_write(fdtv, c, r) < 0) | ||
812 | return -EIO; | ||
813 | |||
814 | return 0; | ||
815 | } | ||
816 | #endif | ||
817 | |||
818 | static int get_ca_object_pos(struct avc_response_frame *r) | ||
819 | { | ||
820 | int length = 1; | ||
821 | |||
822 | /* Check length of length field */ | ||
823 | if (r->operand[7] & 0x80) | ||
824 | length = (r->operand[7] & 0x7f) + 1; | ||
825 | return length + 7; | ||
826 | } | ||
827 | |||
828 | static int get_ca_object_length(struct avc_response_frame *r) | ||
829 | { | ||
830 | #if 0 /* FIXME: unused */ | ||
831 | int size = 0; | ||
832 | int i; | ||
833 | |||
834 | if (r->operand[7] & 0x80) | ||
835 | for (i = 0; i < (r->operand[7] & 0x7f); i++) { | ||
836 | size <<= 8; | ||
837 | size += r->operand[8 + i]; | ||
838 | } | ||
839 | #endif | ||
840 | return r->operand[7]; | ||
841 | } | ||
842 | |||
843 | int avc_ca_app_info(struct firedtv *fdtv, char *app_info, unsigned int *len) | ||
844 | { | ||
845 | char buffer[sizeof(struct avc_command_frame)]; | ||
846 | struct avc_command_frame *c = (void *)buffer; | ||
847 | struct avc_response_frame *r = (void *)buffer; | ||
848 | int pos; | ||
849 | |||
850 | memset(c, 0, sizeof(*c)); | ||
851 | |||
852 | c->ctype = AVC_CTYPE_STATUS; | ||
853 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
854 | c->opcode = AVC_OPCODE_VENDOR; | ||
855 | |||
856 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
857 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
858 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
859 | c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; | ||
860 | c->operand[4] = 0; /* slot */ | ||
861 | c->operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; /* ca tag */ | ||
862 | |||
863 | c->length = 12; | ||
864 | |||
865 | if (avc_write(fdtv, c, r) < 0) | ||
866 | return -EIO; | ||
867 | |||
868 | /* FIXME: check response code and validate response data */ | ||
869 | |||
870 | pos = get_ca_object_pos(r); | ||
871 | app_info[0] = (EN50221_TAG_APP_INFO >> 16) & 0xff; | ||
872 | app_info[1] = (EN50221_TAG_APP_INFO >> 8) & 0xff; | ||
873 | app_info[2] = (EN50221_TAG_APP_INFO >> 0) & 0xff; | ||
874 | app_info[3] = 6 + r->operand[pos + 4]; | ||
875 | app_info[4] = 0x01; | ||
876 | memcpy(&app_info[5], &r->operand[pos], 5 + r->operand[pos + 4]); | ||
877 | *len = app_info[3] + 4; | ||
878 | |||
879 | return 0; | ||
880 | } | ||
881 | |||
882 | int avc_ca_info(struct firedtv *fdtv, char *app_info, unsigned int *len) | ||
883 | { | ||
884 | char buffer[sizeof(struct avc_command_frame)]; | ||
885 | struct avc_command_frame *c = (void *)buffer; | ||
886 | struct avc_response_frame *r = (void *)buffer; | ||
887 | int pos; | ||
888 | |||
889 | memset(c, 0, sizeof(*c)); | ||
890 | |||
891 | c->ctype = AVC_CTYPE_STATUS; | ||
892 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
893 | c->opcode = AVC_OPCODE_VENDOR; | ||
894 | |||
895 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
896 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
897 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
898 | c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; | ||
899 | c->operand[4] = 0; /* slot */ | ||
900 | c->operand[5] = SFE_VENDOR_TAG_CA_APPLICATION_INFO; /* ca tag */ | ||
901 | |||
902 | c->length = 12; | ||
903 | |||
904 | if (avc_write(fdtv, c, r) < 0) | ||
905 | return -EIO; | ||
906 | |||
907 | pos = get_ca_object_pos(r); | ||
908 | app_info[0] = (EN50221_TAG_CA_INFO >> 16) & 0xff; | ||
909 | app_info[1] = (EN50221_TAG_CA_INFO >> 8) & 0xff; | ||
910 | app_info[2] = (EN50221_TAG_CA_INFO >> 0) & 0xff; | ||
911 | app_info[3] = 2; | ||
912 | app_info[4] = r->operand[pos + 0]; | ||
913 | app_info[5] = r->operand[pos + 1]; | ||
914 | *len = app_info[3] + 4; | ||
915 | |||
916 | return 0; | ||
917 | } | ||
918 | |||
919 | int avc_ca_reset(struct firedtv *fdtv) | ||
920 | { | ||
921 | char buffer[sizeof(struct avc_command_frame)]; | ||
922 | struct avc_command_frame *c = (void *)buffer; | ||
923 | struct avc_response_frame *r = (void *)buffer; /* FIXME: unused */ | ||
924 | |||
925 | memset(c, 0, sizeof(*c)); | ||
926 | |||
927 | c->ctype = AVC_CTYPE_CONTROL; | ||
928 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
929 | c->opcode = AVC_OPCODE_VENDOR; | ||
930 | |||
931 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
932 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
933 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
934 | c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; | ||
935 | c->operand[4] = 0; /* slot */ | ||
936 | c->operand[5] = SFE_VENDOR_TAG_CA_RESET; /* ca tag */ | ||
937 | c->operand[6] = 0; /* more/last */ | ||
938 | c->operand[7] = 1; /* length */ | ||
939 | c->operand[8] = 0; /* force hardware reset */ | ||
940 | |||
941 | c->length = 12; | ||
942 | |||
943 | if (avc_write(fdtv, c, r) < 0) | ||
944 | return -EIO; | ||
945 | |||
946 | return 0; | ||
947 | } | ||
948 | |||
949 | int avc_ca_pmt(struct firedtv *fdtv, char *msg, int length) | ||
950 | { | ||
951 | char buffer[sizeof(struct avc_command_frame)]; | ||
952 | struct avc_command_frame *c = (void *)buffer; | ||
953 | struct avc_response_frame *r = (void *)buffer; | ||
954 | int list_management; | ||
955 | int program_info_length; | ||
956 | int pmt_cmd_id; | ||
957 | int read_pos; | ||
958 | int write_pos; | ||
959 | int es_info_length; | ||
960 | int crc32_csum; | ||
961 | |||
962 | memset(c, 0, sizeof(*c)); | ||
963 | |||
964 | c->ctype = AVC_CTYPE_CONTROL; | ||
965 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
966 | c->opcode = AVC_OPCODE_VENDOR; | ||
967 | |||
968 | if (msg[0] != EN50221_LIST_MANAGEMENT_ONLY) { | ||
969 | dev_info(fdtv->device, "forcing list_management to ONLY\n"); | ||
970 | msg[0] = EN50221_LIST_MANAGEMENT_ONLY; | ||
971 | } | ||
972 | /* We take the cmd_id from the programme level only! */ | ||
973 | list_management = msg[0]; | ||
974 | program_info_length = ((msg[4] & 0x0f) << 8) + msg[5]; | ||
975 | if (program_info_length > 0) | ||
976 | program_info_length--; /* Remove pmt_cmd_id */ | ||
977 | pmt_cmd_id = msg[6]; | ||
978 | |||
979 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
980 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
981 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
982 | c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; | ||
983 | c->operand[4] = 0; /* slot */ | ||
984 | c->operand[5] = SFE_VENDOR_TAG_CA_PMT; /* ca tag */ | ||
985 | c->operand[6] = 0; /* more/last */ | ||
986 | /* c->operand[7] = XXXprogram_info_length + 17; */ /* length */ | ||
987 | c->operand[8] = list_management; | ||
988 | c->operand[9] = 0x01; /* pmt_cmd=OK_descramble */ | ||
989 | |||
990 | /* TS program map table */ | ||
991 | |||
992 | c->operand[10] = 0x02; /* Table id=2 */ | ||
993 | c->operand[11] = 0x80; /* Section syntax + length */ | ||
994 | /* c->operand[12] = XXXprogram_info_length + 12; */ | ||
995 | c->operand[13] = msg[1]; /* Program number */ | ||
996 | c->operand[14] = msg[2]; | ||
997 | c->operand[15] = 0x01; /* Version number=0 + current/next=1 */ | ||
998 | c->operand[16] = 0x00; /* Section number=0 */ | ||
999 | c->operand[17] = 0x00; /* Last section number=0 */ | ||
1000 | c->operand[18] = 0x1f; /* PCR_PID=1FFF */ | ||
1001 | c->operand[19] = 0xff; | ||
1002 | c->operand[20] = (program_info_length >> 8); /* Program info length */ | ||
1003 | c->operand[21] = (program_info_length & 0xff); | ||
1004 | |||
1005 | /* CA descriptors at programme level */ | ||
1006 | read_pos = 6; | ||
1007 | write_pos = 22; | ||
1008 | if (program_info_length > 0) { | ||
1009 | pmt_cmd_id = msg[read_pos++]; | ||
1010 | if (pmt_cmd_id != 1 && pmt_cmd_id != 4) | ||
1011 | dev_err(fdtv->device, | ||
1012 | "invalid pmt_cmd_id %d\n", pmt_cmd_id); | ||
1013 | |||
1014 | memcpy(&c->operand[write_pos], &msg[read_pos], | ||
1015 | program_info_length); | ||
1016 | read_pos += program_info_length; | ||
1017 | write_pos += program_info_length; | ||
1018 | } | ||
1019 | while (read_pos < length) { | ||
1020 | c->operand[write_pos++] = msg[read_pos++]; | ||
1021 | c->operand[write_pos++] = msg[read_pos++]; | ||
1022 | c->operand[write_pos++] = msg[read_pos++]; | ||
1023 | es_info_length = | ||
1024 | ((msg[read_pos] & 0x0f) << 8) + msg[read_pos + 1]; | ||
1025 | read_pos += 2; | ||
1026 | if (es_info_length > 0) | ||
1027 | es_info_length--; /* Remove pmt_cmd_id */ | ||
1028 | c->operand[write_pos++] = es_info_length >> 8; | ||
1029 | c->operand[write_pos++] = es_info_length & 0xff; | ||
1030 | if (es_info_length > 0) { | ||
1031 | pmt_cmd_id = msg[read_pos++]; | ||
1032 | if (pmt_cmd_id != 1 && pmt_cmd_id != 4) | ||
1033 | dev_err(fdtv->device, "invalid pmt_cmd_id %d " | ||
1034 | "at stream level\n", pmt_cmd_id); | ||
1035 | |||
1036 | memcpy(&c->operand[write_pos], &msg[read_pos], | ||
1037 | es_info_length); | ||
1038 | read_pos += es_info_length; | ||
1039 | write_pos += es_info_length; | ||
1040 | } | ||
1041 | } | ||
1042 | |||
1043 | /* CRC */ | ||
1044 | c->operand[write_pos++] = 0x00; | ||
1045 | c->operand[write_pos++] = 0x00; | ||
1046 | c->operand[write_pos++] = 0x00; | ||
1047 | c->operand[write_pos++] = 0x00; | ||
1048 | |||
1049 | c->operand[7] = write_pos - 8; | ||
1050 | c->operand[12] = write_pos - 13; | ||
1051 | |||
1052 | crc32_csum = crc32_be(0, &c->operand[10], c->operand[12] - 1); | ||
1053 | c->operand[write_pos - 4] = (crc32_csum >> 24) & 0xff; | ||
1054 | c->operand[write_pos - 3] = (crc32_csum >> 16) & 0xff; | ||
1055 | c->operand[write_pos - 2] = (crc32_csum >> 8) & 0xff; | ||
1056 | c->operand[write_pos - 1] = (crc32_csum >> 0) & 0xff; | ||
1057 | |||
1058 | c->length = ALIGN(3 + write_pos, 4); | ||
1059 | |||
1060 | if (avc_write(fdtv, c, r) < 0) | ||
1061 | return -EIO; | ||
1062 | |||
1063 | if (r->response != AVC_RESPONSE_ACCEPTED) { | ||
1064 | dev_err(fdtv->device, | ||
1065 | "CA PMT failed with response 0x%x\n", r->response); | ||
1066 | return -EFAULT; | ||
1067 | } | ||
1068 | |||
1069 | return 0; | ||
1070 | } | ||
1071 | |||
1072 | int avc_ca_get_time_date(struct firedtv *fdtv, int *interval) | ||
1073 | { | ||
1074 | char buffer[sizeof(struct avc_command_frame)]; | ||
1075 | struct avc_command_frame *c = (void *)buffer; | ||
1076 | struct avc_response_frame *r = (void *)buffer; | ||
1077 | |||
1078 | memset(c, 0, sizeof(*c)); | ||
1079 | |||
1080 | c->ctype = AVC_CTYPE_STATUS; | ||
1081 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
1082 | c->opcode = AVC_OPCODE_VENDOR; | ||
1083 | |||
1084 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
1085 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
1086 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
1087 | c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; | ||
1088 | c->operand[4] = 0; /* slot */ | ||
1089 | c->operand[5] = SFE_VENDOR_TAG_CA_DATE_TIME; /* ca tag */ | ||
1090 | c->operand[6] = 0; /* more/last */ | ||
1091 | c->operand[7] = 0; /* length */ | ||
1092 | |||
1093 | c->length = 12; | ||
1094 | |||
1095 | if (avc_write(fdtv, c, r) < 0) | ||
1096 | return -EIO; | ||
1097 | |||
1098 | /* FIXME: check response code and validate response data */ | ||
1099 | |||
1100 | *interval = r->operand[get_ca_object_pos(r)]; | ||
1101 | |||
1102 | return 0; | ||
1103 | } | ||
1104 | |||
1105 | int avc_ca_enter_menu(struct firedtv *fdtv) | ||
1106 | { | ||
1107 | char buffer[sizeof(struct avc_command_frame)]; | ||
1108 | struct avc_command_frame *c = (void *)buffer; | ||
1109 | struct avc_response_frame *r = (void *)buffer; /* FIXME: unused */ | ||
1110 | |||
1111 | memset(c, 0, sizeof(*c)); | ||
1112 | |||
1113 | c->ctype = AVC_CTYPE_STATUS; | ||
1114 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
1115 | c->opcode = AVC_OPCODE_VENDOR; | ||
1116 | |||
1117 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
1118 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
1119 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
1120 | c->operand[3] = SFE_VENDOR_OPCODE_HOST2CA; | ||
1121 | c->operand[4] = 0; /* slot */ | ||
1122 | c->operand[5] = SFE_VENDOR_TAG_CA_ENTER_MENU; | ||
1123 | c->operand[6] = 0; /* more/last */ | ||
1124 | c->operand[7] = 0; /* length */ | ||
1125 | |||
1126 | c->length = 12; | ||
1127 | |||
1128 | if (avc_write(fdtv, c, r) < 0) | ||
1129 | return -EIO; | ||
1130 | |||
1131 | return 0; | ||
1132 | } | ||
1133 | |||
1134 | int avc_ca_get_mmi(struct firedtv *fdtv, char *mmi_object, unsigned int *len) | ||
1135 | { | ||
1136 | char buffer[sizeof(struct avc_command_frame)]; | ||
1137 | struct avc_command_frame *c = (void *)buffer; | ||
1138 | struct avc_response_frame *r = (void *)buffer; | ||
1139 | |||
1140 | memset(c, 0, sizeof(*c)); | ||
1141 | |||
1142 | c->ctype = AVC_CTYPE_STATUS; | ||
1143 | c->subunit = AVC_SUBUNIT_TYPE_TUNER | fdtv->subunit; | ||
1144 | c->opcode = AVC_OPCODE_VENDOR; | ||
1145 | |||
1146 | c->operand[0] = SFE_VENDOR_DE_COMPANYID_0; | ||
1147 | c->operand[1] = SFE_VENDOR_DE_COMPANYID_1; | ||
1148 | c->operand[2] = SFE_VENDOR_DE_COMPANYID_2; | ||
1149 | c->operand[3] = SFE_VENDOR_OPCODE_CA2HOST; | ||
1150 | c->operand[4] = 0; /* slot */ | ||
1151 | c->operand[5] = SFE_VENDOR_TAG_CA_MMI; | ||
1152 | c->operand[6] = 0; /* more/last */ | ||
1153 | c->operand[7] = 0; /* length */ | ||
1154 | |||
1155 | c->length = 12; | ||
1156 | |||
1157 | if (avc_write(fdtv, c, r) < 0) | ||
1158 | return -EIO; | ||
1159 | |||
1160 | /* FIXME: check response code and validate response data */ | ||
1161 | |||
1162 | *len = get_ca_object_length(r); | ||
1163 | memcpy(mmi_object, &r->operand[get_ca_object_pos(r)], *len); | ||
1164 | |||
1165 | return 0; | ||
1166 | } | ||
1167 | |||
1168 | #define CMP_OUTPUT_PLUG_CONTROL_REG_0 0xfffff0000904ULL | ||
1169 | |||
1170 | static int cmp_read(struct firedtv *fdtv, void *buf, u64 addr, size_t len) | ||
1171 | { | ||
1172 | int ret; | ||
1173 | |||
1174 | if (mutex_lock_interruptible(&fdtv->avc_mutex)) | ||
1175 | return -EINTR; | ||
1176 | |||
1177 | ret = fdtv->backend->read(fdtv, addr, buf, len); | ||
1178 | if (ret < 0) | ||
1179 | dev_err(fdtv->device, "CMP: read I/O error\n"); | ||
1180 | |||
1181 | mutex_unlock(&fdtv->avc_mutex); | ||
1182 | return ret; | ||
1183 | } | ||
1184 | |||
1185 | static int cmp_lock(struct firedtv *fdtv, void *data, u64 addr, __be32 arg) | ||
1186 | { | ||
1187 | int ret; | ||
1188 | |||
1189 | if (mutex_lock_interruptible(&fdtv->avc_mutex)) | ||
1190 | return -EINTR; | ||
1191 | |||
1192 | ret = fdtv->backend->lock(fdtv, addr, data, arg); | ||
1193 | if (ret < 0) | ||
1194 | dev_err(fdtv->device, "CMP: lock I/O error\n"); | ||
1195 | |||
1196 | mutex_unlock(&fdtv->avc_mutex); | ||
1197 | return ret; | ||
1198 | } | ||
1199 | |||
1200 | static inline u32 get_opcr(__be32 opcr, u32 mask, u32 shift) | ||
1201 | { | ||
1202 | return (be32_to_cpu(opcr) >> shift) & mask; | ||
1203 | } | ||
1204 | |||
1205 | static inline void set_opcr(__be32 *opcr, u32 value, u32 mask, u32 shift) | ||
1206 | { | ||
1207 | *opcr &= ~cpu_to_be32(mask << shift); | ||
1208 | *opcr |= cpu_to_be32((value & mask) << shift); | ||
1209 | } | ||
1210 | |||
1211 | #define get_opcr_online(v) get_opcr((v), 0x1, 31) | ||
1212 | #define get_opcr_p2p_connections(v) get_opcr((v), 0x3f, 24) | ||
1213 | #define get_opcr_channel(v) get_opcr((v), 0x3f, 16) | ||
1214 | |||
1215 | #define set_opcr_p2p_connections(p, v) set_opcr((p), (v), 0x3f, 24) | ||
1216 | #define set_opcr_channel(p, v) set_opcr((p), (v), 0x3f, 16) | ||
1217 | #define set_opcr_data_rate(p, v) set_opcr((p), (v), 0x3, 14) | ||
1218 | #define set_opcr_overhead_id(p, v) set_opcr((p), (v), 0xf, 10) | ||
1219 | |||
1220 | int cmp_establish_pp_connection(struct firedtv *fdtv, int plug, int channel) | ||
1221 | { | ||
1222 | __be32 old_opcr, opcr; | ||
1223 | u64 opcr_address = CMP_OUTPUT_PLUG_CONTROL_REG_0 + (plug << 2); | ||
1224 | int attempts = 0; | ||
1225 | int ret; | ||
1226 | |||
1227 | ret = cmp_read(fdtv, &opcr, opcr_address, 4); | ||
1228 | if (ret < 0) | ||
1229 | return ret; | ||
1230 | |||
1231 | repeat: | ||
1232 | if (!get_opcr_online(opcr)) { | ||
1233 | dev_err(fdtv->device, "CMP: output offline\n"); | ||
1234 | return -EBUSY; | ||
1235 | } | ||
1236 | |||
1237 | old_opcr = opcr; | ||
1238 | |||
1239 | if (get_opcr_p2p_connections(opcr)) { | ||
1240 | if (get_opcr_channel(opcr) != channel) { | ||
1241 | dev_err(fdtv->device, "CMP: cannot change channel\n"); | ||
1242 | return -EBUSY; | ||
1243 | } | ||
1244 | dev_info(fdtv->device, "CMP: overlaying connection\n"); | ||
1245 | |||
1246 | /* We don't allocate isochronous resources. */ | ||
1247 | } else { | ||
1248 | set_opcr_channel(&opcr, channel); | ||
1249 | set_opcr_data_rate(&opcr, 2); /* S400 */ | ||
1250 | |||
1251 | /* FIXME: this is for the worst case - optimize */ | ||
1252 | set_opcr_overhead_id(&opcr, 0); | ||
1253 | |||
1254 | /* | ||
1255 | * FIXME: allocate isochronous channel and bandwidth at IRM | ||
1256 | * fdtv->backend->alloc_resources(fdtv, channels_mask, bw); | ||
1257 | */ | ||
1258 | } | ||
1259 | |||
1260 | set_opcr_p2p_connections(&opcr, get_opcr_p2p_connections(opcr) + 1); | ||
1261 | |||
1262 | ret = cmp_lock(fdtv, &opcr, opcr_address, old_opcr); | ||
1263 | if (ret < 0) | ||
1264 | return ret; | ||
1265 | |||
1266 | if (old_opcr != opcr) { | ||
1267 | /* | ||
1268 | * FIXME: if old_opcr.P2P_Connections > 0, | ||
1269 | * deallocate isochronous channel and bandwidth at IRM | ||
1270 | * if (...) | ||
1271 | * fdtv->backend->dealloc_resources(fdtv, channel, bw); | ||
1272 | */ | ||
1273 | |||
1274 | if (++attempts < 6) /* arbitrary limit */ | ||
1275 | goto repeat; | ||
1276 | return -EBUSY; | ||
1277 | } | ||
1278 | |||
1279 | return 0; | ||
1280 | } | ||
1281 | |||
1282 | void cmp_break_pp_connection(struct firedtv *fdtv, int plug, int channel) | ||
1283 | { | ||
1284 | __be32 old_opcr, opcr; | ||
1285 | u64 opcr_address = CMP_OUTPUT_PLUG_CONTROL_REG_0 + (plug << 2); | ||
1286 | int attempts = 0; | ||
1287 | |||
1288 | if (cmp_read(fdtv, &opcr, opcr_address, 4) < 0) | ||
1289 | return; | ||
1290 | |||
1291 | repeat: | ||
1292 | if (!get_opcr_online(opcr) || !get_opcr_p2p_connections(opcr) || | ||
1293 | get_opcr_channel(opcr) != channel) { | ||
1294 | dev_err(fdtv->device, "CMP: no connection to break\n"); | ||
1295 | return; | ||
1296 | } | ||
1297 | |||
1298 | old_opcr = opcr; | ||
1299 | set_opcr_p2p_connections(&opcr, get_opcr_p2p_connections(opcr) - 1); | ||
1300 | |||
1301 | if (cmp_lock(fdtv, &opcr, opcr_address, old_opcr) < 0) | ||
1302 | return; | ||
1303 | |||
1304 | if (old_opcr != opcr) { | ||
1305 | /* | ||
1306 | * FIXME: if old_opcr.P2P_Connections == 1, i.e. we were last | ||
1307 | * owner, deallocate isochronous channel and bandwidth at IRM | ||
1308 | * if (...) | ||
1309 | * fdtv->backend->dealloc_resources(fdtv, channel, bw); | ||
1310 | */ | ||
1311 | |||
1312 | if (++attempts < 6) /* arbitrary limit */ | ||
1313 | goto repeat; | ||
1314 | } | ||
1315 | } | ||
diff --git a/drivers/media/dvb/firewire/firedtv-ci.c b/drivers/media/dvb/firewire/firedtv-ci.c index 6d87926b8bfe..eeb80d0ea3ff 100644 --- a/drivers/media/dvb/firewire/firedtv-ci.c +++ b/drivers/media/dvb/firewire/firedtv-ci.c | |||
@@ -10,33 +10,37 @@ | |||
10 | * the License, or (at your option) any later version. | 10 | * the License, or (at your option) any later version. |
11 | */ | 11 | */ |
12 | 12 | ||
13 | #include <linux/device.h> | ||
13 | #include <linux/dvb/ca.h> | 14 | #include <linux/dvb/ca.h> |
14 | #include <linux/fs.h> | 15 | #include <linux/fs.h> |
15 | #include <linux/module.h> | 16 | #include <linux/module.h> |
16 | 17 | ||
17 | #include <dvbdev.h> | 18 | #include <dvbdev.h> |
18 | 19 | ||
19 | #include "avc.h" | ||
20 | #include "firedtv.h" | 20 | #include "firedtv.h" |
21 | #include "firedtv-ci.h" | ||
22 | 21 | ||
23 | static int fdtv_ca_ready(ANTENNA_INPUT_INFO *info) | 22 | #define EN50221_TAG_APP_INFO_ENQUIRY 0x9f8020 |
23 | #define EN50221_TAG_CA_INFO_ENQUIRY 0x9f8030 | ||
24 | #define EN50221_TAG_CA_PMT 0x9f8032 | ||
25 | #define EN50221_TAG_ENTER_MENU 0x9f8022 | ||
26 | |||
27 | static int fdtv_ca_ready(struct firedtv_tuner_status *stat) | ||
24 | { | 28 | { |
25 | return info->CaInitializationStatus == 1 && | 29 | return stat->ca_initialization_status == 1 && |
26 | info->CaErrorFlag == 0 && | 30 | stat->ca_error_flag == 0 && |
27 | info->CaDvbFlag == 1 && | 31 | stat->ca_dvb_flag == 1 && |
28 | info->CaModulePresentStatus == 1; | 32 | stat->ca_module_present_status == 1; |
29 | } | 33 | } |
30 | 34 | ||
31 | static int fdtv_get_ca_flags(ANTENNA_INPUT_INFO *info) | 35 | static int fdtv_get_ca_flags(struct firedtv_tuner_status *stat) |
32 | { | 36 | { |
33 | int flags = 0; | 37 | int flags = 0; |
34 | 38 | ||
35 | if (info->CaModulePresentStatus == 1) | 39 | if (stat->ca_module_present_status == 1) |
36 | flags |= CA_CI_MODULE_PRESENT; | 40 | flags |= CA_CI_MODULE_PRESENT; |
37 | if (info->CaInitializationStatus == 1 && | 41 | if (stat->ca_initialization_status == 1 && |
38 | info->CaErrorFlag == 0 && | 42 | stat->ca_error_flag == 0 && |
39 | info->CaDvbFlag == 1) | 43 | stat->ca_dvb_flag == 1) |
40 | flags |= CA_CI_MODULE_READY; | 44 | flags |= CA_CI_MODULE_READY; |
41 | return flags; | 45 | return flags; |
42 | } | 46 | } |
@@ -59,17 +63,17 @@ static int fdtv_ca_get_caps(void *arg) | |||
59 | 63 | ||
60 | static int fdtv_ca_get_slot_info(struct firedtv *fdtv, void *arg) | 64 | static int fdtv_ca_get_slot_info(struct firedtv *fdtv, void *arg) |
61 | { | 65 | { |
62 | ANTENNA_INPUT_INFO info; | 66 | struct firedtv_tuner_status stat; |
63 | struct ca_slot_info *slot = arg; | 67 | struct ca_slot_info *slot = arg; |
64 | 68 | ||
65 | if (avc_tuner_status(fdtv, &info)) | 69 | if (avc_tuner_status(fdtv, &stat)) |
66 | return -EFAULT; | 70 | return -EFAULT; |
67 | 71 | ||
68 | if (slot->num != 0) | 72 | if (slot->num != 0) |
69 | return -EFAULT; | 73 | return -EFAULT; |
70 | 74 | ||
71 | slot->type = CA_CI; | 75 | slot->type = CA_CI; |
72 | slot->flags = fdtv_get_ca_flags(&info); | 76 | slot->flags = fdtv_get_ca_flags(&stat); |
73 | return 0; | 77 | return 0; |
74 | } | 78 | } |
75 | 79 | ||
@@ -77,8 +81,7 @@ static int fdtv_ca_app_info(struct firedtv *fdtv, void *arg) | |||
77 | { | 81 | { |
78 | struct ca_msg *reply = arg; | 82 | struct ca_msg *reply = arg; |
79 | 83 | ||
80 | return | 84 | return avc_ca_app_info(fdtv, reply->msg, &reply->length) ? -EFAULT : 0; |
81 | avc_ca_app_info(fdtv, reply->msg, &reply->length) ? -EFAULT : 0; | ||
82 | } | 85 | } |
83 | 86 | ||
84 | static int fdtv_ca_info(struct firedtv *fdtv, void *arg) | 87 | static int fdtv_ca_info(struct firedtv *fdtv, void *arg) |
@@ -92,30 +95,29 @@ static int fdtv_ca_get_mmi(struct firedtv *fdtv, void *arg) | |||
92 | { | 95 | { |
93 | struct ca_msg *reply = arg; | 96 | struct ca_msg *reply = arg; |
94 | 97 | ||
95 | return | 98 | return avc_ca_get_mmi(fdtv, reply->msg, &reply->length) ? -EFAULT : 0; |
96 | avc_ca_get_mmi(fdtv, reply->msg, &reply->length) ? -EFAULT : 0; | ||
97 | } | 99 | } |
98 | 100 | ||
99 | static int fdtv_ca_get_msg(struct firedtv *fdtv, void *arg) | 101 | static int fdtv_ca_get_msg(struct firedtv *fdtv, void *arg) |
100 | { | 102 | { |
101 | ANTENNA_INPUT_INFO info; | 103 | struct firedtv_tuner_status stat; |
102 | int err; | 104 | int err; |
103 | 105 | ||
104 | switch (fdtv->ca_last_command) { | 106 | switch (fdtv->ca_last_command) { |
105 | case TAG_APP_INFO_ENQUIRY: | 107 | case EN50221_TAG_APP_INFO_ENQUIRY: |
106 | err = fdtv_ca_app_info(fdtv, arg); | 108 | err = fdtv_ca_app_info(fdtv, arg); |
107 | break; | 109 | break; |
108 | case TAG_CA_INFO_ENQUIRY: | 110 | case EN50221_TAG_CA_INFO_ENQUIRY: |
109 | err = fdtv_ca_info(fdtv, arg); | 111 | err = fdtv_ca_info(fdtv, arg); |
110 | break; | 112 | break; |
111 | default: | 113 | default: |
112 | if (avc_tuner_status(fdtv, &info)) | 114 | if (avc_tuner_status(fdtv, &stat)) |
113 | err = -EFAULT; | 115 | err = -EFAULT; |
114 | else if (info.CaMmi == 1) | 116 | else if (stat.ca_mmi == 1) |
115 | err = fdtv_ca_get_mmi(fdtv, arg); | 117 | err = fdtv_ca_get_mmi(fdtv, arg); |
116 | else { | 118 | else { |
117 | printk(KERN_INFO "%s: Unhandled message 0x%08X\n", | 119 | dev_info(fdtv->device, "unhandled CA message 0x%08x\n", |
118 | __func__, fdtv->ca_last_command); | 120 | fdtv->ca_last_command); |
119 | err = -EFAULT; | 121 | err = -EFAULT; |
120 | } | 122 | } |
121 | } | 123 | } |
@@ -133,14 +135,13 @@ static int fdtv_ca_pmt(struct firedtv *fdtv, void *arg) | |||
133 | data_pos = 4; | 135 | data_pos = 4; |
134 | if (msg->msg[3] & 0x80) { | 136 | if (msg->msg[3] & 0x80) { |
135 | data_length = 0; | 137 | data_length = 0; |
136 | for (i = 0; i < (msg->msg[3] & 0x7F); i++) | 138 | for (i = 0; i < (msg->msg[3] & 0x7f); i++) |
137 | data_length = (data_length << 8) + msg->msg[data_pos++]; | 139 | data_length = (data_length << 8) + msg->msg[data_pos++]; |
138 | } else { | 140 | } else { |
139 | data_length = msg->msg[3]; | 141 | data_length = msg->msg[3]; |
140 | } | 142 | } |
141 | 143 | ||
142 | return avc_ca_pmt(fdtv, &msg->msg[data_pos], data_length) ? | 144 | return avc_ca_pmt(fdtv, &msg->msg[data_pos], data_length) ? -EFAULT : 0; |
143 | -EFAULT : 0; | ||
144 | } | 145 | } |
145 | 146 | ||
146 | static int fdtv_ca_send_msg(struct firedtv *fdtv, void *arg) | 147 | static int fdtv_ca_send_msg(struct firedtv *fdtv, void *arg) |
@@ -152,23 +153,23 @@ static int fdtv_ca_send_msg(struct firedtv *fdtv, void *arg) | |||
152 | fdtv->ca_last_command = | 153 | fdtv->ca_last_command = |
153 | (msg->msg[0] << 16) + (msg->msg[1] << 8) + msg->msg[2]; | 154 | (msg->msg[0] << 16) + (msg->msg[1] << 8) + msg->msg[2]; |
154 | switch (fdtv->ca_last_command) { | 155 | switch (fdtv->ca_last_command) { |
155 | case TAG_CA_PMT: | 156 | case EN50221_TAG_CA_PMT: |
156 | err = fdtv_ca_pmt(fdtv, arg); | 157 | err = fdtv_ca_pmt(fdtv, arg); |
157 | break; | 158 | break; |
158 | case TAG_APP_INFO_ENQUIRY: | 159 | case EN50221_TAG_APP_INFO_ENQUIRY: |
159 | /* handled in ca_get_msg */ | 160 | /* handled in ca_get_msg */ |
160 | err = 0; | 161 | err = 0; |
161 | break; | 162 | break; |
162 | case TAG_CA_INFO_ENQUIRY: | 163 | case EN50221_TAG_CA_INFO_ENQUIRY: |
163 | /* handled in ca_get_msg */ | 164 | /* handled in ca_get_msg */ |
164 | err = 0; | 165 | err = 0; |
165 | break; | 166 | break; |
166 | case TAG_ENTER_MENU: | 167 | case EN50221_TAG_ENTER_MENU: |
167 | err = avc_ca_enter_menu(fdtv); | 168 | err = avc_ca_enter_menu(fdtv); |
168 | break; | 169 | break; |
169 | default: | 170 | default: |
170 | printk(KERN_ERR "%s: Unhandled unknown message 0x%08X\n", | 171 | dev_err(fdtv->device, "unhandled CA message 0x%08x\n", |
171 | __func__, fdtv->ca_last_command); | 172 | fdtv->ca_last_command); |
172 | err = -EFAULT; | 173 | err = -EFAULT; |
173 | } | 174 | } |
174 | return err; | 175 | return err; |
@@ -179,10 +180,10 @@ static int fdtv_ca_ioctl(struct inode *inode, struct file *file, | |||
179 | { | 180 | { |
180 | struct dvb_device *dvbdev = file->private_data; | 181 | struct dvb_device *dvbdev = file->private_data; |
181 | struct firedtv *fdtv = dvbdev->priv; | 182 | struct firedtv *fdtv = dvbdev->priv; |
182 | ANTENNA_INPUT_INFO info; | 183 | struct firedtv_tuner_status stat; |
183 | int err; | 184 | int err; |
184 | 185 | ||
185 | switch(cmd) { | 186 | switch (cmd) { |
186 | case CA_RESET: | 187 | case CA_RESET: |
187 | err = fdtv_ca_reset(fdtv); | 188 | err = fdtv_ca_reset(fdtv); |
188 | break; | 189 | break; |
@@ -199,13 +200,12 @@ static int fdtv_ca_ioctl(struct inode *inode, struct file *file, | |||
199 | err = fdtv_ca_send_msg(fdtv, arg); | 200 | err = fdtv_ca_send_msg(fdtv, arg); |
200 | break; | 201 | break; |
201 | default: | 202 | default: |
202 | printk(KERN_INFO "%s: Unhandled ioctl, command: %u\n",__func__, | 203 | dev_info(fdtv->device, "unhandled CA ioctl %u\n", cmd); |
203 | cmd); | ||
204 | err = -EOPNOTSUPP; | 204 | err = -EOPNOTSUPP; |
205 | } | 205 | } |
206 | 206 | ||
207 | /* FIXME Is this necessary? */ | 207 | /* FIXME Is this necessary? */ |
208 | avc_tuner_status(fdtv, &info); | 208 | avc_tuner_status(fdtv, &stat); |
209 | 209 | ||
210 | return err; | 210 | return err; |
211 | } | 211 | } |
@@ -233,22 +233,21 @@ static struct dvb_device fdtv_ca = { | |||
233 | 233 | ||
234 | int fdtv_ca_register(struct firedtv *fdtv) | 234 | int fdtv_ca_register(struct firedtv *fdtv) |
235 | { | 235 | { |
236 | ANTENNA_INPUT_INFO info; | 236 | struct firedtv_tuner_status stat; |
237 | int err; | 237 | int err; |
238 | 238 | ||
239 | if (avc_tuner_status(fdtv, &info)) | 239 | if (avc_tuner_status(fdtv, &stat)) |
240 | return -EINVAL; | 240 | return -EINVAL; |
241 | 241 | ||
242 | if (!fdtv_ca_ready(&info)) | 242 | if (!fdtv_ca_ready(&stat)) |
243 | return -EFAULT; | 243 | return -EFAULT; |
244 | 244 | ||
245 | err = dvb_register_device(&fdtv->adapter, &fdtv->cadev, | 245 | err = dvb_register_device(&fdtv->adapter, &fdtv->cadev, |
246 | &fdtv_ca, fdtv, DVB_DEVICE_CA); | 246 | &fdtv_ca, fdtv, DVB_DEVICE_CA); |
247 | 247 | ||
248 | if (info.CaApplicationInfo == 0) | 248 | if (stat.ca_application_info == 0) |
249 | printk(KERN_ERR "%s: CaApplicationInfo is not set.\n", | 249 | dev_err(fdtv->device, "CaApplicationInfo is not set\n"); |
250 | __func__); | 250 | if (stat.ca_date_time_request == 1) |
251 | if (info.CaDateTimeRequest == 1) | ||
252 | avc_ca_get_time_date(fdtv, &fdtv->ca_time_interval); | 251 | avc_ca_get_time_date(fdtv, &fdtv->ca_time_interval); |
253 | 252 | ||
254 | return err; | 253 | return err; |
diff --git a/drivers/media/dvb/firewire/firedtv-ci.h b/drivers/media/dvb/firewire/firedtv-ci.h deleted file mode 100644 index d6840f5dcbae..000000000000 --- a/drivers/media/dvb/firewire/firedtv-ci.h +++ /dev/null | |||
@@ -1,9 +0,0 @@ | |||
1 | #ifndef _FIREDTV_CI_H | ||
2 | #define _FIREDTV_CI_H | ||
3 | |||
4 | struct firedtv; | ||
5 | |||
6 | int fdtv_ca_register(struct firedtv *fdtv); | ||
7 | void fdtv_ca_release(struct firedtv *fdtv); | ||
8 | |||
9 | #endif /* _FIREDTV_CI_H */ | ||
diff --git a/drivers/media/dvb/firewire/firedtv-dvb.c b/drivers/media/dvb/firewire/firedtv-dvb.c index 1823058696f2..9d308dd32a5c 100644 --- a/drivers/media/dvb/firewire/firedtv-dvb.c +++ b/drivers/media/dvb/firewire/firedtv-dvb.c | |||
@@ -10,75 +10,55 @@ | |||
10 | * the License, or (at your option) any later version. | 10 | * the License, or (at your option) any later version. |
11 | */ | 11 | */ |
12 | 12 | ||
13 | #include <linux/bitops.h> | ||
14 | #include <linux/device.h> | ||
13 | #include <linux/errno.h> | 15 | #include <linux/errno.h> |
14 | #include <linux/kernel.h> | 16 | #include <linux/kernel.h> |
17 | #include <linux/mod_devicetable.h> | ||
18 | #include <linux/module.h> | ||
15 | #include <linux/mutex.h> | 19 | #include <linux/mutex.h> |
20 | #include <linux/slab.h> | ||
21 | #include <linux/string.h> | ||
16 | #include <linux/types.h> | 22 | #include <linux/types.h> |
23 | #include <linux/wait.h> | ||
24 | #include <linux/workqueue.h> | ||
17 | 25 | ||
26 | #include <dmxdev.h> | ||
18 | #include <dvb_demux.h> | 27 | #include <dvb_demux.h> |
19 | #include <dvb_frontend.h> | ||
20 | #include <dvbdev.h> | 28 | #include <dvbdev.h> |
29 | #include <dvb_frontend.h> | ||
21 | 30 | ||
22 | #include "avc.h" | ||
23 | #include "firedtv.h" | 31 | #include "firedtv.h" |
24 | #include "firedtv-ci.h" | ||
25 | |||
26 | DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); | ||
27 | 32 | ||
28 | static struct firedtv_channel *fdtv_channel_allocate(struct firedtv *fdtv) | 33 | static int alloc_channel(struct firedtv *fdtv) |
29 | { | 34 | { |
30 | struct firedtv_channel *c = NULL; | 35 | int i; |
31 | int k; | ||
32 | 36 | ||
33 | if (mutex_lock_interruptible(&fdtv->demux_mutex)) | 37 | for (i = 0; i < 16; i++) |
34 | return NULL; | 38 | if (!__test_and_set_bit(i, &fdtv->channel_active)) |
35 | |||
36 | for (k = 0; k < 16; k++) | ||
37 | if (!fdtv->channel[k].active) { | ||
38 | fdtv->channel[k].active = true; | ||
39 | c = &fdtv->channel[k]; | ||
40 | break; | 39 | break; |
41 | } | 40 | return i; |
42 | |||
43 | mutex_unlock(&fdtv->demux_mutex); | ||
44 | return c; | ||
45 | } | 41 | } |
46 | 42 | ||
47 | static int fdtv_channel_collect(struct firedtv *fdtv, int *pidc, u16 pid[]) | 43 | static void collect_channels(struct firedtv *fdtv, int *pidc, u16 pid[]) |
48 | { | 44 | { |
49 | int k, l = 0; | 45 | int i, n; |
50 | |||
51 | if (mutex_lock_interruptible(&fdtv->demux_mutex)) | ||
52 | return -EINTR; | ||
53 | |||
54 | for (k = 0; k < 16; k++) | ||
55 | if (fdtv->channel[k].active) | ||
56 | pid[l++] = fdtv->channel[k].pid; | ||
57 | |||
58 | mutex_unlock(&fdtv->demux_mutex); | ||
59 | 46 | ||
60 | *pidc = l; | 47 | for (i = 0, n = 0; i < 16; i++) |
61 | 48 | if (test_bit(i, &fdtv->channel_active)) | |
62 | return 0; | 49 | pid[n++] = fdtv->channel_pid[i]; |
50 | *pidc = n; | ||
63 | } | 51 | } |
64 | 52 | ||
65 | static int fdtv_channel_release(struct firedtv *fdtv, | 53 | static inline void dealloc_channel(struct firedtv *fdtv, int i) |
66 | struct firedtv_channel *channel) | ||
67 | { | 54 | { |
68 | if (mutex_lock_interruptible(&fdtv->demux_mutex)) | 55 | __clear_bit(i, &fdtv->channel_active); |
69 | return -EINTR; | ||
70 | |||
71 | channel->active = false; | ||
72 | |||
73 | mutex_unlock(&fdtv->demux_mutex); | ||
74 | return 0; | ||
75 | } | 56 | } |
76 | 57 | ||
77 | int fdtv_start_feed(struct dvb_demux_feed *dvbdmxfeed) | 58 | int fdtv_start_feed(struct dvb_demux_feed *dvbdmxfeed) |
78 | { | 59 | { |
79 | struct firedtv *fdtv = (struct firedtv*)dvbdmxfeed->demux->priv; | 60 | struct firedtv *fdtv = dvbdmxfeed->demux->priv; |
80 | struct firedtv_channel *channel; | 61 | int pidc, c, ret; |
81 | int pidc,k; | ||
82 | u16 pids[16]; | 62 | u16 pids[16]; |
83 | 63 | ||
84 | switch (dvbdmxfeed->type) { | 64 | switch (dvbdmxfeed->type) { |
@@ -86,11 +66,14 @@ int fdtv_start_feed(struct dvb_demux_feed *dvbdmxfeed) | |||
86 | case DMX_TYPE_SEC: | 66 | case DMX_TYPE_SEC: |
87 | break; | 67 | break; |
88 | default: | 68 | default: |
89 | printk(KERN_ERR "%s: invalid type %u\n", | 69 | dev_err(fdtv->device, "can't start dmx feed: invalid type %u\n", |
90 | __func__, dvbdmxfeed->type); | 70 | dvbdmxfeed->type); |
91 | return -EINVAL; | 71 | return -EINVAL; |
92 | } | 72 | } |
93 | 73 | ||
74 | if (mutex_lock_interruptible(&fdtv->demux_mutex)) | ||
75 | return -EINTR; | ||
76 | |||
94 | if (dvbdmxfeed->type == DMX_TYPE_TS) { | 77 | if (dvbdmxfeed->type == DMX_TYPE_TS) { |
95 | switch (dvbdmxfeed->pes_type) { | 78 | switch (dvbdmxfeed->pes_type) { |
96 | case DMX_TS_PES_VIDEO: | 79 | case DMX_TS_PES_VIDEO: |
@@ -98,75 +81,64 @@ int fdtv_start_feed(struct dvb_demux_feed *dvbdmxfeed) | |||
98 | case DMX_TS_PES_TELETEXT: | 81 | case DMX_TS_PES_TELETEXT: |
99 | case DMX_TS_PES_PCR: | 82 | case DMX_TS_PES_PCR: |
100 | case DMX_TS_PES_OTHER: | 83 | case DMX_TS_PES_OTHER: |
101 | //Dirty fix to keep fdtv->channel pid-list up to date | 84 | c = alloc_channel(fdtv); |
102 | for(k=0;k<16;k++){ | ||
103 | if (!fdtv->channel[k].active) | ||
104 | fdtv->channel[k].pid = | ||
105 | dvbdmxfeed->pid; | ||
106 | break; | ||
107 | } | ||
108 | channel = fdtv_channel_allocate(fdtv); | ||
109 | break; | 85 | break; |
110 | default: | 86 | default: |
111 | printk(KERN_ERR "%s: invalid pes type %u\n", | 87 | dev_err(fdtv->device, |
112 | __func__, dvbdmxfeed->pes_type); | 88 | "can't start dmx feed: invalid pes type %u\n", |
113 | return -EINVAL; | 89 | dvbdmxfeed->pes_type); |
90 | ret = -EINVAL; | ||
91 | goto out; | ||
114 | } | 92 | } |
115 | } else { | 93 | } else { |
116 | channel = fdtv_channel_allocate(fdtv); | 94 | c = alloc_channel(fdtv); |
117 | } | 95 | } |
118 | 96 | ||
119 | if (!channel) { | 97 | if (c > 15) { |
120 | printk(KERN_ERR "%s: busy!\n", __func__); | 98 | dev_err(fdtv->device, "can't start dmx feed: busy\n"); |
121 | return -EBUSY; | 99 | ret = -EBUSY; |
100 | goto out; | ||
122 | } | 101 | } |
123 | 102 | ||
124 | dvbdmxfeed->priv = channel; | 103 | dvbdmxfeed->priv = (typeof(dvbdmxfeed->priv))(unsigned long)c; |
125 | channel->pid = dvbdmxfeed->pid; | 104 | fdtv->channel_pid[c] = dvbdmxfeed->pid; |
126 | 105 | collect_channels(fdtv, &pidc, pids); | |
127 | if (fdtv_channel_collect(fdtv, &pidc, pids)) { | ||
128 | fdtv_channel_release(fdtv, channel); | ||
129 | printk(KERN_ERR "%s: could not collect pids!\n", __func__); | ||
130 | return -EINTR; | ||
131 | } | ||
132 | 106 | ||
133 | if (dvbdmxfeed->pid == 8192) { | 107 | if (dvbdmxfeed->pid == 8192) { |
134 | k = avc_tuner_get_ts(fdtv); | 108 | ret = avc_tuner_get_ts(fdtv); |
135 | if (k) { | 109 | if (ret) { |
136 | fdtv_channel_release(fdtv, channel); | 110 | dealloc_channel(fdtv, c); |
137 | printk("%s: AVCTuner_GetTS failed with error %d\n", | 111 | dev_err(fdtv->device, "can't get TS\n"); |
138 | __func__, k); | 112 | goto out; |
139 | return k; | ||
140 | } | 113 | } |
141 | } else { | 114 | } else { |
142 | k = avc_tuner_set_pids(fdtv, pidc, pids); | 115 | ret = avc_tuner_set_pids(fdtv, pidc, pids); |
143 | if (k) { | 116 | if (ret) { |
144 | fdtv_channel_release(fdtv, channel); | 117 | dealloc_channel(fdtv, c); |
145 | printk("%s: AVCTuner_SetPIDs failed with error %d\n", | 118 | dev_err(fdtv->device, "can't set PIDs\n"); |
146 | __func__, k); | 119 | goto out; |
147 | return k; | ||
148 | } | 120 | } |
149 | } | 121 | } |
122 | out: | ||
123 | mutex_unlock(&fdtv->demux_mutex); | ||
150 | 124 | ||
151 | return 0; | 125 | return ret; |
152 | } | 126 | } |
153 | 127 | ||
154 | int fdtv_stop_feed(struct dvb_demux_feed *dvbdmxfeed) | 128 | int fdtv_stop_feed(struct dvb_demux_feed *dvbdmxfeed) |
155 | { | 129 | { |
156 | struct dvb_demux *demux = dvbdmxfeed->demux; | 130 | struct dvb_demux *demux = dvbdmxfeed->demux; |
157 | struct firedtv *fdtv = (struct firedtv*)demux->priv; | 131 | struct firedtv *fdtv = demux->priv; |
158 | struct firedtv_channel *c = dvbdmxfeed->priv; | 132 | int pidc, c, ret; |
159 | int k, l; | ||
160 | u16 pids[16]; | 133 | u16 pids[16]; |
161 | 134 | ||
162 | if (dvbdmxfeed->type == DMX_TYPE_TS && !((dvbdmxfeed->ts_type & TS_PACKET) && | 135 | if (dvbdmxfeed->type == DMX_TYPE_TS && |
163 | (demux->dmx.frontend->source != DMX_MEMORY_FE))) { | 136 | !((dvbdmxfeed->ts_type & TS_PACKET) && |
137 | (demux->dmx.frontend->source != DMX_MEMORY_FE))) { | ||
164 | 138 | ||
165 | if (dvbdmxfeed->ts_type & TS_DECODER) { | 139 | if (dvbdmxfeed->ts_type & TS_DECODER) { |
166 | |||
167 | if (dvbdmxfeed->pes_type >= DMX_TS_PES_OTHER || | 140 | if (dvbdmxfeed->pes_type >= DMX_TS_PES_OTHER || |
168 | !demux->pesfilter[dvbdmxfeed->pes_type]) | 141 | !demux->pesfilter[dvbdmxfeed->pes_type]) |
169 | |||
170 | return -EINVAL; | 142 | return -EINVAL; |
171 | 143 | ||
172 | demux->pids[dvbdmxfeed->pes_type] |= 0x8000; | 144 | demux->pids[dvbdmxfeed->pes_type] |= 0x8000; |
@@ -174,38 +146,32 @@ int fdtv_stop_feed(struct dvb_demux_feed *dvbdmxfeed) | |||
174 | } | 146 | } |
175 | 147 | ||
176 | if (!(dvbdmxfeed->ts_type & TS_DECODER && | 148 | if (!(dvbdmxfeed->ts_type & TS_DECODER && |
177 | dvbdmxfeed->pes_type < DMX_TS_PES_OTHER)) | 149 | dvbdmxfeed->pes_type < DMX_TS_PES_OTHER)) |
178 | |||
179 | return 0; | 150 | return 0; |
180 | } | 151 | } |
181 | 152 | ||
182 | if (mutex_lock_interruptible(&fdtv->demux_mutex)) | 153 | if (mutex_lock_interruptible(&fdtv->demux_mutex)) |
183 | return -EINTR; | 154 | return -EINTR; |
184 | 155 | ||
185 | /* list except channel to be removed */ | 156 | c = (unsigned long)dvbdmxfeed->priv; |
186 | for (k = 0, l = 0; k < 16; k++) | 157 | dealloc_channel(fdtv, c); |
187 | if (fdtv->channel[k].active) { | 158 | collect_channels(fdtv, &pidc, pids); |
188 | if (&fdtv->channel[k] != c) | ||
189 | pids[l++] = fdtv->channel[k].pid; | ||
190 | else | ||
191 | fdtv->channel[k].active = false; | ||
192 | } | ||
193 | 159 | ||
194 | k = avc_tuner_set_pids(fdtv, l, pids); | 160 | ret = avc_tuner_set_pids(fdtv, pidc, pids); |
195 | if (!k) | ||
196 | c->active = false; | ||
197 | 161 | ||
198 | mutex_unlock(&fdtv->demux_mutex); | 162 | mutex_unlock(&fdtv->demux_mutex); |
199 | return k; | 163 | |
164 | return ret; | ||
200 | } | 165 | } |
201 | 166 | ||
202 | int fdtv_dvbdev_init(struct firedtv *fdtv, struct device *dev) | 167 | DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); |
168 | |||
169 | int fdtv_dvb_register(struct firedtv *fdtv) | ||
203 | { | 170 | { |
204 | int err; | 171 | int err; |
205 | 172 | ||
206 | err = DVB_REGISTER_ADAPTER(&fdtv->adapter, | 173 | err = dvb_register_adapter(&fdtv->adapter, fdtv_model_names[fdtv->type], |
207 | fdtv_model_names[fdtv->type], | 174 | THIS_MODULE, fdtv->device, adapter_nr); |
208 | THIS_MODULE, dev, adapter_nr); | ||
209 | if (err < 0) | 175 | if (err < 0) |
210 | goto fail_log; | 176 | goto fail_log; |
211 | 177 | ||
@@ -223,9 +189,9 @@ int fdtv_dvbdev_init(struct firedtv *fdtv, struct device *dev) | |||
223 | if (err) | 189 | if (err) |
224 | goto fail_unreg_adapter; | 190 | goto fail_unreg_adapter; |
225 | 191 | ||
226 | fdtv->dmxdev.filternum = 16; | 192 | fdtv->dmxdev.filternum = 16; |
227 | fdtv->dmxdev.demux = &fdtv->demux.dmx; | 193 | fdtv->dmxdev.demux = &fdtv->demux.dmx; |
228 | fdtv->dmxdev.capabilities = 0; | 194 | fdtv->dmxdev.capabilities = 0; |
229 | 195 | ||
230 | err = dvb_dmxdev_init(&fdtv->dmxdev, &fdtv->adapter); | 196 | err = dvb_dmxdev_init(&fdtv->dmxdev, &fdtv->adapter); |
231 | if (err) | 197 | if (err) |
@@ -233,13 +199,12 @@ int fdtv_dvbdev_init(struct firedtv *fdtv, struct device *dev) | |||
233 | 199 | ||
234 | fdtv->frontend.source = DMX_FRONTEND_0; | 200 | fdtv->frontend.source = DMX_FRONTEND_0; |
235 | 201 | ||
236 | err = fdtv->demux.dmx.add_frontend(&fdtv->demux.dmx, | 202 | err = fdtv->demux.dmx.add_frontend(&fdtv->demux.dmx, &fdtv->frontend); |
237 | &fdtv->frontend); | ||
238 | if (err) | 203 | if (err) |
239 | goto fail_dmxdev_release; | 204 | goto fail_dmxdev_release; |
240 | 205 | ||
241 | err = fdtv->demux.dmx.connect_frontend(&fdtv->demux.dmx, | 206 | err = fdtv->demux.dmx.connect_frontend(&fdtv->demux.dmx, |
242 | &fdtv->frontend); | 207 | &fdtv->frontend); |
243 | if (err) | 208 | if (err) |
244 | goto fail_rem_frontend; | 209 | goto fail_rem_frontend; |
245 | 210 | ||
@@ -252,16 +217,15 @@ int fdtv_dvbdev_init(struct firedtv *fdtv, struct device *dev) | |||
252 | 217 | ||
253 | err = fdtv_ca_register(fdtv); | 218 | err = fdtv_ca_register(fdtv); |
254 | if (err) | 219 | if (err) |
255 | dev_info(dev, "Conditional Access Module not enabled\n"); | 220 | dev_info(fdtv->device, |
256 | 221 | "Conditional Access Module not enabled\n"); | |
257 | return 0; | 222 | return 0; |
258 | 223 | ||
259 | fail_net_release: | 224 | fail_net_release: |
260 | dvb_net_release(&fdtv->dvbnet); | 225 | dvb_net_release(&fdtv->dvbnet); |
261 | fdtv->demux.dmx.close(&fdtv->demux.dmx); | 226 | fdtv->demux.dmx.close(&fdtv->demux.dmx); |
262 | fail_rem_frontend: | 227 | fail_rem_frontend: |
263 | fdtv->demux.dmx.remove_frontend(&fdtv->demux.dmx, | 228 | fdtv->demux.dmx.remove_frontend(&fdtv->demux.dmx, &fdtv->frontend); |
264 | &fdtv->frontend); | ||
265 | fail_dmxdev_release: | 229 | fail_dmxdev_release: |
266 | dvb_dmxdev_release(&fdtv->dmxdev); | 230 | dvb_dmxdev_release(&fdtv->dmxdev); |
267 | fail_dmx_release: | 231 | fail_dmx_release: |
@@ -269,8 +233,132 @@ fail_dmx_release: | |||
269 | fail_unreg_adapter: | 233 | fail_unreg_adapter: |
270 | dvb_unregister_adapter(&fdtv->adapter); | 234 | dvb_unregister_adapter(&fdtv->adapter); |
271 | fail_log: | 235 | fail_log: |
272 | dev_err(dev, "DVB initialization failed\n"); | 236 | dev_err(fdtv->device, "DVB initialization failed\n"); |
273 | return err; | 237 | return err; |
274 | } | 238 | } |
275 | 239 | ||
240 | void fdtv_dvb_unregister(struct firedtv *fdtv) | ||
241 | { | ||
242 | fdtv_ca_release(fdtv); | ||
243 | dvb_unregister_frontend(&fdtv->fe); | ||
244 | dvb_net_release(&fdtv->dvbnet); | ||
245 | fdtv->demux.dmx.close(&fdtv->demux.dmx); | ||
246 | fdtv->demux.dmx.remove_frontend(&fdtv->demux.dmx, &fdtv->frontend); | ||
247 | dvb_dmxdev_release(&fdtv->dmxdev); | ||
248 | dvb_dmx_release(&fdtv->demux); | ||
249 | dvb_unregister_adapter(&fdtv->adapter); | ||
250 | } | ||
251 | |||
252 | const char *fdtv_model_names[] = { | ||
253 | [FIREDTV_UNKNOWN] = "unknown type", | ||
254 | [FIREDTV_DVB_S] = "FireDTV S/CI", | ||
255 | [FIREDTV_DVB_C] = "FireDTV C/CI", | ||
256 | [FIREDTV_DVB_T] = "FireDTV T/CI", | ||
257 | [FIREDTV_DVB_S2] = "FireDTV S2 ", | ||
258 | }; | ||
259 | |||
260 | struct firedtv *fdtv_alloc(struct device *dev, | ||
261 | const struct firedtv_backend *backend, | ||
262 | const char *name, size_t name_len) | ||
263 | { | ||
264 | struct firedtv *fdtv; | ||
265 | int i; | ||
266 | |||
267 | fdtv = kzalloc(sizeof(*fdtv), GFP_KERNEL); | ||
268 | if (!fdtv) | ||
269 | return NULL; | ||
270 | |||
271 | dev->driver_data = fdtv; | ||
272 | fdtv->device = dev; | ||
273 | fdtv->isochannel = -1; | ||
274 | fdtv->voltage = 0xff; | ||
275 | fdtv->tone = 0xff; | ||
276 | fdtv->backend = backend; | ||
277 | |||
278 | mutex_init(&fdtv->avc_mutex); | ||
279 | init_waitqueue_head(&fdtv->avc_wait); | ||
280 | fdtv->avc_reply_received = true; | ||
281 | mutex_init(&fdtv->demux_mutex); | ||
282 | INIT_WORK(&fdtv->remote_ctrl_work, avc_remote_ctrl_work); | ||
283 | |||
284 | for (i = ARRAY_SIZE(fdtv_model_names); --i; ) | ||
285 | if (strlen(fdtv_model_names[i]) <= name_len && | ||
286 | strncmp(name, fdtv_model_names[i], name_len) == 0) | ||
287 | break; | ||
288 | fdtv->type = i; | ||
289 | |||
290 | return fdtv; | ||
291 | } | ||
292 | |||
293 | #define MATCH_FLAGS (IEEE1394_MATCH_VENDOR_ID | IEEE1394_MATCH_MODEL_ID | \ | ||
294 | IEEE1394_MATCH_SPECIFIER_ID | IEEE1394_MATCH_VERSION) | ||
295 | |||
296 | #define DIGITAL_EVERYWHERE_OUI 0x001287 | ||
297 | #define AVC_UNIT_SPEC_ID_ENTRY 0x00a02d | ||
298 | #define AVC_SW_VERSION_ENTRY 0x010001 | ||
299 | |||
300 | static struct ieee1394_device_id fdtv_id_table[] = { | ||
301 | { | ||
302 | /* FloppyDTV S/CI and FloppyDTV S2 */ | ||
303 | .match_flags = MATCH_FLAGS, | ||
304 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
305 | .model_id = 0x000024, | ||
306 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
307 | .version = AVC_SW_VERSION_ENTRY, | ||
308 | }, { | ||
309 | /* FloppyDTV T/CI */ | ||
310 | .match_flags = MATCH_FLAGS, | ||
311 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
312 | .model_id = 0x000025, | ||
313 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
314 | .version = AVC_SW_VERSION_ENTRY, | ||
315 | }, { | ||
316 | /* FloppyDTV C/CI */ | ||
317 | .match_flags = MATCH_FLAGS, | ||
318 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
319 | .model_id = 0x000026, | ||
320 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
321 | .version = AVC_SW_VERSION_ENTRY, | ||
322 | }, { | ||
323 | /* FireDTV S/CI and FloppyDTV S2 */ | ||
324 | .match_flags = MATCH_FLAGS, | ||
325 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
326 | .model_id = 0x000034, | ||
327 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
328 | .version = AVC_SW_VERSION_ENTRY, | ||
329 | }, { | ||
330 | /* FireDTV T/CI */ | ||
331 | .match_flags = MATCH_FLAGS, | ||
332 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
333 | .model_id = 0x000035, | ||
334 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
335 | .version = AVC_SW_VERSION_ENTRY, | ||
336 | }, { | ||
337 | /* FireDTV C/CI */ | ||
338 | .match_flags = MATCH_FLAGS, | ||
339 | .vendor_id = DIGITAL_EVERYWHERE_OUI, | ||
340 | .model_id = 0x000036, | ||
341 | .specifier_id = AVC_UNIT_SPEC_ID_ENTRY, | ||
342 | .version = AVC_SW_VERSION_ENTRY, | ||
343 | }, {} | ||
344 | }; | ||
345 | MODULE_DEVICE_TABLE(ieee1394, fdtv_id_table); | ||
346 | |||
347 | static int __init fdtv_init(void) | ||
348 | { | ||
349 | return fdtv_1394_init(fdtv_id_table); | ||
350 | } | ||
351 | |||
352 | static void __exit fdtv_exit(void) | ||
353 | { | ||
354 | fdtv_1394_exit(); | ||
355 | } | ||
356 | |||
357 | module_init(fdtv_init); | ||
358 | module_exit(fdtv_exit); | ||
276 | 359 | ||
360 | MODULE_AUTHOR("Andreas Monitzer <andy@monitzer.com>"); | ||
361 | MODULE_AUTHOR("Ben Backx <ben@bbackx.com>"); | ||
362 | MODULE_DESCRIPTION("FireDTV DVB Driver"); | ||
363 | MODULE_LICENSE("GPL"); | ||
364 | MODULE_SUPPORTED_DEVICE("FireDTV DVB"); | ||
diff --git a/drivers/media/dvb/firewire/firedtv-fe.c b/drivers/media/dvb/firewire/firedtv-fe.c index f8150f402bb6..9b9539c800f8 100644 --- a/drivers/media/dvb/firewire/firedtv-fe.c +++ b/drivers/media/dvb/firewire/firedtv-fe.c | |||
@@ -10,6 +10,7 @@ | |||
10 | * the License, or (at your option) any later version. | 10 | * the License, or (at your option) any later version. |
11 | */ | 11 | */ |
12 | 12 | ||
13 | #include <linux/device.h> | ||
13 | #include <linux/errno.h> | 14 | #include <linux/errno.h> |
14 | #include <linux/kernel.h> | 15 | #include <linux/kernel.h> |
15 | #include <linux/string.h> | 16 | #include <linux/string.h> |
@@ -17,8 +18,6 @@ | |||
17 | 18 | ||
18 | #include <dvb_frontend.h> | 19 | #include <dvb_frontend.h> |
19 | 20 | ||
20 | #include "avc.h" | ||
21 | #include "cmp.h" | ||
22 | #include "firedtv.h" | 21 | #include "firedtv.h" |
23 | 22 | ||
24 | static int fdtv_dvb_init(struct dvb_frontend *fe) | 23 | static int fdtv_dvb_init(struct dvb_frontend *fe) |
@@ -32,35 +31,37 @@ static int fdtv_dvb_init(struct dvb_frontend *fe) | |||
32 | err = cmp_establish_pp_connection(fdtv, fdtv->subunit, | 31 | err = cmp_establish_pp_connection(fdtv, fdtv->subunit, |
33 | fdtv->isochannel); | 32 | fdtv->isochannel); |
34 | if (err) { | 33 | if (err) { |
35 | printk(KERN_ERR "Could not establish point to point " | 34 | dev_err(fdtv->device, |
36 | "connection.\n"); | 35 | "could not establish point to point connection\n"); |
37 | return err; | 36 | return err; |
38 | } | 37 | } |
39 | 38 | ||
40 | return setup_iso_channel(fdtv); | 39 | return fdtv->backend->start_iso(fdtv); |
41 | } | 40 | } |
42 | 41 | ||
43 | static int fdtv_sleep(struct dvb_frontend *fe) | 42 | static int fdtv_sleep(struct dvb_frontend *fe) |
44 | { | 43 | { |
45 | struct firedtv *fdtv = fe->sec_priv; | 44 | struct firedtv *fdtv = fe->sec_priv; |
46 | 45 | ||
47 | tear_down_iso_channel(fdtv); | 46 | fdtv->backend->stop_iso(fdtv); |
48 | cmp_break_pp_connection(fdtv, fdtv->subunit, fdtv->isochannel); | 47 | cmp_break_pp_connection(fdtv, fdtv->subunit, fdtv->isochannel); |
49 | fdtv->isochannel = -1; | 48 | fdtv->isochannel = -1; |
50 | return 0; | 49 | return 0; |
51 | } | 50 | } |
52 | 51 | ||
52 | #define LNBCONTROL_DONTCARE 0xff | ||
53 | |||
53 | static int fdtv_diseqc_send_master_cmd(struct dvb_frontend *fe, | 54 | static int fdtv_diseqc_send_master_cmd(struct dvb_frontend *fe, |
54 | struct dvb_diseqc_master_cmd *cmd) | 55 | struct dvb_diseqc_master_cmd *cmd) |
55 | { | 56 | { |
56 | struct firedtv *fdtv = fe->sec_priv; | 57 | struct firedtv *fdtv = fe->sec_priv; |
57 | 58 | ||
58 | return avc_lnb_control(fdtv, LNBCONTROL_DONTCARE, | 59 | return avc_lnb_control(fdtv, LNBCONTROL_DONTCARE, LNBCONTROL_DONTCARE, |
59 | LNBCONTROL_DONTCARE, LNBCONTROL_DONTCARE, 1, cmd); | 60 | LNBCONTROL_DONTCARE, 1, cmd); |
60 | } | 61 | } |
61 | 62 | ||
62 | static int fdtv_diseqc_send_burst(struct dvb_frontend *fe, | 63 | static int fdtv_diseqc_send_burst(struct dvb_frontend *fe, |
63 | fe_sec_mini_cmd_t minicmd) | 64 | fe_sec_mini_cmd_t minicmd) |
64 | { | 65 | { |
65 | return 0; | 66 | return 0; |
66 | } | 67 | } |
@@ -74,7 +75,7 @@ static int fdtv_set_tone(struct dvb_frontend *fe, fe_sec_tone_mode_t tone) | |||
74 | } | 75 | } |
75 | 76 | ||
76 | static int fdtv_set_voltage(struct dvb_frontend *fe, | 77 | static int fdtv_set_voltage(struct dvb_frontend *fe, |
77 | fe_sec_voltage_t voltage) | 78 | fe_sec_voltage_t voltage) |
78 | { | 79 | { |
79 | struct firedtv *fdtv = fe->sec_priv; | 80 | struct firedtv *fdtv = fe->sec_priv; |
80 | 81 | ||
@@ -85,12 +86,12 @@ static int fdtv_set_voltage(struct dvb_frontend *fe, | |||
85 | static int fdtv_read_status(struct dvb_frontend *fe, fe_status_t *status) | 86 | static int fdtv_read_status(struct dvb_frontend *fe, fe_status_t *status) |
86 | { | 87 | { |
87 | struct firedtv *fdtv = fe->sec_priv; | 88 | struct firedtv *fdtv = fe->sec_priv; |
88 | ANTENNA_INPUT_INFO info; | 89 | struct firedtv_tuner_status stat; |
89 | 90 | ||
90 | if (avc_tuner_status(fdtv, &info)) | 91 | if (avc_tuner_status(fdtv, &stat)) |
91 | return -EINVAL; | 92 | return -EINVAL; |
92 | 93 | ||
93 | if (info.NoRF) | 94 | if (stat.no_rf) |
94 | *status = 0; | 95 | *status = 0; |
95 | else | 96 | else |
96 | *status = FE_HAS_SIGNAL | FE_HAS_VITERBI | FE_HAS_SYNC | | 97 | *status = FE_HAS_SIGNAL | FE_HAS_VITERBI | FE_HAS_SYNC | |
@@ -101,39 +102,37 @@ static int fdtv_read_status(struct dvb_frontend *fe, fe_status_t *status) | |||
101 | static int fdtv_read_ber(struct dvb_frontend *fe, u32 *ber) | 102 | static int fdtv_read_ber(struct dvb_frontend *fe, u32 *ber) |
102 | { | 103 | { |
103 | struct firedtv *fdtv = fe->sec_priv; | 104 | struct firedtv *fdtv = fe->sec_priv; |
104 | ANTENNA_INPUT_INFO info; | 105 | struct firedtv_tuner_status stat; |
105 | 106 | ||
106 | if (avc_tuner_status(fdtv, &info)) | 107 | if (avc_tuner_status(fdtv, &stat)) |
107 | return -EINVAL; | 108 | return -EINVAL; |
108 | 109 | ||
109 | *ber = info.BER[0] << 24 | info.BER[1] << 16 | | 110 | *ber = stat.ber; |
110 | info.BER[2] << 8 | info.BER[3]; | ||
111 | return 0; | 111 | return 0; |
112 | } | 112 | } |
113 | 113 | ||
114 | static int fdtv_read_signal_strength (struct dvb_frontend *fe, u16 *strength) | 114 | static int fdtv_read_signal_strength(struct dvb_frontend *fe, u16 *strength) |
115 | { | 115 | { |
116 | struct firedtv *fdtv = fe->sec_priv; | 116 | struct firedtv *fdtv = fe->sec_priv; |
117 | ANTENNA_INPUT_INFO info; | 117 | struct firedtv_tuner_status stat; |
118 | 118 | ||
119 | if (avc_tuner_status(fdtv, &info)) | 119 | if (avc_tuner_status(fdtv, &stat)) |
120 | return -EINVAL; | 120 | return -EINVAL; |
121 | 121 | ||
122 | *strength = info.SignalStrength << 8; | 122 | *strength = stat.signal_strength << 8; |
123 | return 0; | 123 | return 0; |
124 | } | 124 | } |
125 | 125 | ||
126 | static int fdtv_read_snr(struct dvb_frontend *fe, u16 *snr) | 126 | static int fdtv_read_snr(struct dvb_frontend *fe, u16 *snr) |
127 | { | 127 | { |
128 | struct firedtv *fdtv = fe->sec_priv; | 128 | struct firedtv *fdtv = fe->sec_priv; |
129 | ANTENNA_INPUT_INFO info; | 129 | struct firedtv_tuner_status stat; |
130 | 130 | ||
131 | if (avc_tuner_status(fdtv, &info)) | 131 | if (avc_tuner_status(fdtv, &stat)) |
132 | return -EINVAL; | 132 | return -EINVAL; |
133 | 133 | ||
134 | /* C/N[dB] = -10 * log10(snr / 65535) */ | 134 | /* C/N[dB] = -10 * log10(snr / 65535) */ |
135 | *snr = (info.CarrierNoiseRatio[0] << 8) + info.CarrierNoiseRatio[1]; | 135 | *snr = stat.carrier_noise_ratio * 257; |
136 | *snr *= 257; | ||
137 | return 0; | 136 | return 0; |
138 | } | 137 | } |
139 | 138 | ||
@@ -142,8 +141,10 @@ static int fdtv_read_uncorrected_blocks(struct dvb_frontend *fe, u32 *ucblocks) | |||
142 | return -EOPNOTSUPP; | 141 | return -EOPNOTSUPP; |
143 | } | 142 | } |
144 | 143 | ||
144 | #define ACCEPTED 0x9 | ||
145 | |||
145 | static int fdtv_set_frontend(struct dvb_frontend *fe, | 146 | static int fdtv_set_frontend(struct dvb_frontend *fe, |
146 | struct dvb_frontend_parameters *params) | 147 | struct dvb_frontend_parameters *params) |
147 | { | 148 | { |
148 | struct firedtv *fdtv = fe->sec_priv; | 149 | struct firedtv *fdtv = fe->sec_priv; |
149 | 150 | ||
@@ -155,7 +156,7 @@ static int fdtv_set_frontend(struct dvb_frontend *fe, | |||
155 | } | 156 | } |
156 | 157 | ||
157 | static int fdtv_get_frontend(struct dvb_frontend *fe, | 158 | static int fdtv_get_frontend(struct dvb_frontend *fe, |
158 | struct dvb_frontend_parameters *params) | 159 | struct dvb_frontend_parameters *params) |
159 | { | 160 | { |
160 | return -EOPNOTSUPP; | 161 | return -EOPNOTSUPP; |
161 | } | 162 | } |
@@ -235,8 +236,8 @@ void fdtv_frontend_init(struct firedtv *fdtv) | |||
235 | break; | 236 | break; |
236 | 237 | ||
237 | default: | 238 | default: |
238 | printk(KERN_ERR "FireDTV: no frontend for model type %d\n", | 239 | dev_err(fdtv->device, "no frontend for model type %d\n", |
239 | fdtv->type); | 240 | fdtv->type); |
240 | } | 241 | } |
241 | strcpy(fi->name, fdtv_model_names[fdtv->type]); | 242 | strcpy(fi->name, fdtv_model_names[fdtv->type]); |
242 | 243 | ||
diff --git a/drivers/media/dvb/firewire/firedtv-iso.c b/drivers/media/dvb/firewire/firedtv-iso.c deleted file mode 100644 index a72df228e7de..000000000000 --- a/drivers/media/dvb/firewire/firedtv-iso.c +++ /dev/null | |||
@@ -1,111 +0,0 @@ | |||
1 | /* | ||
2 | * FireSAT DVB driver | ||
3 | * | ||
4 | * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> | ||
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 as | ||
8 | * published by the Free Software Foundation; either version 2 of | ||
9 | * the License, or (at your option) any later version. | ||
10 | */ | ||
11 | |||
12 | #include <linux/errno.h> | ||
13 | #include <linux/kernel.h> | ||
14 | #include <linux/list.h> | ||
15 | #include <linux/spinlock.h> | ||
16 | |||
17 | #include <dvb_demux.h> | ||
18 | |||
19 | #include <dma.h> | ||
20 | #include <iso.h> | ||
21 | #include <nodemgr.h> | ||
22 | |||
23 | #include "firedtv.h" | ||
24 | |||
25 | static void rawiso_activity_cb(struct hpsb_iso *iso); | ||
26 | |||
27 | void tear_down_iso_channel(struct firedtv *fdtv) | ||
28 | { | ||
29 | if (fdtv->iso_handle != NULL) { | ||
30 | hpsb_iso_stop(fdtv->iso_handle); | ||
31 | hpsb_iso_shutdown(fdtv->iso_handle); | ||
32 | } | ||
33 | fdtv->iso_handle = NULL; | ||
34 | } | ||
35 | |||
36 | int setup_iso_channel(struct firedtv *fdtv) | ||
37 | { | ||
38 | int result; | ||
39 | fdtv->iso_handle = | ||
40 | hpsb_iso_recv_init(fdtv->ud->ne->host, | ||
41 | 256 * 200, //data_buf_size, | ||
42 | 256, //buf_packets, | ||
43 | fdtv->isochannel, | ||
44 | HPSB_ISO_DMA_DEFAULT, //dma_mode, | ||
45 | -1, //stat.config.irq_interval, | ||
46 | rawiso_activity_cb); | ||
47 | if (fdtv->iso_handle == NULL) { | ||
48 | printk(KERN_ERR "Cannot initialize iso receive.\n"); | ||
49 | return -EINVAL; | ||
50 | } | ||
51 | result = hpsb_iso_recv_start(fdtv->iso_handle, -1, -1, 0); | ||
52 | if (result != 0) { | ||
53 | printk(KERN_ERR "Cannot start iso receive.\n"); | ||
54 | return -EINVAL; | ||
55 | } | ||
56 | return 0; | ||
57 | } | ||
58 | |||
59 | static void rawiso_activity_cb(struct hpsb_iso *iso) | ||
60 | { | ||
61 | unsigned int num; | ||
62 | unsigned int i; | ||
63 | unsigned int packet; | ||
64 | unsigned long flags; | ||
65 | struct firedtv *fdtv = NULL; | ||
66 | struct firedtv *fdtv_iterator; | ||
67 | |||
68 | spin_lock_irqsave(&fdtv_list_lock, flags); | ||
69 | list_for_each_entry(fdtv_iterator, &fdtv_list, list) { | ||
70 | if(fdtv_iterator->iso_handle == iso) { | ||
71 | fdtv = fdtv_iterator; | ||
72 | break; | ||
73 | } | ||
74 | } | ||
75 | spin_unlock_irqrestore(&fdtv_list_lock, flags); | ||
76 | |||
77 | if (fdtv) { | ||
78 | packet = iso->first_packet; | ||
79 | num = hpsb_iso_n_ready(iso); | ||
80 | for (i = 0; i < num; i++, | ||
81 | packet = (packet + 1) % iso->buf_packets) { | ||
82 | unsigned char *buf = | ||
83 | dma_region_i(&iso->data_buf, unsigned char, | ||
84 | iso->infos[packet].offset + | ||
85 | sizeof(struct CIPHeader)); | ||
86 | int count = (iso->infos[packet].len - | ||
87 | sizeof(struct CIPHeader)) / | ||
88 | (188 + sizeof(struct firewireheader)); | ||
89 | if (iso->infos[packet].len <= sizeof(struct CIPHeader)) | ||
90 | continue; // ignore empty packet | ||
91 | |||
92 | while (count --) { | ||
93 | if (buf[sizeof(struct firewireheader)] == 0x47) | ||
94 | dvb_dmx_swfilter_packets(&fdtv->demux, | ||
95 | &buf[sizeof(struct firewireheader)], 1); | ||
96 | else | ||
97 | printk("%s: invalid packet, skipping\n", __func__); | ||
98 | buf += 188 + sizeof(struct firewireheader); | ||
99 | |||
100 | } | ||
101 | |||
102 | } | ||
103 | hpsb_iso_recv_release_packets(iso, num); | ||
104 | } | ||
105 | else { | ||
106 | printk("%s: packets for unknown iso channel, skipping\n", | ||
107 | __func__); | ||
108 | hpsb_iso_recv_release_packets(iso, hpsb_iso_n_ready(iso)); | ||
109 | } | ||
110 | } | ||
111 | |||
diff --git a/drivers/media/dvb/firewire/firedtv-rc.c b/drivers/media/dvb/firewire/firedtv-rc.c index 436c0c69a13d..46a6324d7b73 100644 --- a/drivers/media/dvb/firewire/firedtv-rc.c +++ b/drivers/media/dvb/firewire/firedtv-rc.c | |||
@@ -15,7 +15,6 @@ | |||
15 | #include <linux/string.h> | 15 | #include <linux/string.h> |
16 | #include <linux/types.h> | 16 | #include <linux/types.h> |
17 | 17 | ||
18 | #include "firedtv-rc.h" | ||
19 | #include "firedtv.h" | 18 | #include "firedtv.h" |
20 | 19 | ||
21 | /* fixed table with older keycodes, geared towards MythTV */ | 20 | /* fixed table with older keycodes, geared towards MythTV */ |
diff --git a/drivers/media/dvb/firewire/firedtv-rc.h b/drivers/media/dvb/firewire/firedtv-rc.h deleted file mode 100644 index d3e14727d3dd..000000000000 --- a/drivers/media/dvb/firewire/firedtv-rc.h +++ /dev/null | |||
@@ -1,11 +0,0 @@ | |||
1 | #ifndef _FIREDTV_RC_H | ||
2 | #define _FIREDTV_RC_H | ||
3 | |||
4 | struct firedtv; | ||
5 | struct device; | ||
6 | |||
7 | int fdtv_register_rc(struct firedtv *fdtv, struct device *dev); | ||
8 | void fdtv_unregister_rc(struct firedtv *fdtv); | ||
9 | void fdtv_handle_rc(struct firedtv *fdtv, unsigned int code); | ||
10 | |||
11 | #endif /* _FIREDTV_RC_H */ | ||
diff --git a/drivers/media/dvb/firewire/firedtv.h b/drivers/media/dvb/firewire/firedtv.h index 2a34028ccbcd..d48530b81e61 100644 --- a/drivers/media/dvb/firewire/firedtv.h +++ b/drivers/media/dvb/firewire/firedtv.h | |||
@@ -29,95 +29,35 @@ | |||
29 | #include <dvb_net.h> | 29 | #include <dvb_net.h> |
30 | #include <dvbdev.h> | 30 | #include <dvbdev.h> |
31 | 31 | ||
32 | #include <linux/version.h> | 32 | struct firedtv_tuner_status { |
33 | #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 25) | 33 | unsigned active_system:8; |
34 | #define DVB_REGISTER_ADAPTER(x, y, z, w, v) dvb_register_adapter(x, y, z, w, v) | 34 | unsigned searching:1; |
35 | #else | 35 | unsigned moving:1; |
36 | #define DVB_REGISTER_ADAPTER(x, y, z, w, v) dvb_register_adapter(x, y, z, w) | 36 | unsigned no_rf:1; |
37 | #define DVB_DEFINE_MOD_OPT_ADAPTER_NR(x) | 37 | unsigned input:1; |
38 | #endif | 38 | unsigned selected_antenna:7; |
39 | 39 | unsigned ber:32; | |
40 | /***************************************************************** | 40 | unsigned signal_strength:8; |
41 | * CA message command constants from en50221_app_tags.h of libdvb | 41 | unsigned raster_frequency:2; |
42 | *****************************************************************/ | 42 | unsigned rf_frequency:22; |
43 | /* Resource Manager */ | 43 | unsigned man_dep_info_length:8; |
44 | #define TAG_PROFILE_ENQUIRY 0x9f8010 | 44 | unsigned front_end_error:1; |
45 | #define TAG_PROFILE 0x9f8011 | 45 | unsigned antenna_error:1; |
46 | #define TAG_PROFILE_CHANGE 0x9f8012 | 46 | unsigned front_end_power_status:1; |
47 | 47 | unsigned power_supply:1; | |
48 | /* Application Info */ | 48 | unsigned carrier_noise_ratio:16; |
49 | #define TAG_APP_INFO_ENQUIRY 0x9f8020 | 49 | unsigned power_supply_voltage:8; |
50 | #define TAG_APP_INFO 0x9f8021 | 50 | unsigned antenna_voltage:8; |
51 | #define TAG_ENTER_MENU 0x9f8022 | 51 | unsigned firewire_bus_voltage:8; |
52 | 52 | unsigned ca_mmi:1; | |
53 | /* CA Support */ | 53 | unsigned ca_pmt_reply:1; |
54 | #define TAG_CA_INFO_ENQUIRY 0x9f8030 | 54 | unsigned ca_date_time_request:1; |
55 | #define TAG_CA_INFO 0x9f8031 | 55 | unsigned ca_application_info:1; |
56 | #define TAG_CA_PMT 0x9f8032 | 56 | unsigned ca_module_present_status:1; |
57 | #define TAG_CA_PMT_REPLY 0x9f8033 | 57 | unsigned ca_dvb_flag:1; |
58 | 58 | unsigned ca_error_flag:1; | |
59 | /* Host Control */ | 59 | unsigned ca_initialization_status:1; |
60 | #define TAG_TUNE 0x9f8400 | 60 | }; |
61 | #define TAG_REPLACE 0x9f8401 | ||
62 | #define TAG_CLEAR_REPLACE 0x9f8402 | ||
63 | #define TAG_ASK_RELEASE 0x9f8403 | ||
64 | |||
65 | /* Date and Time */ | ||
66 | #define TAG_DATE_TIME_ENQUIRY 0x9f8440 | ||
67 | #define TAG_DATE_TIME 0x9f8441 | ||
68 | |||
69 | /* Man Machine Interface (MMI) */ | ||
70 | #define TAG_CLOSE_MMI 0x9f8800 | ||
71 | #define TAG_DISPLAY_CONTROL 0x9f8801 | ||
72 | #define TAG_DISPLAY_REPLY 0x9f8802 | ||
73 | #define TAG_TEXT_LAST 0x9f8803 | ||
74 | #define TAG_TEXT_MORE 0x9f8804 | ||
75 | #define TAG_KEYPAD_CONTROL 0x9f8805 | ||
76 | #define TAG_KEYPRESS 0x9f8806 | ||
77 | #define TAG_ENQUIRY 0x9f8807 | ||
78 | #define TAG_ANSWER 0x9f8808 | ||
79 | #define TAG_MENU_LAST 0x9f8809 | ||
80 | #define TAG_MENU_MORE 0x9f880a | ||
81 | #define TAG_MENU_ANSWER 0x9f880b | ||
82 | #define TAG_LIST_LAST 0x9f880c | ||
83 | #define TAG_LIST_MORE 0x9f880d | ||
84 | #define TAG_SUBTITLE_SEGMENT_LAST 0x9f880e | ||
85 | #define TAG_SUBTITLE_SEGMENT_MORE 0x9f880f | ||
86 | #define TAG_DISPLAY_MESSAGE 0x9f8810 | ||
87 | #define TAG_SCENE_END_MARK 0x9f8811 | ||
88 | #define TAG_SCENE_DONE 0x9f8812 | ||
89 | #define TAG_SCENE_CONTROL 0x9f8813 | ||
90 | #define TAG_SUBTITLE_DOWNLOAD_LAST 0x9f8814 | ||
91 | #define TAG_SUBTITLE_DOWNLOAD_MORE 0x9f8815 | ||
92 | #define TAG_FLUSH_DOWNLOAD 0x9f8816 | ||
93 | #define TAG_DOWNLOAD_REPLY 0x9f8817 | ||
94 | |||
95 | /* Low Speed Communications */ | ||
96 | #define TAG_COMMS_COMMAND 0x9f8c00 | ||
97 | #define TAG_CONNECTION_DESCRIPTOR 0x9f8c01 | ||
98 | #define TAG_COMMS_REPLY 0x9f8c02 | ||
99 | #define TAG_COMMS_SEND_LAST 0x9f8c03 | ||
100 | #define TAG_COMMS_SEND_MORE 0x9f8c04 | ||
101 | #define TAG_COMMS_RECV_LAST 0x9f8c05 | ||
102 | #define TAG_COMMS_RECV_MORE 0x9f8c06 | ||
103 | |||
104 | /* Authentication */ | ||
105 | #define TAG_AUTH_REQ 0x9f8200 | ||
106 | #define TAG_AUTH_RESP 0x9f8201 | ||
107 | |||
108 | /* Teletext */ | ||
109 | #define TAG_TELETEXT_EBU 0x9f9000 | ||
110 | |||
111 | /* Smartcard */ | ||
112 | #define TAG_SMARTCARD_COMMAND 0x9f8e00 | ||
113 | #define TAG_SMARTCARD_REPLY 0x9f8e01 | ||
114 | #define TAG_SMARTCARD_SEND 0x9f8e02 | ||
115 | #define TAG_SMARTCARD_RCV 0x9f8e03 | ||
116 | |||
117 | /* EPG */ | ||
118 | #define TAG_EPG_ENQUIRY 0x9f8f00 | ||
119 | #define TAG_EPG_REPLY 0x9f8f01 | ||
120 | |||
121 | 61 | ||
122 | enum model_type { | 62 | enum model_type { |
123 | FIREDTV_UNKNOWN = 0, | 63 | FIREDTV_UNKNOWN = 0, |
@@ -127,11 +67,22 @@ enum model_type { | |||
127 | FIREDTV_DVB_S2 = 4, | 67 | FIREDTV_DVB_S2 = 4, |
128 | }; | 68 | }; |
129 | 69 | ||
70 | struct device; | ||
130 | struct input_dev; | 71 | struct input_dev; |
131 | struct hpsb_iso; | 72 | struct firedtv; |
132 | struct unit_directory; | 73 | |
74 | struct firedtv_backend { | ||
75 | int (*lock)(struct firedtv *fdtv, u64 addr, void *data, __be32 arg); | ||
76 | int (*read)(struct firedtv *fdtv, u64 addr, void *data, size_t len); | ||
77 | int (*write)(struct firedtv *fdtv, u64 addr, void *data, size_t len); | ||
78 | int (*start_iso)(struct firedtv *fdtv); | ||
79 | void (*stop_iso)(struct firedtv *fdtv); | ||
80 | }; | ||
133 | 81 | ||
134 | struct firedtv { | 82 | struct firedtv { |
83 | struct device *device; | ||
84 | struct list_head list; | ||
85 | |||
135 | struct dvb_adapter adapter; | 86 | struct dvb_adapter adapter; |
136 | struct dmxdev dmxdev; | 87 | struct dmxdev dmxdev; |
137 | struct dvb_demux demux; | 88 | struct dvb_demux demux; |
@@ -149,79 +100,83 @@ struct firedtv { | |||
149 | struct work_struct remote_ctrl_work; | 100 | struct work_struct remote_ctrl_work; |
150 | struct input_dev *remote_ctrl_dev; | 101 | struct input_dev *remote_ctrl_dev; |
151 | 102 | ||
152 | struct firedtv_channel { | 103 | enum model_type type; |
153 | bool active; | 104 | char subunit; |
154 | int pid; | 105 | char isochannel; |
155 | } channel[16]; | 106 | fe_sec_voltage_t voltage; |
156 | struct mutex demux_mutex; | 107 | fe_sec_tone_mode_t tone; |
157 | 108 | ||
158 | struct unit_directory *ud; | 109 | const struct firedtv_backend *backend; |
110 | void *backend_data; | ||
159 | 111 | ||
160 | enum model_type type; | 112 | struct mutex demux_mutex; |
161 | char subunit; | 113 | unsigned long channel_active; |
162 | fe_sec_voltage_t voltage; | 114 | u16 channel_pid[16]; |
163 | fe_sec_tone_mode_t tone; | ||
164 | |||
165 | int isochannel; | ||
166 | struct hpsb_iso *iso_handle; | ||
167 | |||
168 | struct list_head list; | ||
169 | 115 | ||
170 | /* needed by avc_api */ | 116 | size_t response_length; |
171 | int resp_length; | 117 | u8 response[512]; |
172 | u8 respfrm[512]; | ||
173 | }; | 118 | }; |
174 | 119 | ||
175 | struct firewireheader { | 120 | /* firedtv-1394.c */ |
176 | union { | 121 | #ifdef CONFIG_DVB_FIREDTV_IEEE1394 |
177 | struct { | 122 | int fdtv_1394_init(struct ieee1394_device_id id_table[]); |
178 | __u8 tcode:4; | 123 | void fdtv_1394_exit(void); |
179 | __u8 sy:4; | 124 | #else |
180 | __u8 tag:2; | 125 | static inline int fdtv_1394_init(struct ieee1394_device_id it[]) { return 0; } |
181 | __u8 channel:6; | 126 | static inline void fdtv_1394_exit(void) {} |
182 | 127 | #endif | |
183 | __u8 length_l; | ||
184 | __u8 length_h; | ||
185 | } hdr; | ||
186 | __u32 val; | ||
187 | }; | ||
188 | }; | ||
189 | |||
190 | struct CIPHeader { | ||
191 | union { | ||
192 | struct { | ||
193 | __u8 syncbits:2; | ||
194 | __u8 sid:6; | ||
195 | __u8 dbs; | ||
196 | __u8 fn:2; | ||
197 | __u8 qpc:3; | ||
198 | __u8 sph:1; | ||
199 | __u8 rsv:2; | ||
200 | __u8 dbc; | ||
201 | __u8 syncbits2:2; | ||
202 | __u8 fmt:6; | ||
203 | __u32 fdf:24; | ||
204 | } cip; | ||
205 | __u64 val; | ||
206 | }; | ||
207 | }; | ||
208 | |||
209 | extern const char *fdtv_model_names[]; | ||
210 | extern struct list_head fdtv_list; | ||
211 | extern spinlock_t fdtv_list_lock; | ||
212 | 128 | ||
213 | struct device; | 129 | /* firedtv-avc.c */ |
130 | int avc_recv(struct firedtv *fdtv, void *data, size_t length); | ||
131 | int avc_tuner_status(struct firedtv *fdtv, struct firedtv_tuner_status *stat); | ||
132 | struct dvb_frontend_parameters; | ||
133 | int avc_tuner_dsd(struct firedtv *fdtv, struct dvb_frontend_parameters *params); | ||
134 | int avc_tuner_set_pids(struct firedtv *fdtv, unsigned char pidc, u16 pid[]); | ||
135 | int avc_tuner_get_ts(struct firedtv *fdtv); | ||
136 | int avc_identify_subunit(struct firedtv *fdtv); | ||
137 | struct dvb_diseqc_master_cmd; | ||
138 | int avc_lnb_control(struct firedtv *fdtv, char voltage, char burst, | ||
139 | char conttone, char nrdiseq, | ||
140 | struct dvb_diseqc_master_cmd *diseqcmd); | ||
141 | void avc_remote_ctrl_work(struct work_struct *work); | ||
142 | int avc_register_remote_control(struct firedtv *fdtv); | ||
143 | int avc_ca_app_info(struct firedtv *fdtv, char *app_info, unsigned int *len); | ||
144 | int avc_ca_info(struct firedtv *fdtv, char *app_info, unsigned int *len); | ||
145 | int avc_ca_reset(struct firedtv *fdtv); | ||
146 | int avc_ca_pmt(struct firedtv *fdtv, char *app_info, int length); | ||
147 | int avc_ca_get_time_date(struct firedtv *fdtv, int *interval); | ||
148 | int avc_ca_enter_menu(struct firedtv *fdtv); | ||
149 | int avc_ca_get_mmi(struct firedtv *fdtv, char *mmi_object, unsigned int *len); | ||
150 | int cmp_establish_pp_connection(struct firedtv *fdtv, int plug, int channel); | ||
151 | void cmp_break_pp_connection(struct firedtv *fdtv, int plug, int channel); | ||
152 | |||
153 | /* firedtv-ci.c */ | ||
154 | int fdtv_ca_register(struct firedtv *fdtv); | ||
155 | void fdtv_ca_release(struct firedtv *fdtv); | ||
214 | 156 | ||
215 | /* firedtv-dvb.c */ | 157 | /* firedtv-dvb.c */ |
216 | int fdtv_start_feed(struct dvb_demux_feed *dvbdmxfeed); | 158 | int fdtv_start_feed(struct dvb_demux_feed *dvbdmxfeed); |
217 | int fdtv_stop_feed(struct dvb_demux_feed *dvbdmxfeed); | 159 | int fdtv_stop_feed(struct dvb_demux_feed *dvbdmxfeed); |
218 | int fdtv_dvbdev_init(struct firedtv *fdtv, struct device *dev); | 160 | int fdtv_dvb_register(struct firedtv *fdtv); |
161 | void fdtv_dvb_unregister(struct firedtv *fdtv); | ||
162 | struct firedtv *fdtv_alloc(struct device *dev, | ||
163 | const struct firedtv_backend *backend, | ||
164 | const char *name, size_t name_len); | ||
165 | extern const char *fdtv_model_names[]; | ||
219 | 166 | ||
220 | /* firedtv-fe.c */ | 167 | /* firedtv-fe.c */ |
221 | void fdtv_frontend_init(struct firedtv *fdtv); | 168 | void fdtv_frontend_init(struct firedtv *fdtv); |
222 | 169 | ||
223 | /* firedtv-iso.c */ | 170 | /* firedtv-rc.c */ |
224 | int setup_iso_channel(struct firedtv *fdtv); | 171 | #ifdef CONFIG_DVB_FIREDTV_INPUT |
225 | void tear_down_iso_channel(struct firedtv *fdtv); | 172 | int fdtv_register_rc(struct firedtv *fdtv, struct device *dev); |
173 | void fdtv_unregister_rc(struct firedtv *fdtv); | ||
174 | void fdtv_handle_rc(struct firedtv *fdtv, unsigned int code); | ||
175 | #else | ||
176 | static inline int fdtv_register_rc(struct firedtv *fdtv, | ||
177 | struct device *dev) { return 0; } | ||
178 | static inline void fdtv_unregister_rc(struct firedtv *fdtv) {} | ||
179 | static inline void fdtv_handle_rc(struct firedtv *fdtv, unsigned int code) {} | ||
180 | #endif | ||
226 | 181 | ||
227 | #endif /* _FIREDTV_H */ | 182 | #endif /* _FIREDTV_H */ |