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> |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 38 | #include <linux/io.h> /* outb, outb_p */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 39 | #include <media/v4l2-device.h> |
Hans Verkuil | 35ea11f | 2008-07-20 08:12:02 -0300 | [diff] [blame] | 40 | #include <media/v4l2-ioctl.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 42 | MODULE_AUTHOR("C.van Schaik"); |
| 43 | MODULE_DESCRIPTION("A driver for the Zoltrix Radio Plus."); |
| 44 | MODULE_LICENSE("GPL"); |
Mauro Carvalho Chehab | 29834c1 | 2011-06-25 10:15:42 -0300 | [diff] [blame] | 45 | MODULE_VERSION("0.0.3"); |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 46 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | #ifndef CONFIG_RADIO_ZOLTRIX_PORT |
| 48 | #define CONFIG_RADIO_ZOLTRIX_PORT -1 |
| 49 | #endif |
| 50 | |
| 51 | static int io = CONFIG_RADIO_ZOLTRIX_PORT; |
| 52 | static int radio_nr = -1; |
| 53 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 54 | module_param(io, int, 0); |
| 55 | MODULE_PARM_DESC(io, "I/O address of the Zoltrix Radio Plus (0x20c or 0x30c)"); |
| 56 | module_param(radio_nr, int, 0); |
| 57 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 58 | struct zoltrix { |
| 59 | struct v4l2_device v4l2_dev; |
| 60 | struct video_device vdev; |
| 61 | int io; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | int curvol; |
| 63 | unsigned long curfreq; |
| 64 | int muted; |
| 65 | unsigned int stereo; |
Ingo Molnar | 3593cab | 2006-02-07 06:49:14 -0200 | [diff] [blame] | 66 | struct mutex lock; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 | }; |
| 68 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 69 | static struct zoltrix zoltrix_card; |
| 70 | |
| 71 | static int zol_setvol(struct zoltrix *zol, int vol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 73 | zol->curvol = vol; |
| 74 | if (zol->muted) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 75 | return 0; |
| 76 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 77 | mutex_lock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | if (vol == 0) { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 79 | outb(0, zol->io); |
| 80 | outb(0, zol->io); |
| 81 | inb(zol->io + 3); /* Zoltrix needs to be read to confirm */ |
| 82 | mutex_unlock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 | return 0; |
| 84 | } |
| 85 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 86 | outb(zol->curvol-1, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | msleep(10); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 88 | inb(zol->io + 2); |
| 89 | mutex_unlock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 | return 0; |
| 91 | } |
| 92 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 93 | static void zol_mute(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 95 | zol->muted = 1; |
| 96 | mutex_lock(&zol->lock); |
| 97 | outb(0, zol->io); |
| 98 | outb(0, zol->io); |
| 99 | inb(zol->io + 3); /* Zoltrix needs to be read to confirm */ |
| 100 | mutex_unlock(&zol->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 101 | } |
| 102 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 103 | static void zol_unmute(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 105 | zol->muted = 0; |
| 106 | zol_setvol(zol, zol->curvol); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 107 | } |
| 108 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 109 | static int zol_setfreq(struct zoltrix *zol, unsigned long freq) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 110 | { |
| 111 | /* tunes the radio to the desired frequency */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 112 | struct v4l2_device *v4l2_dev = &zol->v4l2_dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | unsigned long long bitmask, f, m; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 114 | unsigned int stereo = zol->stereo; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | int i; |
| 116 | |
Alexey Klimov | b4be204 | 2008-10-09 13:46:59 -0300 | [diff] [blame] | 117 | if (freq == 0) { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 118 | v4l2_warn(v4l2_dev, "cannot set a frequency of 0.\n"); |
Alexey Klimov | b4be204 | 2008-10-09 13:46:59 -0300 | [diff] [blame] | 119 | return -EINVAL; |
| 120 | } |
| 121 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | m = (freq / 160 - 8800) * 2; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 123 | f = (unsigned long long)m + 0x4d1c; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | |
| 125 | bitmask = 0xc480402c10080000ull; |
| 126 | i = 45; |
| 127 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 128 | mutex_lock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 129 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 130 | zol->curfreq = freq; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 132 | outb(0, zol->io); |
| 133 | outb(0, zol->io); |
| 134 | inb(zol->io + 3); /* Zoltrix needs to be read to confirm */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 135 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 136 | outb(0x40, zol->io); |
| 137 | outb(0xc0, zol->io); |
| 138 | |
| 139 | bitmask = (bitmask ^ ((f & 0xff) << 47) ^ ((f & 0xff00) << 30) ^ (stereo << 31)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | while (i--) { |
| 141 | if ((bitmask & 0x8000000000000000ull) != 0) { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 142 | outb(0x80, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 144 | outb(0x00, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 145 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 146 | outb(0x80, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | udelay(50); |
| 148 | } else { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 149 | outb(0xc0, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 151 | outb(0x40, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 152 | udelay(50); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 153 | outb(0xc0, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 154 | udelay(50); |
| 155 | } |
| 156 | bitmask *= 2; |
| 157 | } |
| 158 | /* termination sequence */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 159 | outb(0x80, zol->io); |
| 160 | outb(0xc0, zol->io); |
| 161 | outb(0x40, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 162 | udelay(1000); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 163 | inb(zol->io + 2); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 165 | udelay(1000); |
| 166 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 167 | if (zol->muted) { |
| 168 | outb(0, zol->io); |
| 169 | outb(0, zol->io); |
| 170 | inb(zol->io + 3); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 171 | udelay(1000); |
| 172 | } |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 173 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 174 | mutex_unlock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 175 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 176 | if (!zol->muted) |
| 177 | zol_setvol(zol, zol->curvol); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 178 | return 0; |
| 179 | } |
| 180 | |
| 181 | /* Get signal strength */ |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 182 | static int zol_getsigstr(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 183 | { |
| 184 | int a, b; |
| 185 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 186 | mutex_lock(&zol->lock); |
| 187 | outb(0x00, zol->io); /* This stuff I found to do nothing */ |
| 188 | outb(zol->curvol, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 | msleep(20); |
| 190 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 191 | a = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | msleep(10); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 193 | b = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 195 | mutex_unlock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 196 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 197 | if (a != b) |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 198 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 199 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 200 | /* I found this out by playing with a binary scanner on the card io */ |
| 201 | return a == 0xcf || a == 0xdf || a == 0xef; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | } |
| 203 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 204 | static int zol_is_stereo(struct zoltrix *zol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | { |
| 206 | int x1, x2; |
| 207 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 208 | mutex_lock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 209 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 210 | outb(0x00, zol->io); |
| 211 | outb(zol->curvol, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | msleep(20); |
| 213 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 214 | x1 = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 | msleep(10); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 216 | x2 = inb(zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 217 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 218 | mutex_unlock(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 219 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 220 | return x1 == x2 && x1 == 0xcf; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | } |
| 222 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 223 | static int vidioc_querycap(struct file *file, void *priv, |
| 224 | struct v4l2_capability *v) |
| 225 | { |
| 226 | strlcpy(v->driver, "radio-zoltrix", sizeof(v->driver)); |
| 227 | strlcpy(v->card, "Zoltrix Radio", sizeof(v->card)); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 228 | strlcpy(v->bus_info, "ISA", sizeof(v->bus_info)); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 229 | v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 230 | return 0; |
| 231 | } |
| 232 | |
| 233 | static int vidioc_g_tuner(struct file *file, void *priv, |
| 234 | struct v4l2_tuner *v) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 236 | struct zoltrix *zol = video_drvdata(file); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 237 | |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 238 | if (v->index > 0) |
| 239 | return -EINVAL; |
Mauro Carvalho Chehab | 2ab6529 | 2006-08-08 09:10:04 -0300 | [diff] [blame] | 240 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 241 | strlcpy(v->name, "FM", sizeof(v->name)); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 242 | v->type = V4L2_TUNER_RADIO; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 243 | v->rangelow = 88 * 16000; |
| 244 | v->rangehigh = 108 * 16000; |
| 245 | v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 246 | v->capability = V4L2_TUNER_CAP_LOW; |
| 247 | if (zol_is_stereo(zol)) |
| 248 | v->audmode = V4L2_TUNER_MODE_STEREO; |
| 249 | else |
| 250 | v->audmode = V4L2_TUNER_MODE_MONO; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 251 | v->signal = 0xFFFF * zol_getsigstr(zol); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 252 | return 0; |
| 253 | } |
| 254 | |
| 255 | static int vidioc_s_tuner(struct file *file, void *priv, |
| 256 | struct v4l2_tuner *v) |
| 257 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 258 | return v->index ? -EINVAL : 0; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 259 | } |
| 260 | |
| 261 | static int vidioc_s_frequency(struct file *file, void *priv, |
| 262 | struct v4l2_frequency *f) |
| 263 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 264 | struct zoltrix *zol = video_drvdata(file); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 265 | |
Hans Verkuil | a3a9e28 | 2009-11-27 04:33:25 -0300 | [diff] [blame] | 266 | if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO) |
| 267 | return -EINVAL; |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 268 | if (zol_setfreq(zol, f->frequency) != 0) |
Alexey Klimov | b4be204 | 2008-10-09 13:46:59 -0300 | [diff] [blame] | 269 | return -EINVAL; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 270 | return 0; |
| 271 | } |
| 272 | |
| 273 | static int vidioc_g_frequency(struct file *file, void *priv, |
| 274 | struct v4l2_frequency *f) |
| 275 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 276 | struct zoltrix *zol = video_drvdata(file); |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 277 | |
Hans Verkuil | a3a9e28 | 2009-11-27 04:33:25 -0300 | [diff] [blame] | 278 | if (f->tuner != 0) |
| 279 | return -EINVAL; |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 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 | |
Hans Verkuil | bec4366 | 2008-12-30 06:58:20 -0300 | [diff] [blame] | 374 | static const struct v4l2_file_operations zoltrix_fops = |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | { |
| 376 | .owner = THIS_MODULE, |
Hans Verkuil | 32958fd | 2010-11-14 09:36:23 -0300 | [diff] [blame] | 377 | .unlocked_ioctl = video_ioctl2, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 378 | }; |
| 379 | |
Hans Verkuil | a399810 | 2008-07-21 02:57:38 -0300 | [diff] [blame] | 380 | static const struct v4l2_ioctl_ops zoltrix_ioctl_ops = { |
Douglas Landgraf | a1314b1 | 2007-04-20 18:23:38 -0300 | [diff] [blame] | 381 | .vidioc_querycap = vidioc_querycap, |
| 382 | .vidioc_g_tuner = vidioc_g_tuner, |
| 383 | .vidioc_s_tuner = vidioc_s_tuner, |
| 384 | .vidioc_g_audio = vidioc_g_audio, |
| 385 | .vidioc_s_audio = vidioc_s_audio, |
| 386 | .vidioc_g_input = vidioc_g_input, |
| 387 | .vidioc_s_input = vidioc_s_input, |
| 388 | .vidioc_g_frequency = vidioc_g_frequency, |
| 389 | .vidioc_s_frequency = vidioc_s_frequency, |
| 390 | .vidioc_queryctrl = vidioc_queryctrl, |
| 391 | .vidioc_g_ctrl = vidioc_g_ctrl, |
| 392 | .vidioc_s_ctrl = vidioc_s_ctrl, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 393 | }; |
| 394 | |
| 395 | static int __init zoltrix_init(void) |
| 396 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 397 | struct zoltrix *zol = &zoltrix_card; |
| 398 | struct v4l2_device *v4l2_dev = &zol->v4l2_dev; |
| 399 | int res; |
| 400 | |
| 401 | strlcpy(v4l2_dev->name, "zoltrix", sizeof(v4l2_dev->name)); |
| 402 | zol->io = io; |
| 403 | if (zol->io == -1) { |
Hans Verkuil | b24c20cc | 2009-03-09 08:11:21 -0300 | [diff] [blame] | 404 | v4l2_err(v4l2_dev, "You must set an I/O address with io=0x20c or 0x30c\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | return -EINVAL; |
| 406 | } |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 407 | if (zol->io != 0x20c && zol->io != 0x30c) { |
| 408 | v4l2_err(v4l2_dev, "invalid port, try 0x20c or 0x30c\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 409 | return -ENXIO; |
| 410 | } |
| 411 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 412 | if (!request_region(zol->io, 2, "zoltrix")) { |
| 413 | 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] | 414 | return -EBUSY; |
| 415 | } |
| 416 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 417 | res = v4l2_device_register(NULL, v4l2_dev); |
| 418 | if (res < 0) { |
| 419 | release_region(zol->io, 2); |
| 420 | v4l2_err(v4l2_dev, "Could not register v4l2_device\n"); |
| 421 | return res; |
| 422 | } |
| 423 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 424 | mutex_init(&zol->lock); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 425 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 426 | /* mute card - prevents noisy bootups */ |
| 427 | |
| 428 | /* this ensures that the volume is all the way down */ |
| 429 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 430 | outb(0, zol->io); |
| 431 | outb(0, zol->io); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 432 | msleep(20); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 433 | inb(zol->io + 3); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 434 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 435 | zol->curvol = 0; |
| 436 | zol->stereo = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 437 | |
Hans Verkuil | 32958fd | 2010-11-14 09:36:23 -0300 | [diff] [blame] | 438 | strlcpy(zol->vdev.name, v4l2_dev->name, sizeof(zol->vdev.name)); |
| 439 | zol->vdev.v4l2_dev = v4l2_dev; |
| 440 | zol->vdev.fops = &zoltrix_fops; |
| 441 | zol->vdev.ioctl_ops = &zoltrix_ioctl_ops; |
| 442 | zol->vdev.release = video_device_release_empty; |
| 443 | video_set_drvdata(&zol->vdev, zol); |
| 444 | |
| 445 | if (video_register_device(&zol->vdev, VFL_TYPE_RADIO, radio_nr) < 0) { |
| 446 | v4l2_device_unregister(v4l2_dev); |
| 447 | release_region(zol->io, 2); |
| 448 | return -EINVAL; |
| 449 | } |
| 450 | v4l2_info(v4l2_dev, "Zoltrix Radio Plus card driver.\n"); |
| 451 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 452 | return 0; |
| 453 | } |
| 454 | |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 455 | static void __exit zoltrix_exit(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | { |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 457 | struct zoltrix *zol = &zoltrix_card; |
| 458 | |
| 459 | video_unregister_device(&zol->vdev); |
| 460 | v4l2_device_unregister(&zol->v4l2_dev); |
| 461 | release_region(zol->io, 2); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 462 | } |
| 463 | |
| 464 | module_init(zoltrix_init); |
Hans Verkuil | ec632c8 | 2009-03-06 13:55:34 -0300 | [diff] [blame] | 465 | module_exit(zoltrix_exit); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 466 | |