1 /*
2  * VIDEO MOTION CODECs internal API for video devices
3  *
4  * Interface for MJPEG (and maybe later MPEG/WAVELETS) codec's
5  * bound to a master device.
6  *
7  * (c) 2002 Wolfgang Scherr <scherr@net4you.at>
8  *
9  * $Id: videocodec.c,v 1.1.2.8 2003/03/29 07:16:04 rbultje Exp $
10  *
11  * ------------------------------------------------------------------------
12  *
13  * This program is free software; you can redistribute it and/or modify
14  * it under the terms of the GNU General Public License as published by
15  * the Free Software Foundation; either version 2 of the License, or
16  * (at your option) any later version.
17  *
18  * This program is distributed in the hope that it will be useful,
19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21  * GNU General Public License for more details.
22  *
23  * You should have received a copy of the GNU General Public License
24  * along with this program; if not, write to the Free Software
25  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26  *
27  * ------------------------------------------------------------------------
28  */
29 
30 #define VIDEOCODEC_VERSION "v0.2"
31 
32 #include <linux/kernel.h>
33 #include <linux/module.h>
34 #include <linux/init.h>
35 #include <linux/types.h>
36 #include <linux/slab.h>
37 
38 // kernel config is here (procfs flag)
39 
40 #ifdef CONFIG_PROC_FS
41 #include <linux/proc_fs.h>
42 #include <linux/seq_file.h>
43 #include <asm/uaccess.h>
44 #endif
45 
46 #include "videocodec.h"
47 
48 static int debug;
49 module_param(debug, int, 0);
50 MODULE_PARM_DESC(debug, "Debug level (0-4)");
51 
52 #define dprintk(num, format, args...) \
53 	do { \
54 		if (debug >= num) \
55 			printk(format, ##args); \
56 	} while (0)
57 
58 struct attached_list {
59 	struct videocodec *codec;
60 	struct attached_list *next;
61 };
62 
63 struct codec_list {
64 	const struct videocodec *codec;
65 	int attached;
66 	struct attached_list *list;
67 	struct codec_list *next;
68 };
69 
70 static struct codec_list *codeclist_top = NULL;
71 
72 /* ================================================= */
73 /* function prototypes of the master/slave interface */
74 /* ================================================= */
75 
76 struct videocodec *
77 videocodec_attach (struct videocodec_master *master)
78 {
79 	struct codec_list *h = codeclist_top;
80 	struct attached_list *a, *ptr;
81 	struct videocodec *codec;
82 	int res;
83 
84 	if (!master) {
85 		dprintk(1, KERN_ERR "videocodec_attach: no data\n");
86 		return NULL;
87 	}
88 
89 	dprintk(2,
90 		"videocodec_attach: '%s', flags %lx, magic %lx\n",
91 		master->name, master->flags, master->magic);
92 
93 	if (!h) {
94 		dprintk(1,
95 			KERN_ERR
96 			"videocodec_attach: no device available\n");
97 		return NULL;
98 	}
99 
100 	while (h) {
101 		// attach only if the slave has at least the flags
102 		// expected by the master
103 		if ((master->flags & h->codec->flags) == master->flags) {
104 			dprintk(4, "videocodec_attach: try '%s'\n",
105 				h->codec->name);
106 
107 			if (!try_module_get(h->codec->owner))
108 				return NULL;
109 
110 			codec = kmemdup(h->codec, sizeof(struct videocodec),
111 					GFP_KERNEL);
112 			if (!codec) {
113 				dprintk(1,
114 					KERN_ERR
115 					"videocodec_attach: no mem\n");
116 				goto out_module_put;
117 			}
118 
119 			snprintf(codec->name, sizeof(codec->name),
120 				 "%s[%d]", codec->name, h->attached);
121 			codec->master_data = master;
122 			res = codec->setup(codec);
123 			if (res == 0) {
124 				dprintk(3, "videocodec_attach '%s'\n",
125 					codec->name);
126 				ptr = kzalloc(sizeof(struct attached_list), GFP_KERNEL);
127 				if (!ptr) {
128 					dprintk(1,
129 						KERN_ERR
130 						"videocodec_attach: no memory\n");
131 					goto out_kfree;
132 				}
133 				ptr->codec = codec;
134 
135 				a = h->list;
136 				if (!a) {
137 					h->list = ptr;
138 					dprintk(4,
139 						"videocodec: first element\n");
140 				} else {
141 					while (a->next)
142 						a = a->next;	// find end
143 					a->next = ptr;
144 					dprintk(4,
145 						"videocodec: in after '%s'\n",
146 						h->codec->name);
147 				}
148 
149 				h->attached += 1;
150 				return codec;
151 			} else {
152 				kfree(codec);
153 			}
154 		}
155 		h = h->next;
156 	}
157 
158 	dprintk(1, KERN_ERR "videocodec_attach: no codec found!\n");
159 	return NULL;
160 
161  out_module_put:
162 	module_put(h->codec->owner);
163  out_kfree:
164 	kfree(codec);
165 	return NULL;
166 }
167 
168 int
169 videocodec_detach (struct videocodec *codec)
170 {
171 	struct codec_list *h = codeclist_top;
172 	struct attached_list *a, *prev;
173 	int res;
174 
175 	if (!codec) {
176 		dprintk(1, KERN_ERR "videocodec_detach: no data\n");
177 		return -EINVAL;
178 	}
179 
180 	dprintk(2,
181 		"videocodec_detach: '%s', type: %x, flags %lx, magic %lx\n",
182 		codec->name, codec->type, codec->flags, codec->magic);
183 
184 	if (!h) {
185 		dprintk(1,
186 			KERN_ERR "videocodec_detach: no device left...\n");
187 		return -ENXIO;
188 	}
189 
190 	while (h) {
191 		a = h->list;
192 		prev = NULL;
193 		while (a) {
194 			if (codec == a->codec) {
195 				res = a->codec->unset(a->codec);
196 				if (res >= 0) {
197 					dprintk(3,
198 						"videocodec_detach: '%s'\n",
199 						a->codec->name);
200 					a->codec->master_data = NULL;
201 				} else {
202 					dprintk(1,
203 						KERN_ERR
204 						"videocodec_detach: '%s'\n",
205 						a->codec->name);
206 					a->codec->master_data = NULL;
207 				}
208 				if (prev == NULL) {
209 					h->list = a->next;
210 					dprintk(4,
211 						"videocodec: delete first\n");
212 				} else {
213 					prev->next = a->next;
214 					dprintk(4,
215 						"videocodec: delete middle\n");
216 				}
217 				module_put(a->codec->owner);
218 				kfree(a->codec);
219 				kfree(a);
220 				h->attached -= 1;
221 				return 0;
222 			}
223 			prev = a;
224 			a = a->next;
225 		}
226 		h = h->next;
227 	}
228 
229 	dprintk(1, KERN_ERR "videocodec_detach: given codec not found!\n");
230 	return -EINVAL;
231 }
232 
233 int
234 videocodec_register (const struct videocodec *codec)
235 {
236 	struct codec_list *ptr, *h = codeclist_top;
237 
238 	if (!codec) {
239 		dprintk(1, KERN_ERR "videocodec_register: no data!\n");
240 		return -EINVAL;
241 	}
242 
243 	dprintk(2,
244 		"videocodec: register '%s', type: %x, flags %lx, magic %lx\n",
245 		codec->name, codec->type, codec->flags, codec->magic);
246 
247 	ptr = kzalloc(sizeof(struct codec_list), GFP_KERNEL);
248 	if (!ptr) {
249 		dprintk(1, KERN_ERR "videocodec_register: no memory\n");
250 		return -ENOMEM;
251 	}
252 	ptr->codec = codec;
253 
254 	if (!h) {
255 		codeclist_top = ptr;
256 		dprintk(4, "videocodec: hooked in as first element\n");
257 	} else {
258 		while (h->next)
259 			h = h->next;	// find the end
260 		h->next = ptr;
261 		dprintk(4, "videocodec: hooked in after '%s'\n",
262 			h->codec->name);
263 	}
264 
265 	return 0;
266 }
267 
268 int
269 videocodec_unregister (const struct videocodec *codec)
270 {
271 	struct codec_list *prev = NULL, *h = codeclist_top;
272 
273 	if (!codec) {
274 		dprintk(1, KERN_ERR "videocodec_unregister: no data!\n");
275 		return -EINVAL;
276 	}
277 
278 	dprintk(2,
279 		"videocodec: unregister '%s', type: %x, flags %lx, magic %lx\n",
280 		codec->name, codec->type, codec->flags, codec->magic);
281 
282 	if (!h) {
283 		dprintk(1,
284 			KERN_ERR
285 			"videocodec_unregister: no device left...\n");
286 		return -ENXIO;
287 	}
288 
289 	while (h) {
290 		if (codec == h->codec) {
291 			if (h->attached) {
292 				dprintk(1,
293 					KERN_ERR
294 					"videocodec: '%s' is used\n",
295 					h->codec->name);
296 				return -EBUSY;
297 			}
298 			dprintk(3, "videocodec: unregister '%s' is ok.\n",
299 				h->codec->name);
300 			if (prev == NULL) {
301 				codeclist_top = h->next;
302 				dprintk(4,
303 					"videocodec: delete first element\n");
304 			} else {
305 				prev->next = h->next;
306 				dprintk(4,
307 					"videocodec: delete middle element\n");
308 			}
309 			kfree(h);
310 			return 0;
311 		}
312 		prev = h;
313 		h = h->next;
314 	}
315 
316 	dprintk(1,
317 		KERN_ERR
318 		"videocodec_unregister: given codec not found!\n");
319 	return -EINVAL;
320 }
321 
322 #ifdef CONFIG_PROC_FS
323 static int proc_videocodecs_show(struct seq_file *m, void *v)
324 {
325 	struct codec_list *h = codeclist_top;
326 	struct attached_list *a;
327 
328 	seq_printf(m, "<S>lave or attached <M>aster name  type flags    magic    ");
329 	seq_printf(m, "(connected as)\n");
330 
331 	h = codeclist_top;
332 	while (h) {
333 		seq_printf(m, "S %32s %04x %08lx %08lx (TEMPLATE)\n",
334 			      h->codec->name, h->codec->type,
335 			      h->codec->flags, h->codec->magic);
336 		a = h->list;
337 		while (a) {
338 			seq_printf(m, "M %32s %04x %08lx %08lx (%s)\n",
339 				      a->codec->master_data->name,
340 				      a->codec->master_data->type,
341 				      a->codec->master_data->flags,
342 				      a->codec->master_data->magic,
343 				      a->codec->name);
344 			a = a->next;
345 		}
346 		h = h->next;
347 	}
348 
349 	return 0;
350 }
351 
352 static int proc_videocodecs_open(struct inode *inode, struct file *file)
353 {
354 	return single_open(file, proc_videocodecs_show, NULL);
355 }
356 
357 static const struct file_operations videocodecs_proc_fops = {
358 	.owner		= THIS_MODULE,
359 	.open		= proc_videocodecs_open,
360 	.read		= seq_read,
361 	.llseek		= seq_lseek,
362 	.release	= single_release,
363 };
364 #endif
365 
366 /* ===================== */
367 /* hook in driver module */
368 /* ===================== */
369 static int __init
370 videocodec_init (void)
371 {
372 #ifdef CONFIG_PROC_FS
373 	static struct proc_dir_entry *videocodec_proc_entry;
374 #endif
375 
376 	printk(KERN_INFO "Linux video codec intermediate layer: %s\n",
377 	       VIDEOCODEC_VERSION);
378 
379 #ifdef CONFIG_PROC_FS
380 	videocodec_proc_entry = proc_create("videocodecs", 0, NULL, &videocodecs_proc_fops);
381 	if (!videocodec_proc_entry) {
382 		dprintk(1, KERN_ERR "videocodec: can't init procfs.\n");
383 	}
384 #endif
385 	return 0;
386 }
387 
388 static void __exit
389 videocodec_exit (void)
390 {
391 #ifdef CONFIG_PROC_FS
392 	remove_proc_entry("videocodecs", NULL);
393 #endif
394 }
395 
396 EXPORT_SYMBOL(videocodec_attach);
397 EXPORT_SYMBOL(videocodec_detach);
398 EXPORT_SYMBOL(videocodec_register);
399 EXPORT_SYMBOL(videocodec_unregister);
400 
401 module_init(videocodec_init);
402 module_exit(videocodec_exit);
403 
404 MODULE_AUTHOR("Wolfgang Scherr <scherr@net4you.at>");
405 MODULE_DESCRIPTION("Intermediate API module for video codecs "
406 		   VIDEOCODEC_VERSION);
407 MODULE_LICENSE("GPL");
408