Cai Huoqing | 8d395ce | 2021-09-16 03:00:18 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: LGPL-2.1-or-later |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | /* |
| 3 | * dvbdev.c |
| 4 | * |
| 5 | * Copyright (C) 2000 Ralph Metzler <ralph@convergence.de> |
| 6 | * & Marcus Metzler <marcus@convergence.de> |
| 7 | * for convergence integrated media GmbH |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 | */ |
| 9 | |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 10 | #define pr_fmt(fmt) "dvbdev: " fmt |
| 11 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | #include <linux/types.h> |
| 13 | #include <linux/errno.h> |
| 14 | #include <linux/string.h> |
| 15 | #include <linux/module.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <linux/kernel.h> |
Mauro Carvalho Chehab | 8f569c0 | 2018-03-02 10:21:16 -0500 | [diff] [blame] | 17 | #include <linux/i2c.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 18 | #include <linux/init.h> |
| 19 | #include <linux/slab.h> |
| 20 | #include <linux/device.h> |
| 21 | #include <linux/fs.h> |
| 22 | #include <linux/cdev.h> |
Ingo Molnar | 1e4baed | 2006-01-15 07:52:23 -0200 | [diff] [blame] | 23 | #include <linux/mutex.h> |
Mauro Carvalho Chehab | fada193 | 2017-12-28 13:03:51 -0500 | [diff] [blame] | 24 | #include <media/dvbdev.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | |
Mauro Carvalho Chehab | 188d2d5 | 2015-08-31 13:23:03 -0300 | [diff] [blame] | 26 | /* Due to enum tuner_pad_index */ |
| 27 | #include <media/tuner.h> |
| 28 | |
Arnd Bergmann | 72024f1 | 2010-09-11 19:56:45 +0200 | [diff] [blame] | 29 | static DEFINE_MUTEX(dvbdev_mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | static int dvbdev_debug; |
| 31 | |
| 32 | module_param(dvbdev_debug, int, 0644); |
| 33 | MODULE_PARM_DESC(dvbdev_debug, "Turn on/off device debugging (default:off)."); |
| 34 | |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 35 | #define dprintk(fmt, arg...) do { \ |
| 36 | if (dvbdev_debug) \ |
| 37 | printk(KERN_DEBUG pr_fmt("%s: " fmt), \ |
| 38 | __func__, ##arg); \ |
| 39 | } while (0) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | |
| 41 | static LIST_HEAD(dvb_adapter_list); |
Ingo Molnar | 1e4baed | 2006-01-15 07:52:23 -0200 | [diff] [blame] | 42 | static DEFINE_MUTEX(dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | |
| 44 | static const char * const dnames[] = { |
Mauro Carvalho Chehab | 6bbf7a8 | 2017-09-19 14:22:19 -0400 | [diff] [blame] | 45 | [DVB_DEVICE_VIDEO] = "video", |
| 46 | [DVB_DEVICE_AUDIO] = "audio", |
| 47 | [DVB_DEVICE_SEC] = "sec", |
| 48 | [DVB_DEVICE_FRONTEND] = "frontend", |
| 49 | [DVB_DEVICE_DEMUX] = "demux", |
| 50 | [DVB_DEVICE_DVR] = "dvr", |
| 51 | [DVB_DEVICE_CA] = "ca", |
| 52 | [DVB_DEVICE_NET] = "net", |
| 53 | [DVB_DEVICE_OSD] = "osd" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 | }; |
| 55 | |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 56 | #ifdef CONFIG_DVB_DYNAMIC_MINORS |
| 57 | #define MAX_DVB_MINORS 256 |
| 58 | #define DVB_MAX_IDS MAX_DVB_MINORS |
| 59 | #else |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 | #define DVB_MAX_IDS 4 |
Mauro Carvalho Chehab | 6bbf7a8 | 2017-09-19 14:22:19 -0400 | [diff] [blame] | 61 | |
Mauro Carvalho Chehab | 8382e55 | 2017-10-11 15:29:46 -0400 | [diff] [blame] | 62 | static const u8 minor_type[] = { |
| 63 | [DVB_DEVICE_VIDEO] = 0, |
| 64 | [DVB_DEVICE_AUDIO] = 1, |
| 65 | [DVB_DEVICE_SEC] = 2, |
| 66 | [DVB_DEVICE_FRONTEND] = 3, |
| 67 | [DVB_DEVICE_DEMUX] = 4, |
| 68 | [DVB_DEVICE_DVR] = 5, |
| 69 | [DVB_DEVICE_CA] = 6, |
| 70 | [DVB_DEVICE_NET] = 7, |
| 71 | [DVB_DEVICE_OSD] = 8, |
| 72 | }; |
Mauro Carvalho Chehab | 6bbf7a8 | 2017-09-19 14:22:19 -0400 | [diff] [blame] | 73 | |
Mauro Carvalho Chehab | 8382e55 | 2017-10-11 15:29:46 -0400 | [diff] [blame] | 74 | #define nums2minor(num, type, id) \ |
| 75 | (((num) << 6) | ((id) << 4) | minor_type[type]) |
Mauro Carvalho Chehab | 6bbf7a8 | 2017-09-19 14:22:19 -0400 | [diff] [blame] | 76 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | #define MAX_DVB_MINORS (DVB_MAX_ADAPTERS*64) |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 78 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 | |
gregkh@suse.de | 56b2293 | 2005-03-23 10:01:41 -0800 | [diff] [blame] | 80 | static struct class *dvb_class; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 82 | static struct dvb_device *dvb_minors[MAX_DVB_MINORS]; |
| 83 | static DECLARE_RWSEM(minor_rwsem); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | |
| 85 | static int dvb_device_open(struct inode *inode, struct file *file) |
| 86 | { |
| 87 | struct dvb_device *dvbdev; |
| 88 | |
Arnd Bergmann | 72024f1 | 2010-09-11 19:56:45 +0200 | [diff] [blame] | 89 | mutex_lock(&dvbdev_mutex); |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 90 | down_read(&minor_rwsem); |
| 91 | dvbdev = dvb_minors[iminor(inode)]; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 92 | |
| 93 | if (dvbdev && dvbdev->fops) { |
| 94 | int err = 0; |
Al Viro | e84f9e5 | 2013-09-22 14:17:15 -0400 | [diff] [blame] | 95 | const struct file_operations *new_fops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 | |
Al Viro | e84f9e5 | 2013-09-22 14:17:15 -0400 | [diff] [blame] | 97 | new_fops = fops_get(dvbdev->fops); |
| 98 | if (!new_fops) |
Laurent Pinchart | f41ced8 | 2009-01-06 14:40:40 -0800 | [diff] [blame] | 99 | goto fail; |
Al Viro | e84f9e5 | 2013-09-22 14:17:15 -0400 | [diff] [blame] | 100 | file->private_data = dvbdev; |
| 101 | replace_fops(file, new_fops); |
| 102 | if (file->f_op->open) |
Xiubo Li | 0ede187 | 2016-01-15 03:14:59 -0200 | [diff] [blame] | 103 | err = file->f_op->open(inode, file); |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 104 | up_read(&minor_rwsem); |
Arnd Bergmann | 72024f1 | 2010-09-11 19:56:45 +0200 | [diff] [blame] | 105 | mutex_unlock(&dvbdev_mutex); |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 106 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 107 | } |
Laurent Pinchart | f41ced8 | 2009-01-06 14:40:40 -0800 | [diff] [blame] | 108 | fail: |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 109 | up_read(&minor_rwsem); |
Arnd Bergmann | 72024f1 | 2010-09-11 19:56:45 +0200 | [diff] [blame] | 110 | mutex_unlock(&dvbdev_mutex); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 111 | return -ENODEV; |
| 112 | } |
| 113 | |
| 114 | |
Jan Engelhardt | 27a643b | 2008-04-22 14:42:01 -0300 | [diff] [blame] | 115 | static const struct file_operations dvb_device_fops = |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | { |
| 117 | .owner = THIS_MODULE, |
| 118 | .open = dvb_device_open, |
Arnd Bergmann | 6038f37 | 2010-08-15 18:52:59 +0200 | [diff] [blame] | 119 | .llseek = noop_llseek, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | }; |
| 121 | |
Greg Kroah-Hartman | 7e7654a | 2007-09-12 15:06:57 -0700 | [diff] [blame] | 122 | static struct cdev dvb_device_cdev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 123 | |
| 124 | int dvb_generic_open(struct inode *inode, struct file *file) |
| 125 | { |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 126 | struct dvb_device *dvbdev = file->private_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 128 | if (!dvbdev) |
| 129 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | |
| 131 | if (!dvbdev->users) |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 132 | return -EBUSY; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 133 | |
| 134 | if ((file->f_flags & O_ACCMODE) == O_RDONLY) { |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 135 | if (!dvbdev->readers) |
| 136 | return -EBUSY; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 137 | dvbdev->readers--; |
| 138 | } else { |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 139 | if (!dvbdev->writers) |
| 140 | return -EBUSY; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | dvbdev->writers--; |
| 142 | } |
| 143 | |
| 144 | dvbdev->users--; |
| 145 | return 0; |
| 146 | } |
| 147 | EXPORT_SYMBOL(dvb_generic_open); |
| 148 | |
| 149 | |
| 150 | int dvb_generic_release(struct inode *inode, struct file *file) |
| 151 | { |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 152 | struct dvb_device *dvbdev = file->private_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | |
| 154 | if (!dvbdev) |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 155 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 156 | |
| 157 | if ((file->f_flags & O_ACCMODE) == O_RDONLY) { |
| 158 | dvbdev->readers++; |
| 159 | } else { |
| 160 | dvbdev->writers++; |
| 161 | } |
| 162 | |
| 163 | dvbdev->users++; |
| 164 | return 0; |
| 165 | } |
| 166 | EXPORT_SYMBOL(dvb_generic_release); |
| 167 | |
| 168 | |
Arnd Bergmann | 16ef8de | 2010-04-27 00:24:00 +0200 | [diff] [blame] | 169 | long dvb_generic_ioctl(struct file *file, |
| 170 | unsigned int cmd, unsigned long arg) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 171 | { |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 172 | struct dvb_device *dvbdev = file->private_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 173 | |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 174 | if (!dvbdev) |
| 175 | return -ENODEV; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 176 | |
| 177 | if (!dvbdev->kernel_ioctl) |
| 178 | return -EINVAL; |
| 179 | |
Arnd Bergmann | 72024f1 | 2010-09-11 19:56:45 +0200 | [diff] [blame] | 180 | return dvb_usercopy(file, cmd, arg, dvbdev->kernel_ioctl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 181 | } |
| 182 | EXPORT_SYMBOL(dvb_generic_ioctl); |
| 183 | |
| 184 | |
| 185 | static int dvbdev_get_free_id (struct dvb_adapter *adap, int type) |
| 186 | { |
| 187 | u32 id = 0; |
| 188 | |
| 189 | while (id < DVB_MAX_IDS) { |
Trent Piepho | 7948261 | 2007-10-10 05:37:39 -0300 | [diff] [blame] | 190 | struct dvb_device *dev; |
| 191 | list_for_each_entry(dev, &adap->device_list, list_head) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | if (dev->type == type && dev->id == id) |
| 193 | goto skip; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | return id; |
| 195 | skip: |
| 196 | id++; |
| 197 | } |
| 198 | return -ENFILE; |
| 199 | } |
| 200 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 201 | static void dvb_media_device_free(struct dvb_device *dvbdev) |
| 202 | { |
| 203 | #if defined(CONFIG_MEDIA_CONTROLLER_DVB) |
| 204 | if (dvbdev->entity) { |
| 205 | media_device_unregister_entity(dvbdev->entity); |
| 206 | kfree(dvbdev->entity); |
| 207 | kfree(dvbdev->pads); |
| 208 | dvbdev->entity = NULL; |
| 209 | dvbdev->pads = NULL; |
| 210 | } |
| 211 | |
| 212 | if (dvbdev->tsout_entity) { |
| 213 | int i; |
| 214 | |
| 215 | for (i = 0; i < dvbdev->tsout_num_entities; i++) { |
| 216 | media_device_unregister_entity(&dvbdev->tsout_entity[i]); |
| 217 | kfree(dvbdev->tsout_entity[i].name); |
| 218 | } |
| 219 | kfree(dvbdev->tsout_entity); |
| 220 | kfree(dvbdev->tsout_pads); |
| 221 | dvbdev->tsout_entity = NULL; |
| 222 | dvbdev->tsout_pads = NULL; |
| 223 | |
| 224 | dvbdev->tsout_num_entities = 0; |
| 225 | } |
| 226 | |
| 227 | if (dvbdev->intf_devnode) { |
| 228 | media_devnode_remove(dvbdev->intf_devnode); |
| 229 | dvbdev->intf_devnode = NULL; |
| 230 | } |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 231 | |
| 232 | if (dvbdev->adapter->conn) { |
| 233 | media_device_unregister_entity(dvbdev->adapter->conn); |
Peilin Ye | bf9a40a | 2020-12-11 09:30:39 +0100 | [diff] [blame] | 234 | kfree(dvbdev->adapter->conn); |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 235 | dvbdev->adapter->conn = NULL; |
| 236 | kfree(dvbdev->adapter->conn_pads); |
| 237 | dvbdev->adapter->conn_pads = NULL; |
| 238 | } |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 239 | #endif |
| 240 | } |
| 241 | |
Mauro Carvalho Chehab | 0820eb5 | 2015-12-28 10:30:06 -0200 | [diff] [blame] | 242 | #if defined(CONFIG_MEDIA_CONTROLLER_DVB) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 243 | static int dvb_create_tsout_entity(struct dvb_device *dvbdev, |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 244 | const char *name, int npads) |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 245 | { |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 246 | int i, ret = 0; |
| 247 | |
| 248 | dvbdev->tsout_pads = kcalloc(npads, sizeof(*dvbdev->tsout_pads), |
| 249 | GFP_KERNEL); |
| 250 | if (!dvbdev->tsout_pads) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 251 | return -ENOMEM; |
| 252 | |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 253 | dvbdev->tsout_entity = kcalloc(npads, sizeof(*dvbdev->tsout_entity), |
| 254 | GFP_KERNEL); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 255 | if (!dvbdev->tsout_entity) |
| 256 | return -ENOMEM; |
| 257 | |
| 258 | dvbdev->tsout_num_entities = npads; |
| 259 | |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 260 | for (i = 0; i < npads; i++) { |
| 261 | struct media_pad *pads = &dvbdev->tsout_pads[i]; |
| 262 | struct media_entity *entity = &dvbdev->tsout_entity[i]; |
| 263 | |
| 264 | entity->name = kasprintf(GFP_KERNEL, "%s #%d", name, i); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 265 | if (!entity->name) |
| 266 | return -ENOMEM; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 267 | |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 268 | entity->function = MEDIA_ENT_F_IO_DTV; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 269 | pads->flags = MEDIA_PAD_FL_SINK; |
| 270 | |
Mauro Carvalho Chehab | ab22e77 | 2015-12-11 07:44:40 -0200 | [diff] [blame] | 271 | ret = media_entity_pads_init(entity, 1, pads); |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 272 | if (ret < 0) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 273 | return ret; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 274 | |
| 275 | ret = media_device_register_entity(dvbdev->adapter->mdev, |
| 276 | entity); |
| 277 | if (ret < 0) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 278 | return ret; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 279 | } |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 280 | return 0; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 281 | } |
| 282 | |
| 283 | #define DEMUX_TSOUT "demux-tsout" |
| 284 | #define DVR_TSOUT "dvr-tsout" |
| 285 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 286 | static int dvb_create_media_entity(struct dvb_device *dvbdev, |
| 287 | int type, int demux_sink_pads) |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 288 | { |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 289 | int i, ret, npads; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 290 | |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 291 | switch (type) { |
| 292 | case DVB_DEVICE_FRONTEND: |
| 293 | npads = 2; |
| 294 | break; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 295 | case DVB_DEVICE_DVR: |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 296 | ret = dvb_create_tsout_entity(dvbdev, DVR_TSOUT, |
| 297 | demux_sink_pads); |
| 298 | return ret; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 299 | case DVB_DEVICE_DEMUX: |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 300 | npads = 1 + demux_sink_pads; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 301 | ret = dvb_create_tsout_entity(dvbdev, DEMUX_TSOUT, |
| 302 | demux_sink_pads); |
| 303 | if (ret < 0) |
| 304 | return ret; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 305 | break; |
| 306 | case DVB_DEVICE_CA: |
| 307 | npads = 2; |
| 308 | break; |
| 309 | case DVB_DEVICE_NET: |
| 310 | /* |
| 311 | * We should be creating entities for the MPE/ULE |
| 312 | * decapsulation hardware (or software implementation). |
| 313 | * |
| 314 | * However, the number of for the MPE/ULE decaps may not be |
| 315 | * fixed. As we don't have yet dynamic support for PADs at |
| 316 | * the Media Controller, let's not create the decap |
| 317 | * entities yet. |
| 318 | */ |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 319 | return 0; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 320 | default: |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 321 | return 0; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 322 | } |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 323 | |
| 324 | dvbdev->entity = kzalloc(sizeof(*dvbdev->entity), GFP_KERNEL); |
| 325 | if (!dvbdev->entity) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 326 | return -ENOMEM; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 327 | |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 328 | dvbdev->entity->name = dvbdev->name; |
Mauro Carvalho Chehab | 172e9d3 | 2015-01-03 01:59:53 -0300 | [diff] [blame] | 329 | |
Mauro Carvalho Chehab | 172e9d3 | 2015-01-03 01:59:53 -0300 | [diff] [blame] | 330 | if (npads) { |
| 331 | dvbdev->pads = kcalloc(npads, sizeof(*dvbdev->pads), |
| 332 | GFP_KERNEL); |
Wenwen Wang | fcd5ce4 | 2019-08-18 00:45:40 -0300 | [diff] [blame] | 333 | if (!dvbdev->pads) { |
| 334 | kfree(dvbdev->entity); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 335 | return -ENOMEM; |
Wenwen Wang | fcd5ce4 | 2019-08-18 00:45:40 -0300 | [diff] [blame] | 336 | } |
Mauro Carvalho Chehab | 172e9d3 | 2015-01-03 01:59:53 -0300 | [diff] [blame] | 337 | } |
| 338 | |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 339 | switch (type) { |
| 340 | case DVB_DEVICE_FRONTEND: |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 341 | dvbdev->entity->function = MEDIA_ENT_F_DTV_DEMOD; |
Mauro Carvalho Chehab | 3bde1b7 | 2015-01-03 16:35:53 -0300 | [diff] [blame] | 342 | dvbdev->pads[0].flags = MEDIA_PAD_FL_SINK; |
| 343 | dvbdev->pads[1].flags = MEDIA_PAD_FL_SOURCE; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 344 | break; |
| 345 | case DVB_DEVICE_DEMUX: |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 346 | dvbdev->entity->function = MEDIA_ENT_F_TS_DEMUX; |
Mauro Carvalho Chehab | 3bde1b7 | 2015-01-03 16:35:53 -0300 | [diff] [blame] | 347 | dvbdev->pads[0].flags = MEDIA_PAD_FL_SINK; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 348 | for (i = 1; i < npads; i++) |
| 349 | dvbdev->pads[i].flags = MEDIA_PAD_FL_SOURCE; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 350 | break; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 351 | case DVB_DEVICE_CA: |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 352 | dvbdev->entity->function = MEDIA_ENT_F_DTV_CA; |
Mauro Carvalho Chehab | 3bde1b7 | 2015-01-03 16:35:53 -0300 | [diff] [blame] | 353 | dvbdev->pads[0].flags = MEDIA_PAD_FL_SINK; |
| 354 | dvbdev->pads[1].flags = MEDIA_PAD_FL_SOURCE; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 355 | break; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 356 | default: |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 357 | /* Should never happen, as the first switch prevents it */ |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 358 | kfree(dvbdev->entity); |
Mauro Carvalho Chehab | 172e9d3 | 2015-01-03 01:59:53 -0300 | [diff] [blame] | 359 | kfree(dvbdev->pads); |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 360 | dvbdev->entity = NULL; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 361 | dvbdev->pads = NULL; |
| 362 | return 0; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 363 | } |
| 364 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 365 | if (npads) { |
Mauro Carvalho Chehab | ab22e77 | 2015-12-11 07:44:40 -0200 | [diff] [blame] | 366 | ret = media_entity_pads_init(dvbdev->entity, npads, dvbdev->pads); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 367 | if (ret) |
| 368 | return ret; |
| 369 | } |
| 370 | ret = media_device_register_entity(dvbdev->adapter->mdev, |
| 371 | dvbdev->entity); |
| 372 | if (ret) |
Xiubo Li | eac287a | 2016-01-15 03:15:00 -0200 | [diff] [blame] | 373 | return ret; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 374 | |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 375 | pr_info("%s: media entity '%s' registered.\n", |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 376 | __func__, dvbdev->entity->name); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 377 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 378 | return 0; |
Mauro Carvalho Chehab | a0246e0 | 2015-01-02 12:19:51 -0300 | [diff] [blame] | 379 | } |
Mauro Carvalho Chehab | 0820eb5 | 2015-12-28 10:30:06 -0200 | [diff] [blame] | 380 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 381 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 382 | static int dvb_register_media_device(struct dvb_device *dvbdev, |
| 383 | int type, int minor, |
| 384 | unsigned demux_sink_pads) |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 385 | { |
| 386 | #if defined(CONFIG_MEDIA_CONTROLLER_DVB) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 387 | struct media_link *link; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 388 | u32 intf_type; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 389 | int ret; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 390 | |
| 391 | if (!dvbdev->adapter->mdev) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 392 | return 0; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 393 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 394 | ret = dvb_create_media_entity(dvbdev, type, demux_sink_pads); |
| 395 | if (ret) |
| 396 | return ret; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 397 | |
| 398 | switch (type) { |
| 399 | case DVB_DEVICE_FRONTEND: |
| 400 | intf_type = MEDIA_INTF_T_DVB_FE; |
| 401 | break; |
| 402 | case DVB_DEVICE_DEMUX: |
| 403 | intf_type = MEDIA_INTF_T_DVB_DEMUX; |
| 404 | break; |
| 405 | case DVB_DEVICE_DVR: |
| 406 | intf_type = MEDIA_INTF_T_DVB_DVR; |
| 407 | break; |
| 408 | case DVB_DEVICE_CA: |
| 409 | intf_type = MEDIA_INTF_T_DVB_CA; |
| 410 | break; |
| 411 | case DVB_DEVICE_NET: |
| 412 | intf_type = MEDIA_INTF_T_DVB_NET; |
| 413 | break; |
| 414 | default: |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 415 | return 0; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 416 | } |
| 417 | |
| 418 | dvbdev->intf_devnode = media_devnode_create(dvbdev->adapter->mdev, |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 419 | intf_type, 0, |
Mauro Carvalho Chehab | 0b3b72df9 | 2015-09-09 08:19:25 -0300 | [diff] [blame] | 420 | DVB_MAJOR, minor); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 421 | |
| 422 | if (!dvbdev->intf_devnode) |
| 423 | return -ENOMEM; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 424 | |
| 425 | /* |
| 426 | * Create the "obvious" link, e. g. the ones that represent |
| 427 | * a direct association between an interface and an entity. |
| 428 | * Other links should be created elsewhere, like: |
| 429 | * DVB FE intf -> tuner |
| 430 | * DVB demux intf -> dvr |
| 431 | */ |
| 432 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 433 | if (!dvbdev->entity) |
| 434 | return 0; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 435 | |
Hans Verkuil | 4d1e454 | 2018-07-02 08:43:02 -0400 | [diff] [blame] | 436 | link = media_create_intf_link(dvbdev->entity, |
| 437 | &dvbdev->intf_devnode->intf, |
| 438 | MEDIA_LNK_FL_ENABLED | |
| 439 | MEDIA_LNK_FL_IMMUTABLE); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 440 | if (!link) |
| 441 | return -ENOMEM; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 442 | #endif |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 443 | return 0; |
Mauro Carvalho Chehab | 8211b18 | 2015-08-21 08:20:22 -0300 | [diff] [blame] | 444 | } |
| 445 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 446 | int dvb_register_device(struct dvb_adapter *adap, struct dvb_device **pdvbdev, |
Mauro Carvalho Chehab | 6bbf7a8 | 2017-09-19 14:22:19 -0400 | [diff] [blame] | 447 | const struct dvb_device *template, void *priv, |
| 448 | enum dvb_device_type type, int demux_sink_pads) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 449 | { |
| 450 | struct dvb_device *dvbdev; |
Marcel Siegert | b619010 | 2007-02-13 09:46:55 -0300 | [diff] [blame] | 451 | struct file_operations *dvbdevfops; |
Kay Sievers | 5f55338 | 2007-08-15 14:00:09 -0300 | [diff] [blame] | 452 | struct device *clsdev; |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 453 | int minor; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 454 | int id, ret; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 455 | |
Simon Arlott | c278850 | 2007-03-10 06:21:25 -0300 | [diff] [blame] | 456 | mutex_lock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 457 | |
Marcel Siegert | b619010 | 2007-02-13 09:46:55 -0300 | [diff] [blame] | 458 | if ((id = dvbdev_get_free_id (adap, type)) < 0){ |
Ingo Molnar | 1e4baed | 2006-01-15 07:52:23 -0200 | [diff] [blame] | 459 | mutex_unlock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 460 | *pdvbdev = NULL; |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 461 | pr_err("%s: couldn't find free device id\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 462 | return -ENFILE; |
| 463 | } |
| 464 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 465 | *pdvbdev = dvbdev = kzalloc(sizeof(*dvbdev), GFP_KERNEL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 466 | |
Marcel Siegert | b619010 | 2007-02-13 09:46:55 -0300 | [diff] [blame] | 467 | if (!dvbdev){ |
| 468 | mutex_unlock(&dvbdev_register_lock); |
| 469 | return -ENOMEM; |
| 470 | } |
| 471 | |
Fuqian Huang | f6af820 | 2019-07-03 13:28:37 -0300 | [diff] [blame] | 472 | dvbdevfops = kmemdup(template->fops, sizeof(*dvbdevfops), GFP_KERNEL); |
Marcel Siegert | b619010 | 2007-02-13 09:46:55 -0300 | [diff] [blame] | 473 | |
| 474 | if (!dvbdevfops){ |
| 475 | kfree (dvbdev); |
Ingo Molnar | 1e4baed | 2006-01-15 07:52:23 -0200 | [diff] [blame] | 476 | mutex_unlock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 477 | return -ENOMEM; |
| 478 | } |
| 479 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 480 | memcpy(dvbdev, template, sizeof(struct dvb_device)); |
| 481 | dvbdev->type = type; |
| 482 | dvbdev->id = id; |
| 483 | dvbdev->adapter = adap; |
| 484 | dvbdev->priv = priv; |
Marcel Siegert | b619010 | 2007-02-13 09:46:55 -0300 | [diff] [blame] | 485 | dvbdev->fops = dvbdevfops; |
Markus Rechberger | ca5be9c | 2007-04-14 10:18:58 -0300 | [diff] [blame] | 486 | init_waitqueue_head (&dvbdev->wait_queue); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 487 | |
Jan Engelhardt | 784e29d | 2009-01-11 06:12:43 -0300 | [diff] [blame] | 488 | dvbdevfops->owner = adap->module; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 489 | |
| 490 | list_add_tail (&dvbdev->list_head, &adap->device_list); |
| 491 | |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 492 | down_write(&minor_rwsem); |
| 493 | #ifdef CONFIG_DVB_DYNAMIC_MINORS |
| 494 | for (minor = 0; minor < MAX_DVB_MINORS; minor++) |
| 495 | if (dvb_minors[minor] == NULL) |
| 496 | break; |
| 497 | |
| 498 | if (minor == MAX_DVB_MINORS) { |
Mauro Carvalho Chehab | 1fec2ec | 2021-06-09 14:32:29 +0200 | [diff] [blame] | 499 | list_del (&dvbdev->list_head); |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 500 | kfree(dvbdevfops); |
| 501 | kfree(dvbdev); |
Santosh Nayak | 82163ed | 2012-06-23 07:59:54 -0300 | [diff] [blame] | 502 | up_write(&minor_rwsem); |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 503 | mutex_unlock(&dvbdev_register_lock); |
| 504 | return -EINVAL; |
| 505 | } |
| 506 | #else |
| 507 | minor = nums2minor(adap->num, type, id); |
| 508 | #endif |
| 509 | |
| 510 | dvbdev->minor = minor; |
| 511 | dvb_minors[minor] = dvbdev; |
| 512 | up_write(&minor_rwsem); |
| 513 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 514 | ret = dvb_register_media_device(dvbdev, type, minor, demux_sink_pads); |
| 515 | if (ret) { |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 516 | pr_err("%s: dvb_register_media_device failed to create the mediagraph\n", |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 517 | __func__); |
| 518 | |
| 519 | dvb_media_device_free(dvbdev); |
Mauro Carvalho Chehab | 1fec2ec | 2021-06-09 14:32:29 +0200 | [diff] [blame] | 520 | list_del (&dvbdev->list_head); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 521 | kfree(dvbdevfops); |
| 522 | kfree(dvbdev); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 523 | mutex_unlock(&dvbdev_register_lock); |
| 524 | return ret; |
| 525 | } |
| 526 | |
Andrew de Quincey | f47f476 | 2006-04-04 09:41:47 -0300 | [diff] [blame] | 527 | mutex_unlock(&dvbdev_register_lock); |
| 528 | |
Greg Kroah-Hartman | a9b1261 | 2008-07-21 20:03:34 -0700 | [diff] [blame] | 529 | clsdev = device_create(dvb_class, adap->device, |
Hans Verkuil | b749678 | 2008-11-03 05:38:43 -0300 | [diff] [blame] | 530 | MKDEV(DVB_MAJOR, minor), |
Kay Sievers | a5f4c0c | 2008-10-27 22:27:37 -0300 | [diff] [blame] | 531 | dvbdev, "dvb%d.%s%d", adap->num, dnames[type], id); |
Simon Arlott | 4abdcf9 | 2007-05-06 20:56:14 -0300 | [diff] [blame] | 532 | if (IS_ERR(clsdev)) { |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 533 | pr_err("%s: failed to create device dvb%d.%s%d (%ld)\n", |
Harvey Harrison | 46b4f7c | 2008-04-08 23:20:00 -0300 | [diff] [blame] | 534 | __func__, adap->num, dnames[type], id, PTR_ERR(clsdev)); |
Dinghao Liu | 167faad | 2020-08-24 14:27:46 +0200 | [diff] [blame] | 535 | dvb_media_device_free(dvbdev); |
Mauro Carvalho Chehab | 1fec2ec | 2021-06-09 14:32:29 +0200 | [diff] [blame] | 536 | list_del (&dvbdev->list_head); |
Dinghao Liu | 167faad | 2020-08-24 14:27:46 +0200 | [diff] [blame] | 537 | kfree(dvbdevfops); |
| 538 | kfree(dvbdev); |
Simon Arlott | 4abdcf9 | 2007-05-06 20:56:14 -0300 | [diff] [blame] | 539 | return PTR_ERR(clsdev); |
| 540 | } |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 541 | dprintk("DVB: register adapter%d/%s%d @ minor: %i (0x%02x)\n", |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 542 | adap->num, dnames[type], id, minor, minor); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 543 | |
| 544 | return 0; |
| 545 | } |
| 546 | EXPORT_SYMBOL(dvb_register_device); |
| 547 | |
| 548 | |
Max Kellermann | 1f4ed6c | 2016-08-09 18:32:11 -0300 | [diff] [blame] | 549 | void dvb_remove_device(struct dvb_device *dvbdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 550 | { |
| 551 | if (!dvbdev) |
| 552 | return; |
| 553 | |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 554 | down_write(&minor_rwsem); |
| 555 | dvb_minors[dvbdev->minor] = NULL; |
| 556 | up_write(&minor_rwsem); |
| 557 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 558 | dvb_media_device_free(dvbdev); |
| 559 | |
Andreas Oberritter | 5dd3f30 | 2008-10-23 12:11:19 -0300 | [diff] [blame] | 560 | device_destroy(dvb_class, MKDEV(DVB_MAJOR, dvbdev->minor)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 561 | |
| 562 | list_del (&dvbdev->list_head); |
Max Kellermann | 1f4ed6c | 2016-08-09 18:32:11 -0300 | [diff] [blame] | 563 | } |
| 564 | EXPORT_SYMBOL(dvb_remove_device); |
| 565 | |
| 566 | |
| 567 | void dvb_free_device(struct dvb_device *dvbdev) |
| 568 | { |
| 569 | if (!dvbdev) |
| 570 | return; |
| 571 | |
Marcel Siegert | b619010 | 2007-02-13 09:46:55 -0300 | [diff] [blame] | 572 | kfree (dvbdev->fops); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 573 | kfree (dvbdev); |
| 574 | } |
Max Kellermann | 1f4ed6c | 2016-08-09 18:32:11 -0300 | [diff] [blame] | 575 | EXPORT_SYMBOL(dvb_free_device); |
| 576 | |
| 577 | |
| 578 | void dvb_unregister_device(struct dvb_device *dvbdev) |
| 579 | { |
| 580 | dvb_remove_device(dvbdev); |
| 581 | dvb_free_device(dvbdev); |
| 582 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 583 | EXPORT_SYMBOL(dvb_unregister_device); |
| 584 | |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 585 | |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 586 | #ifdef CONFIG_MEDIA_CONTROLLER_DVB |
Mauro Carvalho Chehab | 17813e2 | 2015-09-06 13:28:48 -0300 | [diff] [blame] | 587 | |
| 588 | static int dvb_create_io_intf_links(struct dvb_adapter *adap, |
| 589 | struct media_interface *intf, |
| 590 | char *name) |
| 591 | { |
| 592 | struct media_device *mdev = adap->mdev; |
| 593 | struct media_entity *entity; |
| 594 | struct media_link *link; |
| 595 | |
| 596 | media_device_for_each_entity(entity, mdev) { |
| 597 | if (entity->function == MEDIA_ENT_F_IO_DTV) { |
| 598 | if (strncmp(entity->name, name, strlen(name))) |
| 599 | continue; |
| 600 | link = media_create_intf_link(entity, intf, |
Hans Verkuil | 4d1e454 | 2018-07-02 08:43:02 -0400 | [diff] [blame] | 601 | MEDIA_LNK_FL_ENABLED | |
| 602 | MEDIA_LNK_FL_IMMUTABLE); |
Mauro Carvalho Chehab | 17813e2 | 2015-09-06 13:28:48 -0300 | [diff] [blame] | 603 | if (!link) |
| 604 | return -ENOMEM; |
| 605 | } |
| 606 | } |
| 607 | return 0; |
| 608 | } |
| 609 | |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 610 | int dvb_create_media_graph(struct dvb_adapter *adap, |
| 611 | bool create_rf_connector) |
Mauro Carvalho Chehab | 480884b | 2015-03-02 10:49:04 -0300 | [diff] [blame] | 612 | { |
| 613 | struct media_device *mdev = adap->mdev; |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 614 | struct media_entity *entity, *tuner = NULL, *demod = NULL, *conn; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 615 | struct media_entity *demux = NULL, *ca = NULL; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 616 | struct media_link *link; |
Mauro Carvalho Chehab | 8ddb90d | 2015-08-21 09:32:38 -0300 | [diff] [blame] | 617 | struct media_interface *intf; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 618 | unsigned demux_pad = 0; |
| 619 | unsigned dvr_pad = 0; |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 620 | unsigned ntuner = 0, ndemod = 0; |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 621 | int ret, pad_source, pad_sink; |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 622 | static const char *connector_name = "Television"; |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 623 | |
| 624 | if (!mdev) |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 625 | return 0; |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 626 | |
| 627 | media_device_for_each_entity(entity, mdev) { |
Mauro Carvalho Chehab | 0e576b7 | 2015-09-06 09:33:39 -0300 | [diff] [blame] | 628 | switch (entity->function) { |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 629 | case MEDIA_ENT_F_TUNER: |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 630 | tuner = entity; |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 631 | ntuner++; |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 632 | break; |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 633 | case MEDIA_ENT_F_DTV_DEMOD: |
Mauro Carvalho Chehab | 32fdc0e | 2015-08-21 11:40:34 -0300 | [diff] [blame] | 634 | demod = entity; |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 635 | ndemod++; |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 636 | break; |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 637 | case MEDIA_ENT_F_TS_DEMUX: |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 638 | demux = entity; |
| 639 | break; |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 640 | case MEDIA_ENT_F_DTV_CA: |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 641 | ca = entity; |
| 642 | break; |
| 643 | } |
| 644 | } |
| 645 | |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 646 | /* |
| 647 | * Prepare to signalize to media_create_pad_links() that multiple |
| 648 | * entities of the same type exists and a 1:n or n:1 links need to be |
| 649 | * created. |
| 650 | * NOTE: if both tuner and demod have multiple instances, it is up |
| 651 | * to the caller driver to create such links. |
| 652 | */ |
| 653 | if (ntuner > 1) |
| 654 | tuner = NULL; |
| 655 | if (ndemod > 1) |
| 656 | demod = NULL; |
| 657 | |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 658 | if (create_rf_connector) { |
| 659 | conn = kzalloc(sizeof(*conn), GFP_KERNEL); |
| 660 | if (!conn) |
| 661 | return -ENOMEM; |
| 662 | adap->conn = conn; |
| 663 | |
Xiubo Li | 5c3fbc5 | 2016-01-15 03:14:58 -0200 | [diff] [blame] | 664 | adap->conn_pads = kzalloc(sizeof(*adap->conn_pads), GFP_KERNEL); |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 665 | if (!adap->conn_pads) |
| 666 | return -ENOMEM; |
| 667 | |
| 668 | conn->flags = MEDIA_ENT_FL_CONNECTOR; |
| 669 | conn->function = MEDIA_ENT_F_CONN_RF; |
| 670 | conn->name = connector_name; |
| 671 | adap->conn_pads->flags = MEDIA_PAD_FL_SOURCE; |
| 672 | |
| 673 | ret = media_entity_pads_init(conn, 1, adap->conn_pads); |
| 674 | if (ret) |
| 675 | return ret; |
| 676 | |
| 677 | ret = media_device_register_entity(mdev, conn); |
| 678 | if (ret) |
| 679 | return ret; |
| 680 | |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 681 | if (!ntuner) { |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 682 | ret = media_create_pad_links(mdev, |
| 683 | MEDIA_ENT_F_CONN_RF, |
| 684 | conn, 0, |
| 685 | MEDIA_ENT_F_DTV_DEMOD, |
| 686 | demod, 0, |
| 687 | MEDIA_LNK_FL_ENABLED, |
| 688 | false); |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 689 | } else { |
| 690 | pad_sink = media_get_pad_index(tuner, true, |
| 691 | PAD_SIGNAL_ANALOG); |
| 692 | if (pad_sink < 0) |
| 693 | return -EINVAL; |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 694 | ret = media_create_pad_links(mdev, |
| 695 | MEDIA_ENT_F_CONN_RF, |
| 696 | conn, 0, |
| 697 | MEDIA_ENT_F_TUNER, |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 698 | tuner, pad_sink, |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 699 | MEDIA_LNK_FL_ENABLED, |
| 700 | false); |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 701 | } |
Mauro Carvalho Chehab | 0230d60 | 2015-12-29 11:52:23 -0200 | [diff] [blame] | 702 | if (ret) |
| 703 | return ret; |
| 704 | } |
| 705 | |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 706 | if (ntuner && ndemod) { |
Brad Love | 9f984ca | 2020-05-14 18:40:43 +0200 | [diff] [blame] | 707 | /* NOTE: first found tuner source pad presumed correct */ |
| 708 | pad_source = media_get_pad_index(tuner, false, |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 709 | PAD_SIGNAL_ANALOG); |
Brad Love | 9f984ca | 2020-05-14 18:40:43 +0200 | [diff] [blame] | 710 | if (pad_source < 0) |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 711 | return -EINVAL; |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 712 | ret = media_create_pad_links(mdev, |
| 713 | MEDIA_ENT_F_TUNER, |
Mauro Carvalho Chehab | f3efe15 | 2018-07-31 12:43:39 -0400 | [diff] [blame] | 714 | tuner, pad_source, |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 715 | MEDIA_ENT_F_DTV_DEMOD, |
| 716 | demod, 0, MEDIA_LNK_FL_ENABLED, |
| 717 | false); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 718 | if (ret) |
| 719 | return ret; |
| 720 | } |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 721 | |
Mauro Carvalho Chehab | a0cce2a | 2015-12-30 10:11:53 -0200 | [diff] [blame] | 722 | if (ndemod && demux) { |
| 723 | ret = media_create_pad_links(mdev, |
| 724 | MEDIA_ENT_F_DTV_DEMOD, |
| 725 | demod, 1, |
| 726 | MEDIA_ENT_F_TS_DEMUX, |
| 727 | demux, 0, MEDIA_LNK_FL_ENABLED, |
| 728 | false); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 729 | if (ret) |
Max Kellermann | acc37e8 | 2016-03-18 18:31:35 -0300 | [diff] [blame] | 730 | return ret; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 731 | } |
| 732 | if (demux && ca) { |
| 733 | ret = media_create_pad_link(demux, 1, ca, |
| 734 | 0, MEDIA_LNK_FL_ENABLED); |
Olli Salonen | 711f3fb | 2016-03-01 16:28:54 -0300 | [diff] [blame] | 735 | if (ret) |
Max Kellermann | acc37e8 | 2016-03-18 18:31:35 -0300 | [diff] [blame] | 736 | return ret; |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 737 | } |
Mauro Carvalho Chehab | 8ddb90d | 2015-08-21 09:32:38 -0300 | [diff] [blame] | 738 | |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 739 | /* Create demux links for each ringbuffer/pad */ |
| 740 | if (demux) { |
| 741 | media_device_for_each_entity(entity, mdev) { |
Mauro Carvalho Chehab | 4ca72ef | 2015-12-10 17:25:41 -0200 | [diff] [blame] | 742 | if (entity->function == MEDIA_ENT_F_IO_DTV) { |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 743 | if (!strncmp(entity->name, DVR_TSOUT, |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 744 | strlen(DVR_TSOUT))) { |
| 745 | ret = media_create_pad_link(demux, |
| 746 | ++dvr_pad, |
| 747 | entity, 0, 0); |
| 748 | if (ret) |
| 749 | return ret; |
| 750 | } |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 751 | if (!strncmp(entity->name, DEMUX_TSOUT, |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 752 | strlen(DEMUX_TSOUT))) { |
| 753 | ret = media_create_pad_link(demux, |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 754 | ++demux_pad, |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 755 | entity, 0, 0); |
| 756 | if (ret) |
| 757 | return ret; |
| 758 | } |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 759 | } |
| 760 | } |
| 761 | } |
| 762 | |
Mauro Carvalho Chehab | 8ed0714 | 2015-09-06 13:38:23 -0300 | [diff] [blame] | 763 | /* Create interface links for FE->tuner, DVR->demux and CA->ca */ |
Mauro Carvalho Chehab | cf975a4 | 2015-08-23 07:51:22 -0300 | [diff] [blame] | 764 | media_device_for_each_intf(intf, mdev) { |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 765 | if (intf->type == MEDIA_INTF_T_DVB_CA && ca) { |
| 766 | link = media_create_intf_link(ca, intf, |
Hans Verkuil | 4d1e454 | 2018-07-02 08:43:02 -0400 | [diff] [blame] | 767 | MEDIA_LNK_FL_ENABLED | |
| 768 | MEDIA_LNK_FL_IMMUTABLE); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 769 | if (!link) |
| 770 | return -ENOMEM; |
| 771 | } |
Mauro Carvalho Chehab | cf975a4 | 2015-08-23 07:51:22 -0300 | [diff] [blame] | 772 | |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 773 | if (intf->type == MEDIA_INTF_T_DVB_FE && tuner) { |
| 774 | link = media_create_intf_link(tuner, intf, |
Hans Verkuil | 4d1e454 | 2018-07-02 08:43:02 -0400 | [diff] [blame] | 775 | MEDIA_LNK_FL_ENABLED | |
| 776 | MEDIA_LNK_FL_IMMUTABLE); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 777 | if (!link) |
| 778 | return -ENOMEM; |
| 779 | } |
Mauro Carvalho Chehab | 8ed0714 | 2015-09-06 13:38:23 -0300 | [diff] [blame] | 780 | #if 0 |
| 781 | /* |
| 782 | * Indirect link - let's not create yet, as we don't know how |
| 783 | * to handle indirect links, nor if this will |
| 784 | * actually be needed. |
| 785 | */ |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 786 | if (intf->type == MEDIA_INTF_T_DVB_DVR && demux) { |
| 787 | link = media_create_intf_link(demux, intf, |
Hans Verkuil | 4d1e454 | 2018-07-02 08:43:02 -0400 | [diff] [blame] | 788 | MEDIA_LNK_FL_ENABLED | |
| 789 | MEDIA_LNK_FL_IMMUTABLE); |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 790 | if (!link) |
| 791 | return -ENOMEM; |
| 792 | } |
Mauro Carvalho Chehab | 8ed0714 | 2015-09-06 13:38:23 -0300 | [diff] [blame] | 793 | #endif |
Mauro Carvalho Chehab | 17813e2 | 2015-09-06 13:28:48 -0300 | [diff] [blame] | 794 | if (intf->type == MEDIA_INTF_T_DVB_DVR) { |
| 795 | ret = dvb_create_io_intf_links(adap, intf, DVR_TSOUT); |
| 796 | if (ret) |
| 797 | return ret; |
| 798 | } |
| 799 | if (intf->type == MEDIA_INTF_T_DVB_DEMUX) { |
| 800 | ret = dvb_create_io_intf_links(adap, intf, DEMUX_TSOUT); |
| 801 | if (ret) |
| 802 | return ret; |
Mauro Carvalho Chehab | df2f94e | 2015-08-21 16:18:18 -0300 | [diff] [blame] | 803 | } |
Mauro Carvalho Chehab | 8ddb90d | 2015-08-21 09:32:38 -0300 | [diff] [blame] | 804 | } |
Mauro Carvalho Chehab | f50d516 | 2015-09-04 15:10:29 -0300 | [diff] [blame] | 805 | return 0; |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 806 | } |
| 807 | EXPORT_SYMBOL_GPL(dvb_create_media_graph); |
Mauro Carvalho Chehab | 480884b | 2015-03-02 10:49:04 -0300 | [diff] [blame] | 808 | #endif |
Mauro Carvalho Chehab | 4155109a | 2015-01-03 16:52:34 -0300 | [diff] [blame] | 809 | |
Janne Grunau | 78e92006 | 2008-04-09 19:13:13 -0300 | [diff] [blame] | 810 | static int dvbdev_check_free_adapter_num(int num) |
| 811 | { |
| 812 | struct list_head *entry; |
| 813 | list_for_each(entry, &dvb_adapter_list) { |
| 814 | struct dvb_adapter *adap; |
| 815 | adap = list_entry(entry, struct dvb_adapter, list_head); |
| 816 | if (adap->num == num) |
| 817 | return 0; |
| 818 | } |
| 819 | return 1; |
| 820 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 821 | |
| 822 | static int dvbdev_get_free_adapter_num (void) |
| 823 | { |
| 824 | int num = 0; |
| 825 | |
| 826 | while (num < DVB_MAX_ADAPTERS) { |
Janne Grunau | 78e92006 | 2008-04-09 19:13:13 -0300 | [diff] [blame] | 827 | if (dvbdev_check_free_adapter_num(num)) |
| 828 | return num; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 829 | num++; |
| 830 | } |
| 831 | |
| 832 | return -ENFILE; |
| 833 | } |
| 834 | |
| 835 | |
Janne Grunau | 78e92006 | 2008-04-09 19:13:13 -0300 | [diff] [blame] | 836 | int dvb_register_adapter(struct dvb_adapter *adap, const char *name, |
| 837 | struct module *module, struct device *device, |
| 838 | short *adapter_nums) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 839 | { |
Janne Grunau | 78e92006 | 2008-04-09 19:13:13 -0300 | [diff] [blame] | 840 | int i, num; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 841 | |
Simon Arlott | c278850 | 2007-03-10 06:21:25 -0300 | [diff] [blame] | 842 | mutex_lock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 843 | |
Janne Grunau | 78e92006 | 2008-04-09 19:13:13 -0300 | [diff] [blame] | 844 | for (i = 0; i < DVB_MAX_ADAPTERS; ++i) { |
| 845 | num = adapter_nums[i]; |
| 846 | if (num >= 0 && num < DVB_MAX_ADAPTERS) { |
| 847 | /* use the one the driver asked for */ |
| 848 | if (dvbdev_check_free_adapter_num(num)) |
| 849 | break; |
| 850 | } else { |
| 851 | num = dvbdev_get_free_adapter_num(); |
| 852 | break; |
| 853 | } |
| 854 | num = -1; |
| 855 | } |
| 856 | |
| 857 | if (num < 0) { |
Ingo Molnar | 1e4baed | 2006-01-15 07:52:23 -0200 | [diff] [blame] | 858 | mutex_unlock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 859 | return -ENFILE; |
| 860 | } |
| 861 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 862 | memset (adap, 0, sizeof(struct dvb_adapter)); |
| 863 | INIT_LIST_HEAD (&adap->device_list); |
| 864 | |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 865 | pr_info("DVB: registering new adapter (%s)\n", name); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 866 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 867 | adap->num = num; |
| 868 | adap->name = name; |
| 869 | adap->module = module; |
Andrew de Quincey | d09dbf9 | 2006-04-10 09:27:37 -0300 | [diff] [blame] | 870 | adap->device = device; |
Darron Broad | 59b1842 | 2008-10-11 11:44:05 -0300 | [diff] [blame] | 871 | adap->mfe_shared = 0; |
| 872 | adap->mfe_dvbdev = NULL; |
| 873 | mutex_init (&adap->mfe_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 874 | |
Max Kellermann | f17c403 | 2018-05-03 14:12:59 -0400 | [diff] [blame] | 875 | #ifdef CONFIG_MEDIA_CONTROLLER_DVB |
| 876 | mutex_init(&adap->mdev_lock); |
| 877 | #endif |
| 878 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 879 | list_add_tail (&adap->list_head, &dvb_adapter_list); |
| 880 | |
Ingo Molnar | 1e4baed | 2006-01-15 07:52:23 -0200 | [diff] [blame] | 881 | mutex_unlock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 882 | |
| 883 | return num; |
| 884 | } |
| 885 | EXPORT_SYMBOL(dvb_register_adapter); |
| 886 | |
| 887 | |
| 888 | int dvb_unregister_adapter(struct dvb_adapter *adap) |
| 889 | { |
Simon Arlott | c278850 | 2007-03-10 06:21:25 -0300 | [diff] [blame] | 890 | mutex_lock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 891 | list_del (&adap->list_head); |
Ingo Molnar | 1e4baed | 2006-01-15 07:52:23 -0200 | [diff] [blame] | 892 | mutex_unlock(&dvbdev_register_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 893 | return 0; |
| 894 | } |
| 895 | EXPORT_SYMBOL(dvb_unregister_adapter); |
| 896 | |
| 897 | /* if the miracle happens and "generic_usercopy()" is included into |
| 898 | the kernel, then this can vanish. please don't make the mistake and |
Mauro Carvalho Chehab | 7808239 | 2019-02-18 14:28:57 -0500 | [diff] [blame] | 899 | define this as video_usercopy(). this will introduce a dependency |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 900 | to the v4l "videodev.o" module, which is unnecessary for some |
| 901 | cards (ie. the budget dvb-cards don't need the v4l module...) */ |
Arnd Bergmann | 16ef8de | 2010-04-27 00:24:00 +0200 | [diff] [blame] | 902 | int dvb_usercopy(struct file *file, |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 903 | unsigned int cmd, unsigned long arg, |
Arnd Bergmann | 16ef8de | 2010-04-27 00:24:00 +0200 | [diff] [blame] | 904 | int (*func)(struct file *file, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 905 | unsigned int cmd, void *arg)) |
| 906 | { |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 907 | char sbuf[128]; |
| 908 | void *mbuf = NULL; |
| 909 | void *parg = NULL; |
| 910 | int err = -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 911 | |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 912 | /* Copy arguments into temp kernel buffer */ |
| 913 | switch (_IOC_DIR(cmd)) { |
| 914 | case _IOC_NONE: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 915 | /* |
| 916 | * For this command, the pointer is actually an integer |
| 917 | * argument. |
| 918 | */ |
| 919 | parg = (void *) arg; |
| 920 | break; |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 921 | case _IOC_READ: /* some v4l ioctls are marked wrong ... */ |
| 922 | case _IOC_WRITE: |
| 923 | case (_IOC_WRITE | _IOC_READ): |
| 924 | if (_IOC_SIZE(cmd) <= sizeof(sbuf)) { |
Michael Krufky | 50c25ff | 2006-01-09 15:25:34 -0200 | [diff] [blame] | 925 | parg = sbuf; |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 926 | } else { |
Michael Krufky | 50c25ff | 2006-01-09 15:25:34 -0200 | [diff] [blame] | 927 | /* too big to allocate from stack */ |
Xiubo Li | 0ede187 | 2016-01-15 03:14:59 -0200 | [diff] [blame] | 928 | mbuf = kmalloc(_IOC_SIZE(cmd), GFP_KERNEL); |
Michael Krufky | 50c25ff | 2006-01-09 15:25:34 -0200 | [diff] [blame] | 929 | if (NULL == mbuf) |
| 930 | return -ENOMEM; |
| 931 | parg = mbuf; |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 932 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 933 | |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 934 | err = -EFAULT; |
| 935 | if (copy_from_user(parg, (void __user *)arg, _IOC_SIZE(cmd))) |
Michael Krufky | 50c25ff | 2006-01-09 15:25:34 -0200 | [diff] [blame] | 936 | goto out; |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 937 | break; |
| 938 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 939 | |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 940 | /* call driver */ |
Arnd Bergmann | 16ef8de | 2010-04-27 00:24:00 +0200 | [diff] [blame] | 941 | if ((err = func(file, cmd, parg)) == -ENOIOCTLCMD) |
Wanlong Gao | d9751fd | 2012-08-27 03:23:14 -0300 | [diff] [blame] | 942 | err = -ENOTTY; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 943 | |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 944 | if (err < 0) |
| 945 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 946 | |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 947 | /* Copy results into user buffer */ |
| 948 | switch (_IOC_DIR(cmd)) |
| 949 | { |
| 950 | case _IOC_READ: |
| 951 | case (_IOC_WRITE | _IOC_READ): |
| 952 | if (copy_to_user((void __user *)arg, parg, _IOC_SIZE(cmd))) |
Michael Krufky | 50c25ff | 2006-01-09 15:25:34 -0200 | [diff] [blame] | 953 | err = -EFAULT; |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 954 | break; |
| 955 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 956 | |
| 957 | out: |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 958 | kfree(mbuf); |
| 959 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 960 | } |
| 961 | |
Mauro Carvalho Chehab | 1980bfa | 2018-03-07 04:11:50 -0500 | [diff] [blame] | 962 | #if IS_ENABLED(CONFIG_I2C) |
Mauro Carvalho Chehab | 8f569c0 | 2018-03-02 10:21:16 -0500 | [diff] [blame] | 963 | struct i2c_client *dvb_module_probe(const char *module_name, |
| 964 | const char *name, |
| 965 | struct i2c_adapter *adap, |
| 966 | unsigned char addr, |
| 967 | void *platform_data) |
| 968 | { |
| 969 | struct i2c_client *client; |
| 970 | struct i2c_board_info *board_info; |
| 971 | |
| 972 | board_info = kzalloc(sizeof(*board_info), GFP_KERNEL); |
Mauro Carvalho Chehab | 39adb4e | 2018-03-22 09:01:11 -0400 | [diff] [blame] | 973 | if (!board_info) |
| 974 | return NULL; |
Mauro Carvalho Chehab | 8f569c0 | 2018-03-02 10:21:16 -0500 | [diff] [blame] | 975 | |
| 976 | if (name) |
Mauro Carvalho Chehab | c0decac | 2018-09-10 08:19:14 -0400 | [diff] [blame] | 977 | strscpy(board_info->type, name, I2C_NAME_SIZE); |
Mauro Carvalho Chehab | 8f569c0 | 2018-03-02 10:21:16 -0500 | [diff] [blame] | 978 | else |
Mauro Carvalho Chehab | c0decac | 2018-09-10 08:19:14 -0400 | [diff] [blame] | 979 | strscpy(board_info->type, module_name, I2C_NAME_SIZE); |
Mauro Carvalho Chehab | 8f569c0 | 2018-03-02 10:21:16 -0500 | [diff] [blame] | 980 | |
| 981 | board_info->addr = addr; |
| 982 | board_info->platform_data = platform_data; |
| 983 | request_module(module_name); |
Wolfram Sang | d928440 | 2019-12-16 16:51:28 +0100 | [diff] [blame] | 984 | client = i2c_new_client_device(adap, board_info); |
| 985 | if (!i2c_client_has_driver(client)) { |
Mauro Carvalho Chehab | 8f569c0 | 2018-03-02 10:21:16 -0500 | [diff] [blame] | 986 | kfree(board_info); |
| 987 | return NULL; |
| 988 | } |
| 989 | |
| 990 | if (!try_module_get(client->dev.driver->owner)) { |
| 991 | i2c_unregister_device(client); |
| 992 | client = NULL; |
| 993 | } |
| 994 | |
| 995 | kfree(board_info); |
| 996 | return client; |
| 997 | } |
| 998 | EXPORT_SYMBOL_GPL(dvb_module_probe); |
| 999 | |
| 1000 | void dvb_module_release(struct i2c_client *client) |
| 1001 | { |
| 1002 | if (!client) |
| 1003 | return; |
| 1004 | |
| 1005 | module_put(client->dev.driver->owner); |
| 1006 | i2c_unregister_device(client); |
| 1007 | } |
| 1008 | EXPORT_SYMBOL_GPL(dvb_module_release); |
| 1009 | #endif |
| 1010 | |
Kay Sievers | a5f4c0c | 2008-10-27 22:27:37 -0300 | [diff] [blame] | 1011 | static int dvb_uevent(struct device *dev, struct kobj_uevent_env *env) |
| 1012 | { |
| 1013 | struct dvb_device *dvbdev = dev_get_drvdata(dev); |
| 1014 | |
Kay Sievers | a5f4c0c | 2008-10-27 22:27:37 -0300 | [diff] [blame] | 1015 | add_uevent_var(env, "DVB_ADAPTER_NUM=%d", dvbdev->adapter->num); |
Kay Sievers | 763d19b | 2008-12-31 23:35:24 -0300 | [diff] [blame] | 1016 | add_uevent_var(env, "DVB_DEVICE_TYPE=%s", dnames[dvbdev->type]); |
| 1017 | add_uevent_var(env, "DVB_DEVICE_NUM=%d", dvbdev->id); |
Kay Sievers | a5f4c0c | 2008-10-27 22:27:37 -0300 | [diff] [blame] | 1018 | return 0; |
| 1019 | } |
| 1020 | |
Al Viro | 2c9ede5 | 2011-07-23 20:24:48 -0400 | [diff] [blame] | 1021 | static char *dvb_devnode(struct device *dev, umode_t *mode) |
Kay Sievers | 8a8bdcc | 2009-04-30 15:23:42 +0200 | [diff] [blame] | 1022 | { |
| 1023 | struct dvb_device *dvbdev = dev_get_drvdata(dev); |
| 1024 | |
| 1025 | return kasprintf(GFP_KERNEL, "dvb/adapter%d/%s%d", |
| 1026 | dvbdev->adapter->num, dnames[dvbdev->type], dvbdev->id); |
| 1027 | } |
| 1028 | |
| 1029 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1030 | static int __init init_dvbdev(void) |
| 1031 | { |
| 1032 | int retval; |
| 1033 | dev_t dev = MKDEV(DVB_MAJOR, 0); |
| 1034 | |
| 1035 | if ((retval = register_chrdev_region(dev, MAX_DVB_MINORS, "DVB")) != 0) { |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 1036 | pr_err("dvb-core: unable to get major %d\n", DVB_MAJOR); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1037 | return retval; |
| 1038 | } |
| 1039 | |
| 1040 | cdev_init(&dvb_device_cdev, &dvb_device_fops); |
| 1041 | if ((retval = cdev_add(&dvb_device_cdev, dev, MAX_DVB_MINORS)) != 0) { |
Mauro Carvalho Chehab | b3ad24d | 2016-10-13 06:47:54 -0300 | [diff] [blame] | 1042 | pr_err("dvb-core: unable register character device\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1043 | goto error; |
| 1044 | } |
| 1045 | |
gregkh@suse.de | 56b2293 | 2005-03-23 10:01:41 -0800 | [diff] [blame] | 1046 | dvb_class = class_create(THIS_MODULE, "dvb"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1047 | if (IS_ERR(dvb_class)) { |
| 1048 | retval = PTR_ERR(dvb_class); |
| 1049 | goto error; |
| 1050 | } |
Kay Sievers | a5f4c0c | 2008-10-27 22:27:37 -0300 | [diff] [blame] | 1051 | dvb_class->dev_uevent = dvb_uevent; |
Kay Sievers | e454cea | 2009-09-18 23:01:12 +0200 | [diff] [blame] | 1052 | dvb_class->devnode = dvb_devnode; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1053 | return 0; |
| 1054 | |
| 1055 | error: |
| 1056 | cdev_del(&dvb_device_cdev); |
| 1057 | unregister_chrdev_region(dev, MAX_DVB_MINORS); |
| 1058 | return retval; |
| 1059 | } |
| 1060 | |
| 1061 | |
| 1062 | static void __exit exit_dvbdev(void) |
| 1063 | { |
gregkh@suse.de | 56b2293 | 2005-03-23 10:01:41 -0800 | [diff] [blame] | 1064 | class_destroy(dvb_class); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1065 | cdev_del(&dvb_device_cdev); |
Mauro Carvalho Chehab | afd1a0c | 2005-12-12 00:37:27 -0800 | [diff] [blame] | 1066 | unregister_chrdev_region(MKDEV(DVB_MAJOR, 0), MAX_DVB_MINORS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1067 | } |
| 1068 | |
Simon Arlott | 4abdcf9 | 2007-05-06 20:56:14 -0300 | [diff] [blame] | 1069 | subsys_initcall(init_dvbdev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1070 | module_exit(exit_dvbdev); |
| 1071 | |
| 1072 | MODULE_DESCRIPTION("DVB Core Driver"); |
| 1073 | MODULE_AUTHOR("Marcus Metzler, Ralph Metzler, Holger Waechtler"); |
| 1074 | MODULE_LICENSE("GPL"); |