Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* zoltrix radio plus driver for Linux radio support |
| 2 | * (c) 1998 C. van Schaik <carl@leg.uct.ac.za> |
| 3 | * |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 4 | * BUGS |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 17 | * kinder to cpu while in delay |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 27 | * |
| 28 | * 2006-07-24 - Converted to V4L2 API |
| 29 | * by Mauro Carvalho Chehab <mchehab@infradead.org> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | */ |
| 31 | |
| 32 | #include <linux/module.h> /* Modules */ |
| 33 | #include <linux/init.h> /* Initdata */ |
Peter Osterlund | fb911ee | 2005-09-13 01:25:15 -0700 | [diff] [blame] | 34 | #include <linux/ioport.h> /* request_region */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | #include <linux/delay.h> /* udelay, msleep */ |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 36 | #include <linux/videodev2.h> /* kernel radio structs */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 37 | #include <linux/mutex.h> |
| 38 | #include <linux/version.h> /* for KERNEL_VERSION MACRO */ |
| 39 | #include <linux/io.h> /* outb, outb_p */ |
| 40 | #include <linux/uaccess.h> /* copy to/from user */ |
| 41 | #include <media/v4l2-device.h> |
Hans Verkuil | 35ea11f | 2008-07-20 08:12:02 -0300 | [diff] [blame] | 42 | #include <media/v4l2-ioctl.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 44 | MODULE_AUTHOR("C.van Schaik"); |
| 45 | MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus."); |
| 46 | MODULE_LICENSE("GPL"); |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 47 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | #ifndef CONFIG_RADIO_ZOLTRIX_PORT |
| 49 | #define CONFIG_RADIO_ZOLTRIX_PORT -1 |
| 50 | #endif |
| 51 | |
| 52 | static int io = CONFIG_RADIO_ZOLTRIX_PORT; |
| 53 | static int radio_nr = -1; |
| 54 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 55 | module_param(io, int, 0); |
| 56 | MODULE_PARM_DESC(io, "I/O address of the Zoltrix Radio Plus (0x20c or 0x30c)"); |
| 57 | module_param(radio_nr, int, 0); |
| 58 | |
| 59 | #define RADIO_VERSION KERNEL_VERSION(0, 0, 2) |
| 60 | |
| 61 | struct zoltrix { |
| 62 | struct v4l2_device v4l2_dev; |
| 63 | struct video_device vdev; |
| 64 | int io; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 65 | int curvol; |
| 66 | unsigned long curfreq; |
| 67 | int muted; |
| 68 | unsigned int stereo; |
Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 69 | struct mutex lock; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | }; |
| 71 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 72 | static struct zoltrix zoltrix_card; |
| 73 | |
| 74 | static int zol_setvol(struct zoltrix *zol, int vol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 76 | zol->curvol = vol; |
| 77 | if (zol->muted) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | return 0; |
| 79 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 80 | mutex_lock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | if (vol == 0) { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 82 | outb(0, zol->io); |
| 83 | outb(0, zol->io); |
| 84 | inb(zol->io + 3); /* Zoltrix needs to be read to confirm */ |
| 85 | mutex_unlock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 86 | return 0; |
| 87 | } |
| 88 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 89 | outb(zol->curvol-1, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 | msleep(10); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 91 | inb(zol->io + 2); |
| 92 | mutex_unlock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | return 0; |
| 94 | } |
| 95 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 96 | static void zol_mute(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 98 | zol->muted = 1; |
| 99 | mutex_lock(&zol->lock); |
| 100 | outb(0, zol->io); |
| 101 | outb(0, zol->io); |
| 102 | inb(zol->io + 3); /* Zoltrix needs to be read to confirm */ |
| 103 | mutex_unlock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | } |
| 105 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 106 | static void zol_unmute(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 107 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 108 | zol->muted = 0; |
| 109 | zol_setvol(zol, zol->curvol); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 110 | } |
| 111 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 112 | static int zol_setfreq(struct zoltrix *zol, unsigned long freq) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | { |
| 114 | /* tunes the radio to the desired frequency */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 115 | struct v4l2_device *v4l2_dev = &zol->v4l2_dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | unsigned long long bitmask, f, m; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 117 | unsigned int stereo = zol->stereo; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | int i; |
| 119 | |
Alexey Klimov | b4be204 | 2008-10-09 13:46:59 -0300 | [diff] [blame] | 120 | if (freq == 0) { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 121 | v4l2_warn(v4l2_dev, "cannot set a frequency of 0.\n"); |
Alexey Klimov | b4be204 | 2008-10-09 13:46:59 -0300 | [diff] [blame] | 122 | return -EINVAL; |
| 123 | } |
| 124 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | m = (freq / 160 - 8800) * 2; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 126 | f = (unsigned long long)m + 0x4d1c; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | |
| 128 | bitmask = 0xc480402c10080000ull; |
| 129 | i = 45; |
| 130 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 131 | mutex_lock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 132 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 133 | zol->curfreq = freq; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 135 | outb(0, zol->io); |
| 136 | outb(0, zol->io); |
| 137 | inb(zol->io + 3); /* Zoltrix needs to be read to confirm */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 139 | outb(0x40, zol->io); |
| 140 | outb(0xc0, zol->io); |
| 141 | |
| 142 | bitmask = (bitmask ^ ((f & 0xff) << 47) ^ ((f & 0xff00) << 30) ^ (stereo << 31)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 | while (i--) { |
| 144 | if ((bitmask & 0x8000000000000000ull) != 0) { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 145 | outb(0x80, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 146 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 147 | outb(0x00, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 149 | outb(0x80, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | udelay(50); |
| 151 | } else { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 152 | outb(0xc0, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 154 | outb(0x40, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 156 | outb(0xc0, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | udelay(50); |
| 158 | } |
| 159 | bitmask *= 2; |
| 160 | } |
| 161 | /* termination sequence */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 162 | outb(0x80, zol->io); |
| 163 | outb(0xc0, zol->io); |
| 164 | outb(0x40, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 165 | udelay(1000); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 166 | inb(zol->io + 2); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 167 | |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 168 | udelay(1000); |
| 169 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 170 | if (zol->muted) { |
| 171 | outb(0, zol->io); |
| 172 | outb(0, zol->io); |
| 173 | inb(zol->io + 3); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 174 | udelay(1000); |
| 175 | } |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 176 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 177 | mutex_unlock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 178 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 179 | if (!zol->muted) |
| 180 | zol_setvol(zol, zol->curvol); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 181 | return 0; |
| 182 | } |
| 183 | |
| 184 | /* Get signal strength */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 185 | static int zol_getsigstr(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 186 | { |
| 187 | int a, b; |
| 188 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 189 | mutex_lock(&zol->lock); |
| 190 | outb(0x00, zol->io); /* This stuff I found to do nothing */ |
| 191 | outb(zol->curvol, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | msleep(20); |
| 193 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 194 | a = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 | msleep(10); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 196 | b = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 197 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 198 | mutex_unlock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 199 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | if (a != b) |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 201 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 203 | /* I found this out by playing with a binary scanner on the card io */ |
| 204 | return a == 0xcf || a == 0xdf || a == 0xef; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | } |
| 206 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 207 | static int zol_is_stereo(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 208 | { |
| 209 | int x1, x2; |
| 210 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 211 | mutex_lock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 212 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 213 | outb(0x00, zol->io); |
| 214 | outb(zol->curvol, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 | msleep(20); |
| 216 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 217 | x1 = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 218 | msleep(10); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 219 | x2 = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 220 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 221 | mutex_unlock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 222 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 223 | return x1 == x2 && x1 == 0xcf; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 224 | } |
| 225 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 226 | static int vidioc_querycap(struct file *file, void *priv, |
| 227 | struct v4l2_capability *v) |
| 228 | { |
| 229 | strlcpy(v->driver, "radio-zoltrix", sizeof(v->driver)); |
| 230 | strlcpy(v->card, "Zoltrix Radio", sizeof(v->card)); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 231 | strlcpy(v->bus_info, "ISA", sizeof(v->bus_info)); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 232 | v->version = RADIO_VERSION; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 233 | v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 234 | return 0; |
| 235 | } |
| 236 | |
| 237 | static int vidioc_g_tuner(struct file *file, void *priv, |
| 238 | struct v4l2_tuner *v) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 239 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 240 | struct zoltrix *zol = video_drvdata(file); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 242 | if (v->index > 0) |
| 243 | return -EINVAL; |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 244 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 245 | strlcpy(v->name, "FM", sizeof(v->name)); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 246 | v->type = V4L2_TUNER_RADIO; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 247 | v->rangelow = 88 * 16000; |
| 248 | v->rangehigh = 108 * 16000; |
| 249 | v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 250 | v->capability = V4L2_TUNER_CAP_LOW; |
| 251 | if (zol_is_stereo(zol)) |
| 252 | v->audmode = V4L2_TUNER_MODE_STEREO; |
| 253 | else |
| 254 | v->audmode = V4L2_TUNER_MODE_MONO; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 255 | v->signal = 0xFFFF * zol_getsigstr(zol); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 256 | return 0; |
| 257 | } |
| 258 | |
| 259 | static int vidioc_s_tuner(struct file *file, void *priv, |
| 260 | struct v4l2_tuner *v) |
| 261 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 262 | return v->index ? -EINVAL : 0; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 263 | } |
| 264 | |
| 265 | static int vidioc_s_frequency(struct file *file, void *priv, |
| 266 | struct v4l2_frequency *f) |
| 267 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 268 | struct zoltrix *zol = video_drvdata(file); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 269 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 270 | if (zol_setfreq(zol, f->frequency) != 0) |
Alexey Klimov | b4be204 | 2008-10-09 13:46:59 -0300 | [diff] [blame] | 271 | return -EINVAL; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 272 | return 0; |
| 273 | } |
| 274 | |
| 275 | static int vidioc_g_frequency(struct file *file, void *priv, |
| 276 | struct v4l2_frequency *f) |
| 277 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 278 | struct zoltrix *zol = video_drvdata(file); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 279 | |
| 280 | f->type = V4L2_TUNER_RADIO; |
| 281 | f->frequency = zol->curfreq; |
| 282 | return 0; |
| 283 | } |
| 284 | |
| 285 | static int vidioc_queryctrl(struct file *file, void *priv, |
| 286 | struct v4l2_queryctrl *qc) |
| 287 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 288 | switch (qc->id) { |
| 289 | case V4L2_CID_AUDIO_MUTE: |
| 290 | return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1); |
| 291 | case V4L2_CID_AUDIO_VOLUME: |
| 292 | return v4l2_ctrl_query_fill(qc, 0, 65535, 4096, 65535); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 293 | } |
| 294 | return -EINVAL; |
| 295 | } |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 296 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 297 | static int vidioc_g_ctrl(struct file *file, void *priv, |
| 298 | struct v4l2_control *ctrl) |
| 299 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 300 | struct zoltrix *zol = video_drvdata(file); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 302 | switch (ctrl->id) { |
| 303 | case V4L2_CID_AUDIO_MUTE: |
| 304 | ctrl->value = zol->muted; |
| 305 | return 0; |
| 306 | case V4L2_CID_AUDIO_VOLUME: |
| 307 | ctrl->value = zol->curvol * 4096; |
| 308 | return 0; |
| 309 | } |
| 310 | return -EINVAL; |
| 311 | } |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 312 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 313 | static int vidioc_s_ctrl(struct file *file, void *priv, |
| 314 | struct v4l2_control *ctrl) |
| 315 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 316 | struct zoltrix *zol = video_drvdata(file); |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 317 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 318 | switch (ctrl->id) { |
| 319 | case V4L2_CID_AUDIO_MUTE: |
| 320 | if (ctrl->value) |
| 321 | zol_mute(zol); |
| 322 | else { |
| 323 | zol_unmute(zol); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 324 | zol_setvol(zol, zol->curvol); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 325 | } |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 326 | return 0; |
| 327 | case V4L2_CID_AUDIO_VOLUME: |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 328 | zol_setvol(zol, ctrl->value / 4096); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 329 | return 0; |
| 330 | } |
| 331 | zol->stereo = 1; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 332 | if (zol_setfreq(zol, zol->curfreq) != 0) |
Alexey Klimov | b4be204 | 2008-10-09 13:46:59 -0300 | [diff] [blame] | 333 | return -EINVAL; |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 334 | #if 0 |
| 335 | /* FIXME: Implement stereo/mono switch on V4L2 */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 336 | if (v->mode & VIDEO_SOUND_STEREO) { |
| 337 | zol->stereo = 1; |
| 338 | zol_setfreq(zol, zol->curfreq); |
| 339 | } |
| 340 | if (v->mode & VIDEO_SOUND_MONO) { |
| 341 | zol->stereo = 0; |
| 342 | zol_setfreq(zol, zol->curfreq); |
| 343 | } |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 344 | #endif |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 345 | return -EINVAL; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 346 | } |
| 347 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 348 | static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i) |
| 349 | { |
| 350 | *i = 0; |
| 351 | return 0; |
| 352 | } |
| 353 | |
| 354 | static int vidioc_s_input(struct file *filp, void *priv, unsigned int i) |
| 355 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 356 | return i ? -EINVAL : 0; |
| 357 | } |
| 358 | |
| 359 | static int vidioc_g_audio(struct file *file, void *priv, |
| 360 | struct v4l2_audio *a) |
| 361 | { |
| 362 | a->index = 0; |
| 363 | strlcpy(a->name, "Radio", sizeof(a->name)); |
| 364 | a->capability = V4L2_AUDCAP_STEREO; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 365 | return 0; |
| 366 | } |
| 367 | |
| 368 | static int vidioc_s_audio(struct file *file, void *priv, |
| 369 | struct v4l2_audio *a) |
| 370 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 371 | return a->index ? -EINVAL : 0; |
| 372 | } |
| 373 | |
| 374 | static int zoltrix_open(struct file *file) |
| 375 | { |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 376 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 377 | } |
| 378 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 379 | static int zoltrix_release(struct file *file) |
Hans Verkuil | 3ca685a | 2008-08-23 04:49:13 -0300 | [diff] [blame] | 380 | { |
Hans Verkuil | 3ca685a | 2008-08-23 04:49:13 -0300 | [diff] [blame] | 381 | return 0; |
| 382 | } |
| 383 | |
Hans Verkuil | bec4366 | 2008-12-30 06:58:20 -0300 | [diff] [blame] | 384 | static const struct v4l2_file_operations zoltrix_fops = |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 385 | { |
| 386 | .owner = THIS_MODULE, |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 387 | .open = zoltrix_open, |
| 388 | .release = zoltrix_release, |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 389 | .ioctl = video_ioctl2, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 390 | }; |
| 391 | |
Hans Verkuil | a399810 | 2008-07-21 02:57:38 -0300 | [diff] [blame] | 392 | static const struct v4l2_ioctl_ops zoltrix_ioctl_ops = { |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 393 | .vidioc_querycap = vidioc_querycap, |
| 394 | .vidioc_g_tuner = vidioc_g_tuner, |
| 395 | .vidioc_s_tuner = vidioc_s_tuner, |
| 396 | .vidioc_g_audio = vidioc_g_audio, |
| 397 | .vidioc_s_audio = vidioc_s_audio, |
| 398 | .vidioc_g_input = vidioc_g_input, |
| 399 | .vidioc_s_input = vidioc_s_input, |
| 400 | .vidioc_g_frequency = vidioc_g_frequency, |
| 401 | .vidioc_s_frequency = vidioc_s_frequency, |
| 402 | .vidioc_queryctrl = vidioc_queryctrl, |
| 403 | .vidioc_g_ctrl = vidioc_g_ctrl, |
| 404 | .vidioc_s_ctrl = vidioc_s_ctrl, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | }; |
| 406 | |
| 407 | static int __init zoltrix_init(void) |
| 408 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 409 | struct zoltrix *zol = &zoltrix_card; |
| 410 | struct v4l2_device *v4l2_dev = &zol->v4l2_dev; |
| 411 | int res; |
| 412 | |
| 413 | strlcpy(v4l2_dev->name, "zoltrix", sizeof(v4l2_dev->name)); |
| 414 | zol->io = io; |
| 415 | if (zol->io == -1) { |
| 416 | v4l2_err(v4l2_dev, "You must set an I/O address with io=0x???\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 417 | return -EINVAL; |
| 418 | } |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 419 | if (zol->io != 0x20c && zol->io != 0x30c) { |
| 420 | v4l2_err(v4l2_dev, "invalid port, try 0x20c or 0x30c\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 421 | return -ENXIO; |
| 422 | } |
| 423 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 424 | if (!request_region(zol->io, 2, "zoltrix")) { |
| 425 | v4l2_err(v4l2_dev, "port 0x%x already in use\n", zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 426 | return -EBUSY; |
| 427 | } |
| 428 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 429 | res = v4l2_device_register(NULL, v4l2_dev); |
| 430 | if (res < 0) { |
| 431 | release_region(zol->io, 2); |
| 432 | v4l2_err(v4l2_dev, "Could not register v4l2_device\n"); |
| 433 | return res; |
| 434 | } |
| 435 | |
| 436 | strlcpy(zol->vdev.name, v4l2_dev->name, sizeof(zol->vdev.name)); |
| 437 | zol->vdev.v4l2_dev = v4l2_dev; |
| 438 | zol->vdev.fops = &zoltrix_fops; |
| 439 | zol->vdev.ioctl_ops = &zoltrix_ioctl_ops; |
| 440 | zol->vdev.release = video_device_release_empty; |
| 441 | video_set_drvdata(&zol->vdev, zol); |
| 442 | |
| 443 | if (video_register_device(&zol->vdev, VFL_TYPE_RADIO, radio_nr) < 0) { |
| 444 | v4l2_device_unregister(v4l2_dev); |
| 445 | release_region(zol->io, 2); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 446 | return -EINVAL; |
| 447 | } |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 448 | v4l2_info(v4l2_dev, "Zoltrix Radio Plus card driver.\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 449 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 450 | mutex_init(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 451 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 452 | /* mute card - prevents noisy bootups */ |
| 453 | |
| 454 | /* this ensures that the volume is all the way down */ |
| 455 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 456 | outb(0, zol->io); |
| 457 | outb(0, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 458 | msleep(20); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 459 | inb(zol->io + 3); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 460 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 461 | zol->curvol = 0; |
| 462 | zol->stereo = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 463 | |
| 464 | return 0; |
| 465 | } |
| 466 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 467 | static void __exit zoltrix_exit(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 468 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 469 | struct zoltrix *zol = &zoltrix_card; |
| 470 | |
| 471 | video_unregister_device(&zol->vdev); |
| 472 | v4l2_device_unregister(&zol->v4l2_dev); |
| 473 | release_region(zol->io, 2); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 474 | } |
| 475 | |
| 476 | module_init(zoltrix_init); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame^] | 477 | module_exit(zoltrix_exit); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 478 | |