1 /* zoltrix radio plus driver for Linux radio support 2 * (c) 1998 C. van Schaik <carl@leg.uct.ac.za> 3 * 4 * BUGS 5 * Due to the inconsistency in reading from the signal flags 6 * it is difficult to get an accurate tuned signal. 7 * 8 * It seems that the card is not linear to 0 volume. It cuts off 9 * at a low volume, and it is not possible (at least I have not found) 10 * to get fine volume control over the low volume range. 11 * 12 * Some code derived from code by Romolo Manfredini 13 * romolo@bicnet.it 14 * 15 * 1999-05-06 - (C. van Schaik) 16 * - Make signal strength and stereo scans 17 * kinder to cpu while in delay 18 * 1999-01-05 - (C. van Schaik) 19 * - Changed tuning to 1/160Mhz accuracy 20 * - Added stereo support 21 * (card defaults to stereo) 22 * (can explicitly force mono on the card) 23 * (can detect if station is in stereo) 24 * - Added unmute function 25 * - Reworked ioctl functions 26 * 2002-07-15 - Fix Stereo typo 27 * 28 * 2006-07-24 - Converted to V4L2 API 29 * by Mauro Carvalho Chehab <mchehab@infradead.org> 30 */ 31 32 #include <linux/module.h> /* Modules */ 33 #include <linux/init.h> /* Initdata */ 34 #include <linux/ioport.h> /* request_region */ 35 #include <linux/delay.h> /* udelay, msleep */ 36 #include <asm/io.h> /* outb, outb_p */ 37 #include <asm/uaccess.h> /* copy to/from user */ 38 #include <linux/videodev2.h> /* kernel radio structs */ 39 #include <media/v4l2-common.h> 40 41 #include <linux/version.h> /* for KERNEL_VERSION MACRO */ 42 #define RADIO_VERSION KERNEL_VERSION(0,0,2) 43 44 static struct v4l2_queryctrl radio_qctrl[] = { 45 { 46 .id = V4L2_CID_AUDIO_MUTE, 47 .name = "Mute", 48 .minimum = 0, 49 .maximum = 1, 50 .default_value = 1, 51 .type = V4L2_CTRL_TYPE_BOOLEAN, 52 },{ 53 .id = V4L2_CID_AUDIO_VOLUME, 54 .name = "Volume", 55 .minimum = 0, 56 .maximum = 65535, 57 .step = 4096, 58 .default_value = 0xff, 59 .type = V4L2_CTRL_TYPE_INTEGER, 60 } 61 }; 62 63 #ifndef CONFIG_RADIO_ZOLTRIX_PORT 64 #define CONFIG_RADIO_ZOLTRIX_PORT -1 65 #endif 66 67 static int io = CONFIG_RADIO_ZOLTRIX_PORT; 68 static int radio_nr = -1; 69 70 struct zol_device { 71 int port; 72 int curvol; 73 unsigned long curfreq; 74 int muted; 75 unsigned int stereo; 76 struct mutex lock; 77 }; 78 79 static int zol_setvol(struct zol_device *dev, int vol) 80 { 81 dev->curvol = vol; 82 if (dev->muted) 83 return 0; 84 85 mutex_lock(&dev->lock); 86 if (vol == 0) { 87 outb(0, io); 88 outb(0, io); 89 inb(io + 3); /* Zoltrix needs to be read to confirm */ 90 mutex_unlock(&dev->lock); 91 return 0; 92 } 93 94 outb(dev->curvol-1, io); 95 msleep(10); 96 inb(io + 2); 97 mutex_unlock(&dev->lock); 98 return 0; 99 } 100 101 static void zol_mute(struct zol_device *dev) 102 { 103 dev->muted = 1; 104 mutex_lock(&dev->lock); 105 outb(0, io); 106 outb(0, io); 107 inb(io + 3); /* Zoltrix needs to be read to confirm */ 108 mutex_unlock(&dev->lock); 109 } 110 111 static void zol_unmute(struct zol_device *dev) 112 { 113 dev->muted = 0; 114 zol_setvol(dev, dev->curvol); 115 } 116 117 static int zol_setfreq(struct zol_device *dev, unsigned long freq) 118 { 119 /* tunes the radio to the desired frequency */ 120 unsigned long long bitmask, f, m; 121 unsigned int stereo = dev->stereo; 122 int i; 123 124 if (freq == 0) 125 return 1; 126 m = (freq / 160 - 8800) * 2; 127 f = (unsigned long long) m + 0x4d1c; 128 129 bitmask = 0xc480402c10080000ull; 130 i = 45; 131 132 mutex_lock(&dev->lock); 133 134 outb(0, io); 135 outb(0, io); 136 inb(io + 3); /* Zoltrix needs to be read to confirm */ 137 138 outb(0x40, io); 139 outb(0xc0, io); 140 141 bitmask = (bitmask ^ ((f & 0xff) << 47) ^ ((f & 0xff00) << 30) ^ ( stereo << 31)); 142 while (i--) { 143 if ((bitmask & 0x8000000000000000ull) != 0) { 144 outb(0x80, io); 145 udelay(50); 146 outb(0x00, io); 147 udelay(50); 148 outb(0x80, io); 149 udelay(50); 150 } else { 151 outb(0xc0, io); 152 udelay(50); 153 outb(0x40, io); 154 udelay(50); 155 outb(0xc0, io); 156 udelay(50); 157 } 158 bitmask *= 2; 159 } 160 /* termination sequence */ 161 outb(0x80, io); 162 outb(0xc0, io); 163 outb(0x40, io); 164 udelay(1000); 165 inb(io+2); 166 167 udelay(1000); 168 169 if (dev->muted) 170 { 171 outb(0, io); 172 outb(0, io); 173 inb(io + 3); 174 udelay(1000); 175 } 176 177 mutex_unlock(&dev->lock); 178 179 if(!dev->muted) 180 { 181 zol_setvol(dev, dev->curvol); 182 } 183 return 0; 184 } 185 186 /* Get signal strength */ 187 188 static int zol_getsigstr(struct zol_device *dev) 189 { 190 int a, b; 191 192 mutex_lock(&dev->lock); 193 outb(0x00, io); /* This stuff I found to do nothing */ 194 outb(dev->curvol, io); 195 msleep(20); 196 197 a = inb(io); 198 msleep(10); 199 b = inb(io); 200 201 mutex_unlock(&dev->lock); 202 203 if (a != b) 204 return (0); 205 206 if ((a == 0xcf) || (a == 0xdf) /* I found this out by playing */ 207 || (a == 0xef)) /* with a binary scanner on the card io */ 208 return (1); 209 return (0); 210 } 211 212 static int zol_is_stereo (struct zol_device *dev) 213 { 214 int x1, x2; 215 216 mutex_lock(&dev->lock); 217 218 outb(0x00, io); 219 outb(dev->curvol, io); 220 msleep(20); 221 222 x1 = inb(io); 223 msleep(10); 224 x2 = inb(io); 225 226 mutex_unlock(&dev->lock); 227 228 if ((x1 == x2) && (x1 == 0xcf)) 229 return 1; 230 return 0; 231 } 232 233 static int zol_do_ioctl(struct inode *inode, struct file *file, 234 unsigned int cmd, void *arg) 235 { 236 struct video_device *dev = video_devdata(file); 237 struct zol_device *zol = dev->priv; 238 239 switch (cmd) { 240 case VIDIOC_QUERYCAP: 241 { 242 struct v4l2_capability *v = arg; 243 memset(v,0,sizeof(*v)); 244 strlcpy(v->driver, "radio-zoltrix", sizeof (v->driver)); 245 strlcpy(v->card, "Zoltrix Radio", sizeof (v->card)); 246 sprintf(v->bus_info,"ISA"); 247 v->version = RADIO_VERSION; 248 v->capabilities = V4L2_CAP_TUNER; 249 250 return 0; 251 } 252 case VIDIOC_G_TUNER: 253 { 254 struct v4l2_tuner *v = arg; 255 256 if (v->index > 0) 257 return -EINVAL; 258 259 memset(v,0,sizeof(*v)); 260 strcpy(v->name, "FM"); 261 v->type = V4L2_TUNER_RADIO; 262 263 v->rangelow=(88*16000); 264 v->rangehigh=(108*16000); 265 v->rxsubchans =V4L2_TUNER_SUB_MONO|V4L2_TUNER_SUB_STEREO; 266 v->capability=V4L2_TUNER_CAP_LOW; 267 if(zol_is_stereo(zol)) 268 v->audmode = V4L2_TUNER_MODE_STEREO; 269 else 270 v->audmode = V4L2_TUNER_MODE_MONO; 271 v->signal=0xFFFF*zol_getsigstr(zol); 272 273 return 0; 274 } 275 case VIDIOC_S_TUNER: 276 { 277 struct v4l2_tuner *v = arg; 278 279 if (v->index > 0) 280 return -EINVAL; 281 282 return 0; 283 } 284 case VIDIOC_S_FREQUENCY: 285 { 286 struct v4l2_frequency *f = arg; 287 288 zol->curfreq = f->frequency; 289 zol_setfreq(zol, zol->curfreq); 290 return 0; 291 } 292 case VIDIOC_G_FREQUENCY: 293 { 294 struct v4l2_frequency *f = arg; 295 296 f->type = V4L2_TUNER_RADIO; 297 f->frequency = zol->curfreq; 298 299 return 0; 300 } 301 case VIDIOC_QUERYCTRL: 302 { 303 struct v4l2_queryctrl *qc = arg; 304 int i; 305 306 for (i = 0; i < ARRAY_SIZE(radio_qctrl); i++) { 307 if (qc->id && qc->id == radio_qctrl[i].id) { 308 memcpy(qc, &(radio_qctrl[i]), 309 sizeof(*qc)); 310 return (0); 311 } 312 } 313 return -EINVAL; 314 } 315 case VIDIOC_G_CTRL: 316 { 317 struct v4l2_control *ctrl= arg; 318 319 switch (ctrl->id) { 320 case V4L2_CID_AUDIO_MUTE: 321 ctrl->value=zol->muted; 322 return (0); 323 case V4L2_CID_AUDIO_VOLUME: 324 ctrl->value=zol->curvol * 4096; 325 return (0); 326 } 327 return -EINVAL; 328 } 329 case VIDIOC_S_CTRL: 330 { 331 struct v4l2_control *ctrl= arg; 332 333 switch (ctrl->id) { 334 case V4L2_CID_AUDIO_MUTE: 335 if (ctrl->value) { 336 zol_mute(zol); 337 } else { 338 zol_unmute(zol); 339 zol_setvol(zol,zol->curvol); 340 } 341 return (0); 342 case V4L2_CID_AUDIO_VOLUME: 343 zol_setvol(zol,ctrl->value/4096); 344 return (0); 345 } 346 zol->stereo = 1; 347 zol_setfreq(zol, zol->curfreq); 348 #if 0 349 /* FIXME: Implement stereo/mono switch on V4L2 */ 350 if (v->mode & VIDEO_SOUND_STEREO) { 351 zol->stereo = 1; 352 zol_setfreq(zol, zol->curfreq); 353 } 354 if (v->mode & VIDEO_SOUND_MONO) { 355 zol->stereo = 0; 356 zol_setfreq(zol, zol->curfreq); 357 } 358 #endif 359 return -EINVAL; 360 } 361 362 default: 363 return v4l_compat_translate_ioctl(inode,file,cmd,arg, 364 zol_do_ioctl); 365 } 366 } 367 368 static int zol_ioctl(struct inode *inode, struct file *file, 369 unsigned int cmd, unsigned long arg) 370 { 371 return video_usercopy(inode, file, cmd, arg, zol_do_ioctl); 372 } 373 374 static struct zol_device zoltrix_unit; 375 376 static const struct file_operations zoltrix_fops = 377 { 378 .owner = THIS_MODULE, 379 .open = video_exclusive_open, 380 .release = video_exclusive_release, 381 .ioctl = zol_ioctl, 382 .compat_ioctl = v4l_compat_ioctl32, 383 .llseek = no_llseek, 384 }; 385 386 static struct video_device zoltrix_radio = 387 { 388 .owner = THIS_MODULE, 389 .name = "Zoltrix Radio Plus", 390 .type = VID_TYPE_TUNER, 391 .hardware = 0, 392 .fops = &zoltrix_fops, 393 }; 394 395 static int __init zoltrix_init(void) 396 { 397 if (io == -1) { 398 printk(KERN_ERR "You must set an I/O address with io=0x???\n"); 399 return -EINVAL; 400 } 401 if ((io != 0x20c) && (io != 0x30c)) { 402 printk(KERN_ERR "zoltrix: invalid port, try 0x20c or 0x30c\n"); 403 return -ENXIO; 404 } 405 406 zoltrix_radio.priv = &zoltrix_unit; 407 if (!request_region(io, 2, "zoltrix")) { 408 printk(KERN_ERR "zoltrix: port 0x%x already in use\n", io); 409 return -EBUSY; 410 } 411 412 if (video_register_device(&zoltrix_radio, VFL_TYPE_RADIO, radio_nr) == -1) 413 { 414 release_region(io, 2); 415 return -EINVAL; 416 } 417 printk(KERN_INFO "Zoltrix Radio Plus card driver.\n"); 418 419 mutex_init(&zoltrix_unit.lock); 420 421 /* mute card - prevents noisy bootups */ 422 423 /* this ensures that the volume is all the way down */ 424 425 outb(0, io); 426 outb(0, io); 427 msleep(20); 428 inb(io + 3); 429 430 zoltrix_unit.curvol = 0; 431 zoltrix_unit.stereo = 1; 432 433 return 0; 434 } 435 436 MODULE_AUTHOR("C.van Schaik"); 437 MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus."); 438 MODULE_LICENSE("GPL"); 439 440 module_param(io, int, 0); 441 MODULE_PARM_DESC(io, "I/O address of the Zoltrix Radio Plus (0x20c or 0x30c)"); 442 module_param(radio_nr, int, 0); 443 444 static void __exit zoltrix_cleanup_module(void) 445 { 446 video_unregister_device(&zoltrix_radio); 447 release_region(io, 2); 448 } 449 450 module_init(zoltrix_init); 451 module_exit(zoltrix_cleanup_module); 452 453