1 /*
2  * FireDTV driver -- firewire I/O backend
3  */
4 
5 #include <linux/device.h>
6 #include <linux/errno.h>
7 #include <linux/firewire.h>
8 #include <linux/firewire-constants.h>
9 #include <linux/kernel.h>
10 #include <linux/list.h>
11 #include <linux/mm.h>
12 #include <linux/mod_devicetable.h>
13 #include <linux/module.h>
14 #include <linux/mutex.h>
15 #include <linux/slab.h>
16 #include <linux/spinlock.h>
17 #include <linux/string.h>
18 #include <linux/types.h>
19 #include <linux/wait.h>
20 #include <linux/workqueue.h>
21 
22 #include <asm/page.h>
23 
24 #include <media/dvb_demux.h>
25 
26 #include "firedtv.h"
27 
28 static LIST_HEAD(node_list);
29 static DEFINE_SPINLOCK(node_list_lock);
30 
31 static inline struct fw_device *device_of(struct firedtv *fdtv)
32 {
33 	return fw_device(fdtv->device->parent);
34 }
35 
36 static int node_req(struct firedtv *fdtv, u64 addr, void *data, size_t len,
37 		    int tcode)
38 {
39 	struct fw_device *device = device_of(fdtv);
40 	int rcode, generation = device->generation;
41 
42 	smp_rmb(); /* node_id vs. generation */
43 
44 	rcode = fw_run_transaction(device->card, tcode, device->node_id,
45 			generation, device->max_speed, addr, data, len);
46 
47 	return rcode != RCODE_COMPLETE ? -EIO : 0;
48 }
49 
50 int fdtv_lock(struct firedtv *fdtv, u64 addr, void *data)
51 {
52 	return node_req(fdtv, addr, data, 8, TCODE_LOCK_COMPARE_SWAP);
53 }
54 
55 int fdtv_read(struct firedtv *fdtv, u64 addr, void *data)
56 {
57 	return node_req(fdtv, addr, data, 4, TCODE_READ_QUADLET_REQUEST);
58 }
59 
60 int fdtv_write(struct firedtv *fdtv, u64 addr, void *data, size_t len)
61 {
62 	return node_req(fdtv, addr, data, len, TCODE_WRITE_BLOCK_REQUEST);
63 }
64 
65 #define ISO_HEADER_SIZE			4
66 #define CIP_HEADER_SIZE			8
67 #define MPEG2_TS_HEADER_SIZE		4
68 #define MPEG2_TS_SOURCE_PACKET_SIZE	(4 + 188)
69 
70 #define MAX_PACKET_SIZE		1024  /* 776, rounded up to 2^n */
71 #define PACKETS_PER_PAGE	(PAGE_SIZE / MAX_PACKET_SIZE)
72 #define N_PACKETS		64    /* buffer size */
73 #define N_PAGES			DIV_ROUND_UP(N_PACKETS, PACKETS_PER_PAGE)
74 #define IRQ_INTERVAL		16
75 
76 struct fdtv_ir_context {
77 	struct fw_iso_context *context;
78 	struct fw_iso_buffer buffer;
79 	int interrupt_packet;
80 	int current_packet;
81 	char *pages[N_PAGES];
82 };
83 
84 static int queue_iso(struct fdtv_ir_context *ctx, int index)
85 {
86 	struct fw_iso_packet p;
87 
88 	p.payload_length = MAX_PACKET_SIZE;
89 	p.interrupt = !(++ctx->interrupt_packet & (IRQ_INTERVAL - 1));
90 	p.skip = 0;
91 	p.header_length = ISO_HEADER_SIZE;
92 
93 	return fw_iso_context_queue(ctx->context, &p, &ctx->buffer,
94 				    index * MAX_PACKET_SIZE);
95 }
96 
97 static void handle_iso(struct fw_iso_context *context, u32 cycle,
98 		       size_t header_length, void *header, void *data)
99 {
100 	struct firedtv *fdtv = data;
101 	struct fdtv_ir_context *ctx = fdtv->ir_context;
102 	__be32 *h, *h_end;
103 	int length, err, i = ctx->current_packet;
104 	char *p, *p_end;
105 
106 	for (h = header, h_end = h + header_length / 4; h < h_end; h++) {
107 		length = be32_to_cpup(h) >> 16;
108 		if (unlikely(length > MAX_PACKET_SIZE)) {
109 			dev_err(fdtv->device, "length = %d\n", length);
110 			length = MAX_PACKET_SIZE;
111 		}
112 
113 		p = ctx->pages[i / PACKETS_PER_PAGE]
114 				+ (i % PACKETS_PER_PAGE) * MAX_PACKET_SIZE;
115 		p_end = p + length;
116 
117 		for (p += CIP_HEADER_SIZE + MPEG2_TS_HEADER_SIZE; p < p_end;
118 		     p += MPEG2_TS_SOURCE_PACKET_SIZE)
119 			dvb_dmx_swfilter_packets(&fdtv->demux, p, 1);
120 
121 		err = queue_iso(ctx, i);
122 		if (unlikely(err))
123 			dev_err(fdtv->device, "requeue failed\n");
124 
125 		i = (i + 1) & (N_PACKETS - 1);
126 	}
127 	fw_iso_context_queue_flush(ctx->context);
128 	ctx->current_packet = i;
129 }
130 
131 int fdtv_start_iso(struct firedtv *fdtv)
132 {
133 	struct fdtv_ir_context *ctx;
134 	struct fw_device *device = device_of(fdtv);
135 	int i, err;
136 
137 	ctx = kmalloc(sizeof(*ctx), GFP_KERNEL);
138 	if (!ctx)
139 		return -ENOMEM;
140 
141 	ctx->context = fw_iso_context_create(device->card,
142 			FW_ISO_CONTEXT_RECEIVE, fdtv->isochannel,
143 			device->max_speed, ISO_HEADER_SIZE, handle_iso, fdtv);
144 	if (IS_ERR(ctx->context)) {
145 		err = PTR_ERR(ctx->context);
146 		goto fail_free;
147 	}
148 
149 	err = fw_iso_buffer_init(&ctx->buffer, device->card,
150 				 N_PAGES, DMA_FROM_DEVICE);
151 	if (err)
152 		goto fail_context_destroy;
153 
154 	ctx->interrupt_packet = 0;
155 	ctx->current_packet = 0;
156 
157 	for (i = 0; i < N_PAGES; i++)
158 		ctx->pages[i] = page_address(ctx->buffer.pages[i]);
159 
160 	for (i = 0; i < N_PACKETS; i++) {
161 		err = queue_iso(ctx, i);
162 		if (err)
163 			goto fail;
164 	}
165 
166 	err = fw_iso_context_start(ctx->context, -1, 0,
167 				   FW_ISO_CONTEXT_MATCH_ALL_TAGS);
168 	if (err)
169 		goto fail;
170 
171 	fdtv->ir_context = ctx;
172 
173 	return 0;
174 fail:
175 	fw_iso_buffer_destroy(&ctx->buffer, device->card);
176 fail_context_destroy:
177 	fw_iso_context_destroy(ctx->context);
178 fail_free:
179 	kfree(ctx);
180 
181 	return err;
182 }
183 
184 void fdtv_stop_iso(struct firedtv *fdtv)
185 {
186 	struct fdtv_ir_context *ctx = fdtv->ir_context;
187 
188 	fw_iso_context_stop(ctx->context);
189 	fw_iso_buffer_destroy(&ctx->buffer, device_of(fdtv)->card);
190 	fw_iso_context_destroy(ctx->context);
191 	kfree(ctx);
192 }
193 
194 static void handle_fcp(struct fw_card *card, struct fw_request *request,
195 		       int tcode, int destination, int source, int generation,
196 		       unsigned long long offset, void *payload, size_t length,
197 		       void *callback_data)
198 {
199 	struct firedtv *f, *fdtv = NULL;
200 	struct fw_device *device;
201 	unsigned long flags;
202 	int su;
203 
204 	if (length < 2 || (((u8 *)payload)[0] & 0xf0) != 0)
205 		return;
206 
207 	su = ((u8 *)payload)[1] & 0x7;
208 
209 	spin_lock_irqsave(&node_list_lock, flags);
210 	list_for_each_entry(f, &node_list, list) {
211 		device = device_of(f);
212 		if (device->generation != generation)
213 			continue;
214 
215 		smp_rmb(); /* node_id vs. generation */
216 
217 		if (device->card == card &&
218 		    device->node_id == source &&
219 		    (f->subunit == su || (f->subunit == 0 && su == 0x7))) {
220 			fdtv = f;
221 			break;
222 		}
223 	}
224 	spin_unlock_irqrestore(&node_list_lock, flags);
225 
226 	if (fdtv)
227 		avc_recv(fdtv, payload, length);
228 }
229 
230 static struct fw_address_handler fcp_handler = {
231 	.length           = CSR_FCP_END - CSR_FCP_RESPONSE,
232 	.address_callback = handle_fcp,
233 };
234 
235 static const struct fw_address_region fcp_region = {
236 	.start	= CSR_REGISTER_BASE + CSR_FCP_RESPONSE,
237 	.end	= CSR_REGISTER_BASE + CSR_FCP_END,
238 };
239 
240 static const char * const model_names[] = {
241 	[FIREDTV_UNKNOWN] = "unknown type",
242 	[FIREDTV_DVB_S]   = "FireDTV S/CI",
243 	[FIREDTV_DVB_C]   = "FireDTV C/CI",
244 	[FIREDTV_DVB_T]   = "FireDTV T/CI",
245 	[FIREDTV_DVB_S2]  = "FireDTV S2  ",
246 };
247 
248 /* Adjust the template string if models with longer names appear. */
249 #define MAX_MODEL_NAME_LEN sizeof("FireDTV ????")
250 
251 static int node_probe(struct fw_unit *unit, const struct ieee1394_device_id *id)
252 {
253 	struct firedtv *fdtv;
254 	char name[MAX_MODEL_NAME_LEN];
255 	int name_len, i, err;
256 
257 	fdtv = kzalloc(sizeof(*fdtv), GFP_KERNEL);
258 	if (!fdtv)
259 		return -ENOMEM;
260 
261 	dev_set_drvdata(&unit->device, fdtv);
262 	fdtv->device		= &unit->device;
263 	fdtv->isochannel	= -1;
264 	fdtv->voltage		= 0xff;
265 	fdtv->tone		= 0xff;
266 
267 	mutex_init(&fdtv->avc_mutex);
268 	init_waitqueue_head(&fdtv->avc_wait);
269 	mutex_init(&fdtv->demux_mutex);
270 	INIT_WORK(&fdtv->remote_ctrl_work, avc_remote_ctrl_work);
271 
272 	name_len = fw_csr_string(unit->directory, CSR_MODEL,
273 				 name, sizeof(name));
274 	for (i = ARRAY_SIZE(model_names); --i; )
275 		if (strlen(model_names[i]) <= name_len &&
276 		    strncmp(name, model_names[i], name_len) == 0)
277 			break;
278 	fdtv->type = i;
279 
280 	err = fdtv_register_rc(fdtv, &unit->device);
281 	if (err)
282 		goto fail_free;
283 
284 	spin_lock_irq(&node_list_lock);
285 	list_add_tail(&fdtv->list, &node_list);
286 	spin_unlock_irq(&node_list_lock);
287 
288 	err = avc_identify_subunit(fdtv);
289 	if (err)
290 		goto fail;
291 
292 	err = fdtv_dvb_register(fdtv, model_names[fdtv->type]);
293 	if (err)
294 		goto fail;
295 
296 	avc_register_remote_control(fdtv);
297 
298 	return 0;
299 fail:
300 	spin_lock_irq(&node_list_lock);
301 	list_del(&fdtv->list);
302 	spin_unlock_irq(&node_list_lock);
303 	fdtv_unregister_rc(fdtv);
304 fail_free:
305 	kfree(fdtv);
306 
307 	return err;
308 }
309 
310 static void node_remove(struct fw_unit *unit)
311 {
312 	struct firedtv *fdtv = dev_get_drvdata(&unit->device);
313 
314 	fdtv_dvb_unregister(fdtv);
315 
316 	spin_lock_irq(&node_list_lock);
317 	list_del(&fdtv->list);
318 	spin_unlock_irq(&node_list_lock);
319 
320 	fdtv_unregister_rc(fdtv);
321 
322 	kfree(fdtv);
323 }
324 
325 static void node_update(struct fw_unit *unit)
326 {
327 	struct firedtv *fdtv = dev_get_drvdata(&unit->device);
328 
329 	if (fdtv->isochannel >= 0)
330 		cmp_establish_pp_connection(fdtv, fdtv->subunit,
331 					    fdtv->isochannel);
332 }
333 
334 #define MATCH_FLAGS (IEEE1394_MATCH_VENDOR_ID | IEEE1394_MATCH_MODEL_ID | \
335 		     IEEE1394_MATCH_SPECIFIER_ID | IEEE1394_MATCH_VERSION)
336 
337 #define DIGITAL_EVERYWHERE_OUI	0x001287
338 #define AVC_UNIT_SPEC_ID_ENTRY	0x00a02d
339 #define AVC_SW_VERSION_ENTRY	0x010001
340 
341 static const struct ieee1394_device_id fdtv_id_table[] = {
342 	{
343 		/* FloppyDTV S/CI and FloppyDTV S2 */
344 		.match_flags	= MATCH_FLAGS,
345 		.vendor_id	= DIGITAL_EVERYWHERE_OUI,
346 		.model_id	= 0x000024,
347 		.specifier_id	= AVC_UNIT_SPEC_ID_ENTRY,
348 		.version	= AVC_SW_VERSION_ENTRY,
349 	}, {
350 		/* FloppyDTV T/CI */
351 		.match_flags	= MATCH_FLAGS,
352 		.vendor_id	= DIGITAL_EVERYWHERE_OUI,
353 		.model_id	= 0x000025,
354 		.specifier_id	= AVC_UNIT_SPEC_ID_ENTRY,
355 		.version	= AVC_SW_VERSION_ENTRY,
356 	}, {
357 		/* FloppyDTV C/CI */
358 		.match_flags	= MATCH_FLAGS,
359 		.vendor_id	= DIGITAL_EVERYWHERE_OUI,
360 		.model_id	= 0x000026,
361 		.specifier_id	= AVC_UNIT_SPEC_ID_ENTRY,
362 		.version	= AVC_SW_VERSION_ENTRY,
363 	}, {
364 		/* FireDTV S/CI and FloppyDTV S2 */
365 		.match_flags	= MATCH_FLAGS,
366 		.vendor_id	= DIGITAL_EVERYWHERE_OUI,
367 		.model_id	= 0x000034,
368 		.specifier_id	= AVC_UNIT_SPEC_ID_ENTRY,
369 		.version	= AVC_SW_VERSION_ENTRY,
370 	}, {
371 		/* FireDTV T/CI */
372 		.match_flags	= MATCH_FLAGS,
373 		.vendor_id	= DIGITAL_EVERYWHERE_OUI,
374 		.model_id	= 0x000035,
375 		.specifier_id	= AVC_UNIT_SPEC_ID_ENTRY,
376 		.version	= AVC_SW_VERSION_ENTRY,
377 	}, {
378 		/* FireDTV C/CI */
379 		.match_flags	= MATCH_FLAGS,
380 		.vendor_id	= DIGITAL_EVERYWHERE_OUI,
381 		.model_id	= 0x000036,
382 		.specifier_id	= AVC_UNIT_SPEC_ID_ENTRY,
383 		.version	= AVC_SW_VERSION_ENTRY,
384 	}, {}
385 };
386 MODULE_DEVICE_TABLE(ieee1394, fdtv_id_table);
387 
388 static struct fw_driver fdtv_driver = {
389 	.driver   = {
390 		.owner  = THIS_MODULE,
391 		.name   = "firedtv",
392 		.bus    = &fw_bus_type,
393 	},
394 	.probe    = node_probe,
395 	.update   = node_update,
396 	.remove   = node_remove,
397 	.id_table = fdtv_id_table,
398 };
399 
400 static int __init fdtv_init(void)
401 {
402 	int ret;
403 
404 	ret = fw_core_add_address_handler(&fcp_handler, &fcp_region);
405 	if (ret < 0)
406 		return ret;
407 
408 	ret = driver_register(&fdtv_driver.driver);
409 	if (ret < 0)
410 		fw_core_remove_address_handler(&fcp_handler);
411 
412 	return ret;
413 }
414 
415 static void __exit fdtv_exit(void)
416 {
417 	driver_unregister(&fdtv_driver.driver);
418 	fw_core_remove_address_handler(&fcp_handler);
419 }
420 
421 module_init(fdtv_init);
422 module_exit(fdtv_exit);
423 
424 MODULE_AUTHOR("Andreas Monitzer <andy@monitzer.com>");
425 MODULE_AUTHOR("Ben Backx <ben@bbackx.com>");
426 MODULE_DESCRIPTION("FireDTV DVB Driver");
427 MODULE_LICENSE("GPL");
428 MODULE_SUPPORTED_DEVICE("FireDTV DVB");
429