1137c579cSHans Verkuil /* 2137c579cSHans Verkuil * Framework for ISA radio drivers. 3137c579cSHans Verkuil * This takes care of all the V4L2 scaffolding, allowing the ISA drivers 4137c579cSHans Verkuil * to concentrate on the actual hardware operation. 5137c579cSHans Verkuil * 6137c579cSHans Verkuil * Copyright (C) 2012 Hans Verkuil <hans.verkuil@cisco.com> 7137c579cSHans Verkuil * 8137c579cSHans Verkuil * This program is free software; you can redistribute it and/or 9137c579cSHans Verkuil * modify it under the terms of the GNU General Public License 10137c579cSHans Verkuil * version 2 as published by the Free Software Foundation. 11137c579cSHans Verkuil * 12137c579cSHans Verkuil * This program is distributed in the hope that it will be useful, but 13137c579cSHans Verkuil * WITHOUT ANY WARRANTY; without even the implied warranty of 14137c579cSHans Verkuil * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 15137c579cSHans Verkuil * General Public License for more details. 16137c579cSHans Verkuil * 17137c579cSHans Verkuil * You should have received a copy of the GNU General Public License 18137c579cSHans Verkuil * along with this program; if not, write to the Free Software 19137c579cSHans Verkuil * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 20137c579cSHans Verkuil * 02110-1301 USA 21137c579cSHans Verkuil */ 22137c579cSHans Verkuil 23137c579cSHans Verkuil #include <linux/module.h> 24137c579cSHans Verkuil #include <linux/init.h> 25137c579cSHans Verkuil #include <linux/ioport.h> 26137c579cSHans Verkuil #include <linux/delay.h> 27137c579cSHans Verkuil #include <linux/videodev2.h> 28137c579cSHans Verkuil #include <linux/io.h> 299f1dfccfSHans Verkuil #include <linux/slab.h> 30137c579cSHans Verkuil #include <media/v4l2-device.h> 31137c579cSHans Verkuil #include <media/v4l2-ioctl.h> 32137c579cSHans Verkuil #include <media/v4l2-fh.h> 33137c579cSHans Verkuil #include <media/v4l2-ctrls.h> 34137c579cSHans Verkuil #include <media/v4l2-event.h> 35137c579cSHans Verkuil 36137c579cSHans Verkuil #include "radio-isa.h" 37137c579cSHans Verkuil 38137c579cSHans Verkuil MODULE_AUTHOR("Hans Verkuil"); 39137c579cSHans Verkuil MODULE_DESCRIPTION("A framework for ISA radio drivers."); 40137c579cSHans Verkuil MODULE_LICENSE("GPL"); 41137c579cSHans Verkuil 42137c579cSHans Verkuil #define FREQ_LOW (87U * 16000U) 43137c579cSHans Verkuil #define FREQ_HIGH (108U * 16000U) 44137c579cSHans Verkuil 45137c579cSHans Verkuil static int radio_isa_querycap(struct file *file, void *priv, 46137c579cSHans Verkuil struct v4l2_capability *v) 47137c579cSHans Verkuil { 48137c579cSHans Verkuil struct radio_isa_card *isa = video_drvdata(file); 49137c579cSHans Verkuil 50137c579cSHans Verkuil strlcpy(v->driver, isa->drv->driver.driver.name, sizeof(v->driver)); 51137c579cSHans Verkuil strlcpy(v->card, isa->drv->card, sizeof(v->card)); 52137c579cSHans Verkuil snprintf(v->bus_info, sizeof(v->bus_info), "ISA:%s", isa->v4l2_dev.name); 53137c579cSHans Verkuil 54137c579cSHans Verkuil v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO; 55137c579cSHans Verkuil v->device_caps = v->capabilities | V4L2_CAP_DEVICE_CAPS; 56137c579cSHans Verkuil return 0; 57137c579cSHans Verkuil } 58137c579cSHans Verkuil 59137c579cSHans Verkuil static int radio_isa_g_tuner(struct file *file, void *priv, 60137c579cSHans Verkuil struct v4l2_tuner *v) 61137c579cSHans Verkuil { 62137c579cSHans Verkuil struct radio_isa_card *isa = video_drvdata(file); 63137c579cSHans Verkuil const struct radio_isa_ops *ops = isa->drv->ops; 64137c579cSHans Verkuil 65137c579cSHans Verkuil if (v->index > 0) 66137c579cSHans Verkuil return -EINVAL; 67137c579cSHans Verkuil 68137c579cSHans Verkuil strlcpy(v->name, "FM", sizeof(v->name)); 69137c579cSHans Verkuil v->type = V4L2_TUNER_RADIO; 70137c579cSHans Verkuil v->rangelow = FREQ_LOW; 71137c579cSHans Verkuil v->rangehigh = FREQ_HIGH; 72137c579cSHans Verkuil v->capability = V4L2_TUNER_CAP_LOW; 73137c579cSHans Verkuil if (isa->drv->has_stereo) 74137c579cSHans Verkuil v->capability |= V4L2_TUNER_CAP_STEREO; 75137c579cSHans Verkuil 76137c579cSHans Verkuil if (ops->g_rxsubchans) 77137c579cSHans Verkuil v->rxsubchans = ops->g_rxsubchans(isa); 78137c579cSHans Verkuil else 79137c579cSHans Verkuil v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO; 80137c579cSHans Verkuil v->audmode = isa->stereo ? V4L2_TUNER_MODE_STEREO : V4L2_TUNER_MODE_MONO; 81137c579cSHans Verkuil if (ops->g_signal) 82137c579cSHans Verkuil v->signal = ops->g_signal(isa); 83137c579cSHans Verkuil else 84137c579cSHans Verkuil v->signal = (v->rxsubchans & V4L2_TUNER_SUB_STEREO) ? 85137c579cSHans Verkuil 0xffff : 0; 86137c579cSHans Verkuil return 0; 87137c579cSHans Verkuil } 88137c579cSHans Verkuil 89137c579cSHans Verkuil static int radio_isa_s_tuner(struct file *file, void *priv, 90137c579cSHans Verkuil struct v4l2_tuner *v) 91137c579cSHans Verkuil { 92137c579cSHans Verkuil struct radio_isa_card *isa = video_drvdata(file); 93137c579cSHans Verkuil const struct radio_isa_ops *ops = isa->drv->ops; 94137c579cSHans Verkuil 95137c579cSHans Verkuil if (v->index) 96137c579cSHans Verkuil return -EINVAL; 97137c579cSHans Verkuil if (ops->s_stereo) { 98137c579cSHans Verkuil isa->stereo = (v->audmode == V4L2_TUNER_MODE_STEREO); 99137c579cSHans Verkuil return ops->s_stereo(isa, isa->stereo); 100137c579cSHans Verkuil } 101137c579cSHans Verkuil return 0; 102137c579cSHans Verkuil } 103137c579cSHans Verkuil 104137c579cSHans Verkuil static int radio_isa_s_frequency(struct file *file, void *priv, 105137c579cSHans Verkuil struct v4l2_frequency *f) 106137c579cSHans Verkuil { 107137c579cSHans Verkuil struct radio_isa_card *isa = video_drvdata(file); 108137c579cSHans Verkuil int res; 109137c579cSHans Verkuil 110137c579cSHans Verkuil if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO) 111137c579cSHans Verkuil return -EINVAL; 112137c579cSHans Verkuil f->frequency = clamp(f->frequency, FREQ_LOW, FREQ_HIGH); 113137c579cSHans Verkuil res = isa->drv->ops->s_frequency(isa, f->frequency); 114137c579cSHans Verkuil if (res == 0) 115137c579cSHans Verkuil isa->freq = f->frequency; 116137c579cSHans Verkuil return res; 117137c579cSHans Verkuil } 118137c579cSHans Verkuil 119137c579cSHans Verkuil static int radio_isa_g_frequency(struct file *file, void *priv, 120137c579cSHans Verkuil struct v4l2_frequency *f) 121137c579cSHans Verkuil { 122137c579cSHans Verkuil struct radio_isa_card *isa = video_drvdata(file); 123137c579cSHans Verkuil 124137c579cSHans Verkuil if (f->tuner != 0) 125137c579cSHans Verkuil return -EINVAL; 126137c579cSHans Verkuil f->type = V4L2_TUNER_RADIO; 127137c579cSHans Verkuil f->frequency = isa->freq; 128137c579cSHans Verkuil return 0; 129137c579cSHans Verkuil } 130137c579cSHans Verkuil 131137c579cSHans Verkuil static int radio_isa_s_ctrl(struct v4l2_ctrl *ctrl) 132137c579cSHans Verkuil { 133137c579cSHans Verkuil struct radio_isa_card *isa = 134137c579cSHans Verkuil container_of(ctrl->handler, struct radio_isa_card, hdl); 135137c579cSHans Verkuil 136137c579cSHans Verkuil switch (ctrl->id) { 137137c579cSHans Verkuil case V4L2_CID_AUDIO_MUTE: 138137c579cSHans Verkuil return isa->drv->ops->s_mute_volume(isa, ctrl->val, 139137c579cSHans Verkuil isa->volume ? isa->volume->val : 0); 140137c579cSHans Verkuil } 141137c579cSHans Verkuil return -EINVAL; 142137c579cSHans Verkuil } 143137c579cSHans Verkuil 144137c579cSHans Verkuil static int radio_isa_log_status(struct file *file, void *priv) 145137c579cSHans Verkuil { 146137c579cSHans Verkuil struct radio_isa_card *isa = video_drvdata(file); 147137c579cSHans Verkuil 148137c579cSHans Verkuil v4l2_info(&isa->v4l2_dev, "I/O Port = 0x%03x\n", isa->io); 149137c579cSHans Verkuil v4l2_ctrl_handler_log_status(&isa->hdl, isa->v4l2_dev.name); 150137c579cSHans Verkuil return 0; 151137c579cSHans Verkuil } 152137c579cSHans Verkuil 153137c579cSHans Verkuil static const struct v4l2_ctrl_ops radio_isa_ctrl_ops = { 154137c579cSHans Verkuil .s_ctrl = radio_isa_s_ctrl, 155137c579cSHans Verkuil }; 156137c579cSHans Verkuil 157137c579cSHans Verkuil static const struct v4l2_file_operations radio_isa_fops = { 158137c579cSHans Verkuil .owner = THIS_MODULE, 159137c579cSHans Verkuil .open = v4l2_fh_open, 160137c579cSHans Verkuil .release = v4l2_fh_release, 161137c579cSHans Verkuil .poll = v4l2_ctrl_poll, 162137c579cSHans Verkuil .unlocked_ioctl = video_ioctl2, 163137c579cSHans Verkuil }; 164137c579cSHans Verkuil 165137c579cSHans Verkuil static const struct v4l2_ioctl_ops radio_isa_ioctl_ops = { 166137c579cSHans Verkuil .vidioc_querycap = radio_isa_querycap, 167137c579cSHans Verkuil .vidioc_g_tuner = radio_isa_g_tuner, 168137c579cSHans Verkuil .vidioc_s_tuner = radio_isa_s_tuner, 169137c579cSHans Verkuil .vidioc_g_frequency = radio_isa_g_frequency, 170137c579cSHans Verkuil .vidioc_s_frequency = radio_isa_s_frequency, 171137c579cSHans Verkuil .vidioc_log_status = radio_isa_log_status, 172a22d85feSHans de Goede .vidioc_subscribe_event = v4l2_ctrl_subscribe_event, 173137c579cSHans Verkuil .vidioc_unsubscribe_event = v4l2_event_unsubscribe, 174137c579cSHans Verkuil }; 175137c579cSHans Verkuil 176137c579cSHans Verkuil int radio_isa_match(struct device *pdev, unsigned int dev) 177137c579cSHans Verkuil { 178137c579cSHans Verkuil struct radio_isa_driver *drv = pdev->platform_data; 179137c579cSHans Verkuil 180137c579cSHans Verkuil return drv->probe || drv->io_params[dev] >= 0; 181137c579cSHans Verkuil } 182137c579cSHans Verkuil EXPORT_SYMBOL_GPL(radio_isa_match); 183137c579cSHans Verkuil 184137c579cSHans Verkuil static bool radio_isa_valid_io(const struct radio_isa_driver *drv, int io) 185137c579cSHans Verkuil { 186137c579cSHans Verkuil int i; 187137c579cSHans Verkuil 188137c579cSHans Verkuil for (i = 0; i < drv->num_of_io_ports; i++) 189137c579cSHans Verkuil if (drv->io_ports[i] == io) 190137c579cSHans Verkuil return true; 191137c579cSHans Verkuil return false; 192137c579cSHans Verkuil } 193137c579cSHans Verkuil 194865d7ec9SOndrej Zary struct radio_isa_card *radio_isa_alloc(struct radio_isa_driver *drv, 195865d7ec9SOndrej Zary struct device *pdev) 196137c579cSHans Verkuil { 197137c579cSHans Verkuil struct v4l2_device *v4l2_dev; 198865d7ec9SOndrej Zary struct radio_isa_card *isa = drv->ops->alloc(); 199865d7ec9SOndrej Zary if (!isa) 200865d7ec9SOndrej Zary return NULL; 201137c579cSHans Verkuil 202137c579cSHans Verkuil dev_set_drvdata(pdev, isa); 203137c579cSHans Verkuil isa->drv = drv; 204137c579cSHans Verkuil v4l2_dev = &isa->v4l2_dev; 205137c579cSHans Verkuil strlcpy(v4l2_dev->name, dev_name(pdev), sizeof(v4l2_dev->name)); 206137c579cSHans Verkuil 207865d7ec9SOndrej Zary return isa; 208137c579cSHans Verkuil } 209137c579cSHans Verkuil 210865d7ec9SOndrej Zary int radio_isa_common_probe(struct radio_isa_card *isa, struct device *pdev, 211865d7ec9SOndrej Zary int radio_nr, unsigned region_size) 212865d7ec9SOndrej Zary { 213865d7ec9SOndrej Zary const struct radio_isa_driver *drv = isa->drv; 214865d7ec9SOndrej Zary const struct radio_isa_ops *ops = drv->ops; 215865d7ec9SOndrej Zary struct v4l2_device *v4l2_dev = &isa->v4l2_dev; 216865d7ec9SOndrej Zary int res; 217137c579cSHans Verkuil 218865d7ec9SOndrej Zary if (!request_region(isa->io, region_size, v4l2_dev->name)) { 219137c579cSHans Verkuil v4l2_err(v4l2_dev, "port 0x%x already in use\n", isa->io); 220137c579cSHans Verkuil kfree(isa); 221137c579cSHans Verkuil return -EBUSY; 222137c579cSHans Verkuil } 223137c579cSHans Verkuil 224137c579cSHans Verkuil res = v4l2_device_register(pdev, v4l2_dev); 225137c579cSHans Verkuil if (res < 0) { 226137c579cSHans Verkuil v4l2_err(v4l2_dev, "Could not register v4l2_device\n"); 227137c579cSHans Verkuil goto err_dev_reg; 228137c579cSHans Verkuil } 229137c579cSHans Verkuil 230137c579cSHans Verkuil v4l2_ctrl_handler_init(&isa->hdl, 1); 231137c579cSHans Verkuil isa->mute = v4l2_ctrl_new_std(&isa->hdl, &radio_isa_ctrl_ops, 232137c579cSHans Verkuil V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 233137c579cSHans Verkuil if (drv->max_volume) 234137c579cSHans Verkuil isa->volume = v4l2_ctrl_new_std(&isa->hdl, &radio_isa_ctrl_ops, 235137c579cSHans Verkuil V4L2_CID_AUDIO_VOLUME, 0, drv->max_volume, 1, 236137c579cSHans Verkuil drv->max_volume); 237137c579cSHans Verkuil v4l2_dev->ctrl_handler = &isa->hdl; 238137c579cSHans Verkuil if (isa->hdl.error) { 239137c579cSHans Verkuil res = isa->hdl.error; 240137c579cSHans Verkuil v4l2_err(v4l2_dev, "Could not register controls\n"); 241137c579cSHans Verkuil goto err_hdl; 242137c579cSHans Verkuil } 243137c579cSHans Verkuil if (drv->max_volume) 244137c579cSHans Verkuil v4l2_ctrl_cluster(2, &isa->mute); 245137c579cSHans Verkuil v4l2_dev->ctrl_handler = &isa->hdl; 246137c579cSHans Verkuil 247137c579cSHans Verkuil mutex_init(&isa->lock); 248137c579cSHans Verkuil isa->vdev.lock = &isa->lock; 249137c579cSHans Verkuil strlcpy(isa->vdev.name, v4l2_dev->name, sizeof(isa->vdev.name)); 250137c579cSHans Verkuil isa->vdev.v4l2_dev = v4l2_dev; 251137c579cSHans Verkuil isa->vdev.fops = &radio_isa_fops; 252137c579cSHans Verkuil isa->vdev.ioctl_ops = &radio_isa_ioctl_ops; 253137c579cSHans Verkuil isa->vdev.release = video_device_release_empty; 254137c579cSHans Verkuil set_bit(V4L2_FL_USE_FH_PRIO, &isa->vdev.flags); 255137c579cSHans Verkuil video_set_drvdata(&isa->vdev, isa); 256137c579cSHans Verkuil isa->freq = FREQ_LOW; 257137c579cSHans Verkuil isa->stereo = drv->has_stereo; 258137c579cSHans Verkuil 259137c579cSHans Verkuil if (ops->init) 260137c579cSHans Verkuil res = ops->init(isa); 261137c579cSHans Verkuil if (!res) 262137c579cSHans Verkuil res = v4l2_ctrl_handler_setup(&isa->hdl); 263137c579cSHans Verkuil if (!res) 264137c579cSHans Verkuil res = ops->s_frequency(isa, isa->freq); 265137c579cSHans Verkuil if (!res && ops->s_stereo) 266137c579cSHans Verkuil res = ops->s_stereo(isa, isa->stereo); 267137c579cSHans Verkuil if (res < 0) { 268137c579cSHans Verkuil v4l2_err(v4l2_dev, "Could not setup card\n"); 269f61861faSHans Verkuil goto err_hdl; 270137c579cSHans Verkuil } 271865d7ec9SOndrej Zary res = video_register_device(&isa->vdev, VFL_TYPE_RADIO, radio_nr); 272865d7ec9SOndrej Zary 273137c579cSHans Verkuil if (res < 0) { 274137c579cSHans Verkuil v4l2_err(v4l2_dev, "Could not register device node\n"); 275f61861faSHans Verkuil goto err_hdl; 276137c579cSHans Verkuil } 277137c579cSHans Verkuil 278137c579cSHans Verkuil v4l2_info(v4l2_dev, "Initialized radio card %s on port 0x%03x\n", 279137c579cSHans Verkuil drv->card, isa->io); 280137c579cSHans Verkuil return 0; 281137c579cSHans Verkuil 282137c579cSHans Verkuil err_hdl: 283f61861faSHans Verkuil v4l2_ctrl_handler_free(&isa->hdl); 284137c579cSHans Verkuil err_dev_reg: 285865d7ec9SOndrej Zary release_region(isa->io, region_size); 286137c579cSHans Verkuil kfree(isa); 287137c579cSHans Verkuil return res; 288137c579cSHans Verkuil } 289137c579cSHans Verkuil 290865d7ec9SOndrej Zary int radio_isa_common_remove(struct radio_isa_card *isa, unsigned region_size) 291137c579cSHans Verkuil { 292137c579cSHans Verkuil const struct radio_isa_ops *ops = isa->drv->ops; 293137c579cSHans Verkuil 294137c579cSHans Verkuil ops->s_mute_volume(isa, true, isa->volume ? isa->volume->cur.val : 0); 295137c579cSHans Verkuil video_unregister_device(&isa->vdev); 296137c579cSHans Verkuil v4l2_ctrl_handler_free(&isa->hdl); 297137c579cSHans Verkuil v4l2_device_unregister(&isa->v4l2_dev); 298865d7ec9SOndrej Zary release_region(isa->io, region_size); 299137c579cSHans Verkuil v4l2_info(&isa->v4l2_dev, "Removed radio card %s\n", isa->drv->card); 300137c579cSHans Verkuil kfree(isa); 301137c579cSHans Verkuil return 0; 302137c579cSHans Verkuil } 303865d7ec9SOndrej Zary 304865d7ec9SOndrej Zary int radio_isa_probe(struct device *pdev, unsigned int dev) 305865d7ec9SOndrej Zary { 306865d7ec9SOndrej Zary struct radio_isa_driver *drv = pdev->platform_data; 307865d7ec9SOndrej Zary const struct radio_isa_ops *ops = drv->ops; 308865d7ec9SOndrej Zary struct v4l2_device *v4l2_dev; 309865d7ec9SOndrej Zary struct radio_isa_card *isa; 310865d7ec9SOndrej Zary 311865d7ec9SOndrej Zary isa = radio_isa_alloc(drv, pdev); 312865d7ec9SOndrej Zary if (!isa) 313865d7ec9SOndrej Zary return -ENOMEM; 314865d7ec9SOndrej Zary isa->io = drv->io_params[dev]; 315865d7ec9SOndrej Zary v4l2_dev = &isa->v4l2_dev; 316865d7ec9SOndrej Zary 317865d7ec9SOndrej Zary if (drv->probe && ops->probe) { 318865d7ec9SOndrej Zary int i; 319865d7ec9SOndrej Zary 320865d7ec9SOndrej Zary for (i = 0; i < drv->num_of_io_ports; ++i) { 321865d7ec9SOndrej Zary int io = drv->io_ports[i]; 322865d7ec9SOndrej Zary 323865d7ec9SOndrej Zary if (request_region(io, drv->region_size, v4l2_dev->name)) { 324865d7ec9SOndrej Zary bool found = ops->probe(isa, io); 325865d7ec9SOndrej Zary 326865d7ec9SOndrej Zary release_region(io, drv->region_size); 327865d7ec9SOndrej Zary if (found) { 328865d7ec9SOndrej Zary isa->io = io; 329865d7ec9SOndrej Zary break; 330865d7ec9SOndrej Zary } 331865d7ec9SOndrej Zary } 332865d7ec9SOndrej Zary } 333865d7ec9SOndrej Zary } 334865d7ec9SOndrej Zary 335865d7ec9SOndrej Zary if (!radio_isa_valid_io(drv, isa->io)) { 336865d7ec9SOndrej Zary int i; 337865d7ec9SOndrej Zary 338865d7ec9SOndrej Zary if (isa->io < 0) 339865d7ec9SOndrej Zary return -ENODEV; 340865d7ec9SOndrej Zary v4l2_err(v4l2_dev, "you must set an I/O address with io=0x%03x", 341865d7ec9SOndrej Zary drv->io_ports[0]); 342865d7ec9SOndrej Zary for (i = 1; i < drv->num_of_io_ports; i++) 343865d7ec9SOndrej Zary printk(KERN_CONT "/0x%03x", drv->io_ports[i]); 344865d7ec9SOndrej Zary printk(KERN_CONT ".\n"); 345865d7ec9SOndrej Zary kfree(isa); 346865d7ec9SOndrej Zary return -EINVAL; 347865d7ec9SOndrej Zary } 348865d7ec9SOndrej Zary 349865d7ec9SOndrej Zary return radio_isa_common_probe(isa, pdev, drv->radio_nr_params[dev], 350865d7ec9SOndrej Zary drv->region_size); 351865d7ec9SOndrej Zary } 352865d7ec9SOndrej Zary EXPORT_SYMBOL_GPL(radio_isa_probe); 353865d7ec9SOndrej Zary 354865d7ec9SOndrej Zary int radio_isa_remove(struct device *pdev, unsigned int dev) 355865d7ec9SOndrej Zary { 356865d7ec9SOndrej Zary struct radio_isa_card *isa = dev_get_drvdata(pdev); 357865d7ec9SOndrej Zary 358865d7ec9SOndrej Zary return radio_isa_common_remove(isa, isa->drv->region_size); 359865d7ec9SOndrej Zary } 360137c579cSHans Verkuil EXPORT_SYMBOL_GPL(radio_isa_remove); 361865d7ec9SOndrej Zary 362865d7ec9SOndrej Zary #ifdef CONFIG_PNP 363865d7ec9SOndrej Zary int radio_isa_pnp_probe(struct pnp_dev *dev, const struct pnp_device_id *dev_id) 364865d7ec9SOndrej Zary { 365865d7ec9SOndrej Zary struct pnp_driver *pnp_drv = to_pnp_driver(dev->dev.driver); 366865d7ec9SOndrej Zary struct radio_isa_driver *drv = container_of(pnp_drv, 367865d7ec9SOndrej Zary struct radio_isa_driver, pnp_driver); 368865d7ec9SOndrej Zary struct radio_isa_card *isa; 369865d7ec9SOndrej Zary 370865d7ec9SOndrej Zary if (!pnp_port_valid(dev, 0)) 371865d7ec9SOndrej Zary return -ENODEV; 372865d7ec9SOndrej Zary 373865d7ec9SOndrej Zary isa = radio_isa_alloc(drv, &dev->dev); 374865d7ec9SOndrej Zary if (!isa) 375865d7ec9SOndrej Zary return -ENOMEM; 376865d7ec9SOndrej Zary 377865d7ec9SOndrej Zary isa->io = pnp_port_start(dev, 0); 378865d7ec9SOndrej Zary 379865d7ec9SOndrej Zary return radio_isa_common_probe(isa, &dev->dev, drv->radio_nr_params[0], 380865d7ec9SOndrej Zary pnp_port_len(dev, 0)); 381865d7ec9SOndrej Zary } 382865d7ec9SOndrej Zary EXPORT_SYMBOL_GPL(radio_isa_pnp_probe); 383865d7ec9SOndrej Zary 384865d7ec9SOndrej Zary void radio_isa_pnp_remove(struct pnp_dev *dev) 385865d7ec9SOndrej Zary { 386865d7ec9SOndrej Zary struct radio_isa_card *isa = dev_get_drvdata(&dev->dev); 387865d7ec9SOndrej Zary 388865d7ec9SOndrej Zary radio_isa_common_remove(isa, pnp_port_len(dev, 0)); 389865d7ec9SOndrej Zary } 390865d7ec9SOndrej Zary EXPORT_SYMBOL_GPL(radio_isa_pnp_remove); 391865d7ec9SOndrej Zary #endif 392