Commit | Line | Data |
---|---|---|
c81c8b68 | 1 | /* |
87918334 | 2 | * FireDTV driver -- ieee1394 I/O backend |
c81c8b68 | 3 | * |
612262a5 SR |
4 | * Copyright (C) 2004 Andreas Monitzer <andy@monitzer.com> |
5 | * Copyright (C) 2007-2008 Ben Backx <ben@bbackx.com> | |
6 | * Copyright (C) 2008 Henrik Kurelid <henrik@kurelid.se> | |
c81c8b68 GKH |
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 | ||
612262a5 | 14 | #include <linux/device.h> |
c81c8b68 | 15 | #include <linux/errno.h> |
612262a5 SR |
16 | #include <linux/kernel.h> |
17 | #include <linux/list.h> | |
5a0e3ad6 | 18 | #include <linux/slab.h> |
612262a5 | 19 | #include <linux/spinlock.h> |
612262a5 | 20 | #include <linux/types.h> |
612262a5 | 21 | |
15490795 | 22 | #include <dma.h> |
612262a5 | 23 | #include <csr1212.h> |
c81c8b68 | 24 | #include <highlevel.h> |
c81c8b68 | 25 | #include <hosts.h> |
15490795 SR |
26 | #include <ieee1394.h> |
27 | #include <iso.h> | |
612262a5 | 28 | #include <nodemgr.h> |
c81c8b68 | 29 | |
6e25abb5 SR |
30 | #include <dvb_demux.h> |
31 | ||
a70f81c1 | 32 | #include "firedtv.h" |
c81c8b68 | 33 | |
15490795 SR |
34 | static LIST_HEAD(node_list); |
35 | static DEFINE_SPINLOCK(node_list_lock); | |
c81c8b68 | 36 | |
6e25abb5 SR |
37 | #define CIP_HEADER_SIZE 8 |
38 | #define MPEG2_TS_HEADER_SIZE 4 | |
39 | #define MPEG2_TS_SOURCE_PACKET_SIZE (4 + 188) | |
c81c8b68 | 40 | |
15490795 | 41 | static void rawiso_activity_cb(struct hpsb_iso *iso) |
c81c8b68 | 42 | { |
15490795 SR |
43 | struct firedtv *f, *fdtv = NULL; |
44 | unsigned int i, num, packet; | |
45 | unsigned char *buf; | |
c81c8b68 | 46 | unsigned long flags; |
15490795 SR |
47 | int count; |
48 | ||
49 | spin_lock_irqsave(&node_list_lock, flags); | |
50 | list_for_each_entry(f, &node_list, list) | |
51 | if (f->backend_data == iso) { | |
52 | fdtv = f; | |
53 | break; | |
54 | } | |
55 | spin_unlock_irqrestore(&node_list_lock, flags); | |
56 | ||
57 | packet = iso->first_packet; | |
58 | num = hpsb_iso_n_ready(iso); | |
59 | ||
60 | if (!fdtv) { | |
61 | dev_err(fdtv->device, "received at unknown iso channel\n"); | |
62 | goto out; | |
63 | } | |
c81c8b68 | 64 | |
15490795 SR |
65 | for (i = 0; i < num; i++, packet = (packet + 1) % iso->buf_packets) { |
66 | buf = dma_region_i(&iso->data_buf, unsigned char, | |
67 | iso->infos[packet].offset + CIP_HEADER_SIZE); | |
68 | count = (iso->infos[packet].len - CIP_HEADER_SIZE) / | |
6e25abb5 | 69 | MPEG2_TS_SOURCE_PACKET_SIZE; |
15490795 SR |
70 | |
71 | /* ignore empty packet */ | |
72 | if (iso->infos[packet].len <= CIP_HEADER_SIZE) | |
73 | continue; | |
74 | ||
75 | while (count--) { | |
6e25abb5 | 76 | if (buf[MPEG2_TS_HEADER_SIZE] == 0x47) |
15490795 | 77 | dvb_dmx_swfilter_packets(&fdtv->demux, |
6e25abb5 | 78 | &buf[MPEG2_TS_HEADER_SIZE], 1); |
15490795 SR |
79 | else |
80 | dev_err(fdtv->device, | |
81 | "skipping invalid packet\n"); | |
6e25abb5 | 82 | buf += MPEG2_TS_SOURCE_PACKET_SIZE; |
c81c8b68 | 83 | } |
15490795 SR |
84 | } |
85 | out: | |
86 | hpsb_iso_recv_release_packets(iso, num); | |
87 | } | |
88 | ||
89 | static inline struct node_entry *node_of(struct firedtv *fdtv) | |
90 | { | |
91 | return container_of(fdtv->device, struct unit_directory, device)->ne; | |
92 | } | |
93 | ||
3fb80ef3 | 94 | static int node_lock(struct firedtv *fdtv, u64 addr, void *data) |
15490795 | 95 | { |
3fb80ef3 | 96 | quadlet_t *d = data; |
054286b1 SR |
97 | int ret; |
98 | ||
3fb80ef3 SR |
99 | ret = hpsb_node_lock(node_of(fdtv), addr, |
100 | EXTCODE_COMPARE_SWAP, &d[1], d[0]); | |
101 | d[0] = d[1]; | |
054286b1 SR |
102 | |
103 | return ret; | |
15490795 SR |
104 | } |
105 | ||
5375659a | 106 | static int node_read(struct firedtv *fdtv, u64 addr, void *data) |
15490795 | 107 | { |
5375659a | 108 | return hpsb_node_read(node_of(fdtv), addr, data, 4); |
15490795 SR |
109 | } |
110 | ||
111 | static int node_write(struct firedtv *fdtv, u64 addr, void *data, size_t len) | |
112 | { | |
113 | return hpsb_node_write(node_of(fdtv), addr, data, len); | |
114 | } | |
115 | ||
116 | #define FDTV_ISO_BUFFER_PACKETS 256 | |
117 | #define FDTV_ISO_BUFFER_SIZE (FDTV_ISO_BUFFER_PACKETS * 200) | |
118 | ||
119 | static int start_iso(struct firedtv *fdtv) | |
120 | { | |
121 | struct hpsb_iso *iso_handle; | |
122 | int ret; | |
123 | ||
124 | iso_handle = hpsb_iso_recv_init(node_of(fdtv)->host, | |
125 | FDTV_ISO_BUFFER_SIZE, FDTV_ISO_BUFFER_PACKETS, | |
126 | fdtv->isochannel, HPSB_ISO_DMA_DEFAULT, | |
127 | -1, /* stat.config.irq_interval */ | |
128 | rawiso_activity_cb); | |
129 | if (iso_handle == NULL) { | |
130 | dev_err(fdtv->device, "cannot initialize iso receive\n"); | |
131 | return -ENOMEM; | |
132 | } | |
133 | fdtv->backend_data = iso_handle; | |
134 | ||
135 | ret = hpsb_iso_recv_start(iso_handle, -1, -1, 0); | |
136 | if (ret != 0) { | |
137 | dev_err(fdtv->device, "cannot start iso receive\n"); | |
138 | hpsb_iso_shutdown(iso_handle); | |
139 | fdtv->backend_data = NULL; | |
140 | } | |
141 | return ret; | |
142 | } | |
143 | ||
144 | static void stop_iso(struct firedtv *fdtv) | |
145 | { | |
146 | struct hpsb_iso *iso_handle = fdtv->backend_data; | |
c81c8b68 | 147 | |
15490795 SR |
148 | if (iso_handle != NULL) { |
149 | hpsb_iso_stop(iso_handle); | |
150 | hpsb_iso_shutdown(iso_handle); | |
df4846c3 | 151 | } |
15490795 | 152 | fdtv->backend_data = NULL; |
c81c8b68 GKH |
153 | } |
154 | ||
15490795 SR |
155 | static const struct firedtv_backend fdtv_1394_backend = { |
156 | .lock = node_lock, | |
157 | .read = node_read, | |
158 | .write = node_write, | |
159 | .start_iso = start_iso, | |
160 | .stop_iso = stop_iso, | |
612262a5 SR |
161 | }; |
162 | ||
15490795 SR |
163 | static void fcp_request(struct hpsb_host *host, int nodeid, int direction, |
164 | int cts, u8 *data, size_t length) | |
c81c8b68 | 165 | { |
15490795 | 166 | struct firedtv *f, *fdtv = NULL; |
c81c8b68 | 167 | unsigned long flags; |
15490795 | 168 | int su; |
c81c8b68 | 169 | |
15490795 SR |
170 | if (length == 0 || (data[0] & 0xf0) != 0) |
171 | return; | |
f1bbb43a | 172 | |
15490795 SR |
173 | su = data[1] & 0x7; |
174 | ||
175 | spin_lock_irqsave(&node_list_lock, flags); | |
176 | list_for_each_entry(f, &node_list, list) | |
177 | if (node_of(f)->host == host && | |
178 | node_of(f)->nodeid == nodeid && | |
179 | (f->subunit == su || (f->subunit == 0 && su == 0x7))) { | |
180 | fdtv = f; | |
181 | break; | |
182 | } | |
183 | spin_unlock_irqrestore(&node_list_lock, flags); | |
8ae83cdf | 184 | |
15490795 SR |
185 | if (fdtv) |
186 | avc_recv(fdtv, data, length); | |
187 | } | |
188 | ||
189 | static int node_probe(struct device *dev) | |
190 | { | |
191 | struct unit_directory *ud = | |
192 | container_of(dev, struct unit_directory, device); | |
193 | struct firedtv *fdtv; | |
194 | int kv_len, err; | |
195 | void *kv_str; | |
8ae83cdf | 196 | |
b2ad41f9 SR |
197 | if (ud->model_name_kv) { |
198 | kv_len = (ud->model_name_kv->value.leaf.len - 2) * 4; | |
199 | kv_str = CSR1212_TEXTUAL_DESCRIPTOR_LEAF_DATA(ud->model_name_kv); | |
200 | } else { | |
201 | kv_len = 0; | |
202 | kv_str = NULL; | |
203 | } | |
15490795 SR |
204 | fdtv = fdtv_alloc(dev, &fdtv_1394_backend, kv_str, kv_len); |
205 | if (!fdtv) | |
206 | return -ENOMEM; | |
8ae83cdf SR |
207 | |
208 | /* | |
209 | * Work around a bug in udev's path_id script: Use the fw-host's dev | |
210 | * instead of the unit directory's dev as parent of the input device. | |
211 | */ | |
a70f81c1 | 212 | err = fdtv_register_rc(fdtv, dev->parent->parent); |
8ae83cdf SR |
213 | if (err) |
214 | goto fail_free; | |
215 | ||
15490795 SR |
216 | spin_lock_irq(&node_list_lock); |
217 | list_add_tail(&fdtv->list, &node_list); | |
218 | spin_unlock_irq(&node_list_lock); | |
8ae83cdf | 219 | |
a70f81c1 | 220 | err = avc_identify_subunit(fdtv); |
8ae83cdf SR |
221 | if (err) |
222 | goto fail; | |
c81c8b68 | 223 | |
15490795 | 224 | err = fdtv_dvb_register(fdtv); |
8ae83cdf SR |
225 | if (err) |
226 | goto fail; | |
c81c8b68 | 227 | |
a70f81c1 | 228 | avc_register_remote_control(fdtv); |
56411f49 | 229 | |
8ae83cdf | 230 | return 0; |
8ae83cdf | 231 | fail: |
15490795 | 232 | spin_lock_irq(&node_list_lock); |
a70f81c1 | 233 | list_del(&fdtv->list); |
15490795 | 234 | spin_unlock_irq(&node_list_lock); |
a70f81c1 | 235 | fdtv_unregister_rc(fdtv); |
8ae83cdf | 236 | fail_free: |
a70f81c1 | 237 | kfree(fdtv); |
56411f49 | 238 | |
8ae83cdf | 239 | return err; |
c81c8b68 GKH |
240 | } |
241 | ||
15490795 | 242 | static int node_remove(struct device *dev) |
c81c8b68 | 243 | { |
79510cdb | 244 | struct firedtv *fdtv = dev_get_drvdata(dev); |
c81c8b68 | 245 | |
15490795 SR |
246 | fdtv_dvb_unregister(fdtv); |
247 | ||
248 | spin_lock_irq(&node_list_lock); | |
a70f81c1 | 249 | list_del(&fdtv->list); |
15490795 | 250 | spin_unlock_irq(&node_list_lock); |
c81c8b68 | 251 | |
a70f81c1 | 252 | fdtv_unregister_rc(fdtv); |
a70f81c1 | 253 | kfree(fdtv); |
56411f49 | 254 | |
c81c8b68 GKH |
255 | return 0; |
256 | } | |
257 | ||
15490795 | 258 | static int node_update(struct unit_directory *ud) |
c81c8b68 | 259 | { |
79510cdb | 260 | struct firedtv *fdtv = dev_get_drvdata(&ud->device); |
c81c8b68 | 261 | |
a70f81c1 R |
262 | if (fdtv->isochannel >= 0) |
263 | cmp_establish_pp_connection(fdtv, fdtv->subunit, | |
264 | fdtv->isochannel); | |
c81c8b68 GKH |
265 | return 0; |
266 | } | |
267 | ||
a70f81c1 | 268 | static struct hpsb_protocol_driver fdtv_driver = { |
612262a5 | 269 | .name = "firedtv", |
87918334 | 270 | .id_table = fdtv_id_table, |
15490795 | 271 | .update = node_update, |
c81c8b68 | 272 | .driver = { |
15490795 SR |
273 | .probe = node_probe, |
274 | .remove = node_remove, | |
c81c8b68 GKH |
275 | }, |
276 | }; | |
277 | ||
a70f81c1 | 278 | static struct hpsb_highlevel fdtv_highlevel = { |
612262a5 SR |
279 | .name = "firedtv", |
280 | .fcp_request = fcp_request, | |
281 | }; | |
282 | ||
87918334 | 283 | int __init fdtv_1394_init(void) |
c81c8b68 GKH |
284 | { |
285 | int ret; | |
286 | ||
a70f81c1 R |
287 | hpsb_register_highlevel(&fdtv_highlevel); |
288 | ret = hpsb_register_protocol(&fdtv_driver); | |
c81c8b68 | 289 | if (ret) { |
612262a5 | 290 | printk(KERN_ERR "firedtv: failed to register protocol\n"); |
a70f81c1 | 291 | hpsb_unregister_highlevel(&fdtv_highlevel); |
612262a5 | 292 | } |
612262a5 | 293 | return ret; |
c81c8b68 GKH |
294 | } |
295 | ||
15490795 | 296 | void __exit fdtv_1394_exit(void) |
c81c8b68 | 297 | { |
a70f81c1 R |
298 | hpsb_unregister_protocol(&fdtv_driver); |
299 | hpsb_unregister_highlevel(&fdtv_highlevel); | |
c81c8b68 | 300 | } |