985 lines · 22.3 KB · C
RawDownload
/* * dvbdev.c * * Copyright (C) 2000 Ralph  Metzler <ralph@convergence.de> *                  & Marcus Metzler <marcus@convergence.de> *                    for convergence integrated media GmbH * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public License * as published by the Free Software Foundation; either version 2.1 * of the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the * GNU General Public License for more details. * */ #define pr_fmt(fmt) "dvbdev: " fmt #include <linux/types.h>#include <linux/errno.h>#include <linux/string.h>#include <linux/module.h>#include <linux/kernel.h>#include <linux/init.h>#include <linux/slab.h>#include <linux/device.h>#include <linux/fs.h>#include <linux/cdev.h>#include <linux/mutex.h>#include "dvbdev.h" /* Due to enum tuner_pad_index */#include <media/tuner.h> static DEFINE_MUTEX(dvbdev_mutex);static int dvbdev_debug; module_param(dvbdev_debug, int, 0644);MODULE_PARM_DESC(dvbdev_debug, "Turn on/off device debugging (default:off)."); #define dprintk(fmt, arg...) do {					\	if (dvbdev_debug)						\		printk(KERN_DEBUG pr_fmt("%s: " fmt),			\		       __func__, ##arg);				\} while (0) static LIST_HEAD(dvb_adapter_list);static DEFINE_MUTEX(dvbdev_register_lock); static const char * const dnames[] = {	"video", "audio", "sec", "frontend", "demux", "dvr", "ca",	"net", "osd"}; #ifdef CONFIG_DVB_DYNAMIC_MINORS#define MAX_DVB_MINORS		256#define DVB_MAX_IDS		MAX_DVB_MINORS#else#define DVB_MAX_IDS		4#define nums2minor(num, type, id)	((num << 6) | (id << 4) | type)#define MAX_DVB_MINORS		(DVB_MAX_ADAPTERS*64)#endif static struct class *dvb_class; static struct dvb_device *dvb_minors[MAX_DVB_MINORS];static DECLARE_RWSEM(minor_rwsem); static int dvb_device_open(struct inode *inode, struct file *file){	struct dvb_device *dvbdev; 	mutex_lock(&dvbdev_mutex);	down_read(&minor_rwsem);	dvbdev = dvb_minors[iminor(inode)]; 	if (dvbdev && dvbdev->fops) {		int err = 0;		const struct file_operations *new_fops; 		new_fops = fops_get(dvbdev->fops);		if (!new_fops)			goto fail;		file->private_data = dvbdev;		replace_fops(file, new_fops);		if (file->f_op->open)			err = file->f_op->open(inode, file);		up_read(&minor_rwsem);		mutex_unlock(&dvbdev_mutex);		return err;	}fail:	up_read(&minor_rwsem);	mutex_unlock(&dvbdev_mutex);	return -ENODEV;}  static const struct file_operations dvb_device_fops ={	.owner =	THIS_MODULE,	.open =		dvb_device_open,	.llseek =	noop_llseek,}; static struct cdev dvb_device_cdev; int dvb_generic_open(struct inode *inode, struct file *file){	struct dvb_device *dvbdev = file->private_data; 	if (!dvbdev)		return -ENODEV; 	if (!dvbdev->users)		return -EBUSY; 	if ((file->f_flags & O_ACCMODE) == O_RDONLY) {		if (!dvbdev->readers)			return -EBUSY;		dvbdev->readers--;	} else {		if (!dvbdev->writers)			return -EBUSY;		dvbdev->writers--;	} 	dvbdev->users--;	return 0;}EXPORT_SYMBOL(dvb_generic_open);  int dvb_generic_release(struct inode *inode, struct file *file){	struct dvb_device *dvbdev = file->private_data; 	if (!dvbdev)		return -ENODEV; 	if ((file->f_flags & O_ACCMODE) == O_RDONLY) {		dvbdev->readers++;	} else {		dvbdev->writers++;	} 	dvbdev->users++;	return 0;}EXPORT_SYMBOL(dvb_generic_release);  long dvb_generic_ioctl(struct file *file,		       unsigned int cmd, unsigned long arg){	struct dvb_device *dvbdev = file->private_data; 	if (!dvbdev)		return -ENODEV; 	if (!dvbdev->kernel_ioctl)		return -EINVAL; 	return dvb_usercopy(file, cmd, arg, dvbdev->kernel_ioctl);}EXPORT_SYMBOL(dvb_generic_ioctl);  static int dvbdev_get_free_id (struct dvb_adapter *adap, int type){	u32 id = 0; 	while (id < DVB_MAX_IDS) {		struct dvb_device *dev;		list_for_each_entry(dev, &adap->device_list, list_head)			if (dev->type == type && dev->id == id)				goto skip;		return id;skip:		id++;	}	return -ENFILE;} static void dvb_media_device_free(struct dvb_device *dvbdev){#if defined(CONFIG_MEDIA_CONTROLLER_DVB)	if (dvbdev->entity) {		media_device_unregister_entity(dvbdev->entity);		kfree(dvbdev->entity);		kfree(dvbdev->pads);		dvbdev->entity = NULL;		dvbdev->pads = NULL;	} 	if (dvbdev->tsout_entity) {		int i; 		for (i = 0; i < dvbdev->tsout_num_entities; i++) {			media_device_unregister_entity(&dvbdev->tsout_entity[i]);			kfree(dvbdev->tsout_entity[i].name);		}		kfree(dvbdev->tsout_entity);		kfree(dvbdev->tsout_pads);		dvbdev->tsout_entity = NULL;		dvbdev->tsout_pads = NULL; 		dvbdev->tsout_num_entities = 0;	} 	if (dvbdev->intf_devnode) {		media_devnode_remove(dvbdev->intf_devnode);		dvbdev->intf_devnode = NULL;	} 	if (dvbdev->adapter->conn) {		media_device_unregister_entity(dvbdev->adapter->conn);		dvbdev->adapter->conn = NULL;		kfree(dvbdev->adapter->conn_pads);		dvbdev->adapter->conn_pads = NULL;	}#endif} #if defined(CONFIG_MEDIA_CONTROLLER_DVB)static int dvb_create_tsout_entity(struct dvb_device *dvbdev,				    const char *name, int npads){	int i, ret = 0; 	dvbdev->tsout_pads = kcalloc(npads, sizeof(*dvbdev->tsout_pads),				     GFP_KERNEL);	if (!dvbdev->tsout_pads)		return -ENOMEM; 	dvbdev->tsout_entity = kcalloc(npads, sizeof(*dvbdev->tsout_entity),				       GFP_KERNEL);	if (!dvbdev->tsout_entity)		return -ENOMEM; 	dvbdev->tsout_num_entities = npads; 	for (i = 0; i < npads; i++) {		struct media_pad *pads = &dvbdev->tsout_pads[i];		struct media_entity *entity = &dvbdev->tsout_entity[i]; 		entity->name = kasprintf(GFP_KERNEL, "%s #%d", name, i);		if (!entity->name)			return -ENOMEM; 		entity->function = MEDIA_ENT_F_IO_DTV;		pads->flags = MEDIA_PAD_FL_SINK; 		ret = media_entity_pads_init(entity, 1, pads);		if (ret < 0)			return ret; 		ret = media_device_register_entity(dvbdev->adapter->mdev,						   entity);		if (ret < 0)			return ret;	}	return 0;} #define DEMUX_TSOUT	"demux-tsout"#define DVR_TSOUT	"dvr-tsout" static int dvb_create_media_entity(struct dvb_device *dvbdev,				   int type, int demux_sink_pads){	int i, ret, npads; 	switch (type) {	case DVB_DEVICE_FRONTEND:		npads = 2;		break;	case DVB_DEVICE_DVR:		ret = dvb_create_tsout_entity(dvbdev, DVR_TSOUT,					      demux_sink_pads);		return ret;	case DVB_DEVICE_DEMUX:		npads = 1 + demux_sink_pads;		ret = dvb_create_tsout_entity(dvbdev, DEMUX_TSOUT,					      demux_sink_pads);		if (ret < 0)			return ret;		break;	case DVB_DEVICE_CA:		npads = 2;		break;	case DVB_DEVICE_NET:		/*		 * We should be creating entities for the MPE/ULE		 * decapsulation hardware (or software implementation).		 *		 * However, the number of for the MPE/ULE decaps may not be		 * fixed. As we don't have yet dynamic support for PADs at		 * the Media Controller, let's not create the decap		 * entities yet.		 */		return 0;	default:		return 0;	} 	dvbdev->entity = kzalloc(sizeof(*dvbdev->entity), GFP_KERNEL);	if (!dvbdev->entity)		return -ENOMEM; 	dvbdev->entity->name = dvbdev->name; 	if (npads) {		dvbdev->pads = kcalloc(npads, sizeof(*dvbdev->pads),				       GFP_KERNEL);		if (!dvbdev->pads)			return -ENOMEM;	} 	switch (type) {	case DVB_DEVICE_FRONTEND:		dvbdev->entity->function = MEDIA_ENT_F_DTV_DEMOD;		dvbdev->pads[0].flags = MEDIA_PAD_FL_SINK;		dvbdev->pads[1].flags = MEDIA_PAD_FL_SOURCE;		break;	case DVB_DEVICE_DEMUX:		dvbdev->entity->function = MEDIA_ENT_F_TS_DEMUX;		dvbdev->pads[0].flags = MEDIA_PAD_FL_SINK;		for (i = 1; i < npads; i++)			dvbdev->pads[i].flags = MEDIA_PAD_FL_SOURCE;		break;	case DVB_DEVICE_CA:		dvbdev->entity->function = MEDIA_ENT_F_DTV_CA;		dvbdev->pads[0].flags = MEDIA_PAD_FL_SINK;		dvbdev->pads[1].flags = MEDIA_PAD_FL_SOURCE;		break;	default:		/* Should never happen, as the first switch prevents it */		kfree(dvbdev->entity);		kfree(dvbdev->pads);		dvbdev->entity = NULL;		dvbdev->pads = NULL;		return 0;	} 	if (npads) {		ret = media_entity_pads_init(dvbdev->entity, npads, dvbdev->pads);		if (ret)			return ret;	}	ret = media_device_register_entity(dvbdev->adapter->mdev,					   dvbdev->entity);	if (ret)		return ret; 	pr_info("%s: media entity '%s' registered.\n",		__func__, dvbdev->entity->name); 	return 0;}#endif static int dvb_register_media_device(struct dvb_device *dvbdev,				     int type, int minor,				     unsigned demux_sink_pads){#if defined(CONFIG_MEDIA_CONTROLLER_DVB)	struct media_link *link;	u32 intf_type;	int ret; 	if (!dvbdev->adapter->mdev)		return 0; 	ret = dvb_create_media_entity(dvbdev, type, demux_sink_pads);	if (ret)		return ret; 	switch (type) {	case DVB_DEVICE_FRONTEND:		intf_type = MEDIA_INTF_T_DVB_FE;		break;	case DVB_DEVICE_DEMUX:		intf_type = MEDIA_INTF_T_DVB_DEMUX;		break;	case DVB_DEVICE_DVR:		intf_type = MEDIA_INTF_T_DVB_DVR;		break;	case DVB_DEVICE_CA:		intf_type = MEDIA_INTF_T_DVB_CA;		break;	case DVB_DEVICE_NET:		intf_type = MEDIA_INTF_T_DVB_NET;		break;	default:		return 0;	} 	dvbdev->intf_devnode = media_devnode_create(dvbdev->adapter->mdev,						    intf_type, 0,						    DVB_MAJOR, minor); 	if (!dvbdev->intf_devnode)		return -ENOMEM; 	/*	 * Create the "obvious" link, e. g. the ones that represent	 * a direct association between an interface and an entity.	 * Other links should be created elsewhere, like:	 *		DVB FE intf    -> tuner	 *		DVB demux intf -> dvr	 */ 	if (!dvbdev->entity)		return 0; 	link = media_create_intf_link(dvbdev->entity, &dvbdev->intf_devnode->intf,				      MEDIA_LNK_FL_ENABLED);	if (!link)		return -ENOMEM;#endif	return 0;} int dvb_register_device(struct dvb_adapter *adap, struct dvb_device **pdvbdev,			const struct dvb_device *template, void *priv, int type,			int demux_sink_pads){	struct dvb_device *dvbdev;	struct file_operations *dvbdevfops;	struct device *clsdev;	int minor;	int id, ret; 	mutex_lock(&dvbdev_register_lock); 	if ((id = dvbdev_get_free_id (adap, type)) < 0){		mutex_unlock(&dvbdev_register_lock);		*pdvbdev = NULL;		pr_err("%s: couldn't find free device id\n", __func__);		return -ENFILE;	} 	*pdvbdev = dvbdev = kzalloc(sizeof(*dvbdev), GFP_KERNEL); 	if (!dvbdev){		mutex_unlock(&dvbdev_register_lock);		return -ENOMEM;	} 	dvbdevfops = kzalloc(sizeof(struct file_operations), GFP_KERNEL); 	if (!dvbdevfops){		kfree (dvbdev);		mutex_unlock(&dvbdev_register_lock);		return -ENOMEM;	} 	memcpy(dvbdev, template, sizeof(struct dvb_device));	dvbdev->type = type;	dvbdev->id = id;	dvbdev->adapter = adap;	dvbdev->priv = priv;	dvbdev->fops = dvbdevfops;	init_waitqueue_head (&dvbdev->wait_queue); 	memcpy(dvbdevfops, template->fops, sizeof(struct file_operations));	dvbdevfops->owner = adap->module; 	list_add_tail (&dvbdev->list_head, &adap->device_list); 	down_write(&minor_rwsem);#ifdef CONFIG_DVB_DYNAMIC_MINORS	for (minor = 0; minor < MAX_DVB_MINORS; minor++)		if (dvb_minors[minor] == NULL)			break; 	if (minor == MAX_DVB_MINORS) {		kfree(dvbdevfops);		kfree(dvbdev);		up_write(&minor_rwsem);		mutex_unlock(&dvbdev_register_lock);		return -EINVAL;	}#else	minor = nums2minor(adap->num, type, id);#endif 	dvbdev->minor = minor;	dvb_minors[minor] = dvbdev;	up_write(&minor_rwsem); 	ret = dvb_register_media_device(dvbdev, type, minor, demux_sink_pads);	if (ret) {		pr_err("%s: dvb_register_media_device failed to create the mediagraph\n",		      __func__); 

Lines 1–500 of 985.