Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* GemTek radio card driver for Linux (C) 1998 Jonas Munsin <jmunsin@iki.fi> |
| 2 | * |
| 3 | * GemTek hasn't released any specs on the card, so the protocol had to |
| 4 | * be reverse engineered with dosemu. |
| 5 | * |
| 6 | * Besides the protocol changes, this is mostly a copy of: |
| 7 | * |
| 8 | * RadioTrack II driver for Linux radio support (C) 1998 Ben Pfaff |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 9 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 | * Based on RadioTrack I/RadioReveal (C) 1997 M. Kirkwood |
Alan Cox | d9b0144 | 2008-10-27 15:13:47 -0300 | [diff] [blame] | 11 | * Converted to new API by Alan Cox <alan@lxorguk.ukuu.org.uk> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | * Various bugfixes and enhancements by Russell Kroll <rkroll@exploits.org> |
| 13 | * |
| 14 | * TODO: Allow for more than one of these foolish entities :-) |
| 15 | * |
Mauro Carvalho Chehab | d1c4ecd | 2006-08-08 09:10:01 -0300 | [diff] [blame] | 16 | * Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@infradead.org> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | */ |
| 18 | |
| 19 | #include <linux/module.h> /* Modules */ |
| 20 | #include <linux/init.h> /* Initdata */ |
Peter Osterlund | fb911ee | 2005-09-13 01:25:15 -0700 | [diff] [blame] | 21 | #include <linux/ioport.h> /* request_region */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | #include <linux/delay.h> /* udelay */ |
Mauro Carvalho Chehab | d1c4ecd | 2006-08-08 09:10:01 -0300 | [diff] [blame] | 23 | #include <linux/videodev2.h> /* kernel radio structs */ |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 24 | #include <linux/version.h> /* for KERNEL_VERSION MACRO */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 25 | #include <linux/mutex.h> |
| 26 | #include <linux/io.h> /* outb, outb_p */ |
| 27 | #include <linux/uaccess.h> /* copy to/from user */ |
| 28 | #include <media/v4l2-ioctl.h> |
| 29 | #include <media/v4l2-device.h> |
| 30 | |
| 31 | #define RADIO_VERSION KERNEL_VERSION(0, 0, 3) |
Mauro Carvalho Chehab | d1c4ecd | 2006-08-08 09:10:01 -0300 | [diff] [blame] | 32 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 33 | /* |
| 34 | * Module info. |
| 35 | */ |
| 36 | |
| 37 | MODULE_AUTHOR("Jonas Munsin, Pekka Seppänen <pexu@kapsi.fi>"); |
| 38 | MODULE_DESCRIPTION("A driver for the GemTek Radio card."); |
| 39 | MODULE_LICENSE("GPL"); |
| 40 | |
| 41 | /* |
| 42 | * Module params. |
| 43 | */ |
Mauro Carvalho Chehab | d1c4ecd | 2006-08-08 09:10:01 -0300 | [diff] [blame] | 44 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | #ifndef CONFIG_RADIO_GEMTEK_PORT |
| 46 | #define CONFIG_RADIO_GEMTEK_PORT -1 |
| 47 | #endif |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 48 | #ifndef CONFIG_RADIO_GEMTEK_PROBE |
| 49 | #define CONFIG_RADIO_GEMTEK_PROBE 1 |
| 50 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 52 | static int io = CONFIG_RADIO_GEMTEK_PORT; |
| 53 | static int probe = CONFIG_RADIO_GEMTEK_PROBE; |
| 54 | static int hardmute; |
| 55 | static int shutdown = 1; |
| 56 | static int keepmuted = 1; |
| 57 | static int initmute = 1; |
| 58 | static int radio_nr = -1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 60 | module_param(io, int, 0444); |
Joe Perches | 13d9701 | 2007-11-19 22:48:16 -0300 | [diff] [blame] | 61 | MODULE_PARM_DESC(io, "Force I/O port for the GemTek Radio card if automatic " |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 62 | "probing is disabled or fails. The most common I/O ports are: 0x20c " |
| 63 | "0x30c, 0x24c or 0x34c (0x20c, 0x248 and 0x28c have been reported to " |
Joe Perches | 13d9701 | 2007-11-19 22:48:16 -0300 | [diff] [blame] | 64 | "work for the combined sound/radiocard)."); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 65 | |
| 66 | module_param(probe, bool, 0444); |
| 67 | MODULE_PARM_DESC(probe, "Enable automatic device probing. Note: only the most " |
| 68 | "common I/O ports used by the card are probed."); |
| 69 | |
| 70 | module_param(hardmute, bool, 0644); |
| 71 | MODULE_PARM_DESC(hardmute, "Enable `hard muting' by shutting down PLL, may " |
| 72 | "reduce static noise."); |
| 73 | |
| 74 | module_param(shutdown, bool, 0644); |
| 75 | MODULE_PARM_DESC(shutdown, "Enable shutting down PLL and muting line when " |
| 76 | "module is unloaded."); |
| 77 | |
| 78 | module_param(keepmuted, bool, 0644); |
| 79 | MODULE_PARM_DESC(keepmuted, "Keep card muted even when frequency is changed."); |
| 80 | |
| 81 | module_param(initmute, bool, 0444); |
| 82 | MODULE_PARM_DESC(initmute, "Mute card when module is loaded."); |
| 83 | |
| 84 | module_param(radio_nr, int, 0444); |
| 85 | |
| 86 | /* |
| 87 | * Functions for controlling the card. |
| 88 | */ |
| 89 | #define GEMTEK_LOWFREQ (87*16000) |
| 90 | #define GEMTEK_HIGHFREQ (108*16000) |
| 91 | |
Trent Piepho | 857e594 | 2007-10-01 00:32:25 -0300 | [diff] [blame] | 92 | /* |
| 93 | * Frequency calculation constants. Intermediate frequency 10.52 MHz (nominal |
| 94 | * value 10.7 MHz), reference divisor 6.39 kHz (nominal 6.25 kHz). |
| 95 | */ |
| 96 | #define FSCALE 8 |
| 97 | #define IF_OFFSET ((unsigned int)(10.52 * 16000 * (1<<FSCALE))) |
| 98 | #define REF_FREQ ((unsigned int)(6.39 * 16 * (1<<FSCALE))) |
| 99 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 100 | #define GEMTEK_CK 0x01 /* Clock signal */ |
| 101 | #define GEMTEK_DA 0x02 /* Serial data */ |
| 102 | #define GEMTEK_CE 0x04 /* Chip enable */ |
| 103 | #define GEMTEK_NS 0x08 /* No signal */ |
| 104 | #define GEMTEK_MT 0x10 /* Line mute */ |
| 105 | #define GEMTEK_STDF_3_125_KHZ 0x01 /* Standard frequency 3.125 kHz */ |
| 106 | #define GEMTEK_PLL_OFF 0x07 /* PLL off */ |
| 107 | |
| 108 | #define BU2614_BUS_SIZE 32 /* BU2614 / BU2614FS bus size */ |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 109 | |
| 110 | #define SHORT_DELAY 5 /* usec */ |
| 111 | #define LONG_DELAY 75 /* usec */ |
| 112 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 113 | struct gemtek { |
| 114 | struct v4l2_device v4l2_dev; |
| 115 | struct video_device vdev; |
| 116 | struct mutex lock; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 117 | unsigned long lastfreq; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | int muted; |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 119 | int verified; |
| 120 | int io; |
Trent Piepho | b25be97 | 2007-10-01 00:38:30 -0300 | [diff] [blame] | 121 | u32 bu2614data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | }; |
| 123 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 124 | static struct gemtek gemtek_card; |
| 125 | |
Trent Piepho | b25be97 | 2007-10-01 00:38:30 -0300 | [diff] [blame] | 126 | #define BU2614_FREQ_BITS 16 /* D0..D15, Frequency data */ |
| 127 | #define BU2614_PORT_BITS 3 /* P0..P2, Output port control data */ |
| 128 | #define BU2614_VOID_BITS 4 /* unused */ |
| 129 | #define BU2614_FMES_BITS 1 /* CT, Frequency measurement beginning data */ |
| 130 | #define BU2614_STDF_BITS 3 /* R0..R2, Standard frequency data */ |
| 131 | #define BU2614_SWIN_BITS 1 /* S, Switch between FMIN / AMIN */ |
| 132 | #define BU2614_SWAL_BITS 1 /* PS, Swallow counter division (AMIN only)*/ |
| 133 | #define BU2614_VOID2_BITS 1 /* unused */ |
| 134 | #define BU2614_FMUN_BITS 1 /* GT, Frequency measurement time & unlock */ |
| 135 | #define BU2614_TEST_BITS 1 /* TS, Test data is input */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 | |
Trent Piepho | b25be97 | 2007-10-01 00:38:30 -0300 | [diff] [blame] | 137 | #define BU2614_FREQ_SHIFT 0 |
| 138 | #define BU2614_PORT_SHIFT (BU2614_FREQ_BITS + BU2614_FREQ_SHIFT) |
| 139 | #define BU2614_VOID_SHIFT (BU2614_PORT_BITS + BU2614_PORT_SHIFT) |
| 140 | #define BU2614_FMES_SHIFT (BU2614_VOID_BITS + BU2614_VOID_SHIFT) |
| 141 | #define BU2614_STDF_SHIFT (BU2614_FMES_BITS + BU2614_FMES_SHIFT) |
| 142 | #define BU2614_SWIN_SHIFT (BU2614_STDF_BITS + BU2614_STDF_SHIFT) |
| 143 | #define BU2614_SWAL_SHIFT (BU2614_SWIN_BITS + BU2614_SWIN_SHIFT) |
| 144 | #define BU2614_VOID2_SHIFT (BU2614_SWAL_BITS + BU2614_SWAL_SHIFT) |
| 145 | #define BU2614_FMUN_SHIFT (BU2614_VOID2_BITS + BU2614_VOID2_SHIFT) |
| 146 | #define BU2614_TEST_SHIFT (BU2614_FMUN_BITS + BU2614_FMUN_SHIFT) |
| 147 | |
| 148 | #define MKMASK(field) (((1<<BU2614_##field##_BITS) - 1) << \ |
| 149 | BU2614_##field##_SHIFT) |
| 150 | #define BU2614_PORT_MASK MKMASK(PORT) |
| 151 | #define BU2614_FREQ_MASK MKMASK(FREQ) |
| 152 | #define BU2614_VOID_MASK MKMASK(VOID) |
| 153 | #define BU2614_FMES_MASK MKMASK(FMES) |
| 154 | #define BU2614_STDF_MASK MKMASK(STDF) |
| 155 | #define BU2614_SWIN_MASK MKMASK(SWIN) |
| 156 | #define BU2614_SWAL_MASK MKMASK(SWAL) |
| 157 | #define BU2614_VOID2_MASK MKMASK(VOID2) |
| 158 | #define BU2614_FMUN_MASK MKMASK(FMUN) |
| 159 | #define BU2614_TEST_MASK MKMASK(TEST) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 160 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 161 | /* |
| 162 | * Set data which will be sent to BU2614FS. |
| 163 | */ |
Trent Piepho | b25be97 | 2007-10-01 00:38:30 -0300 | [diff] [blame] | 164 | #define gemtek_bu2614_set(dev, field, data) ((dev)->bu2614data = \ |
| 165 | ((dev)->bu2614data & ~field##_MASK) | ((data) << field##_SHIFT)) |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 166 | |
| 167 | /* |
| 168 | * Transmit settings to BU2614FS over GemTek IC. |
| 169 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 170 | static void gemtek_bu2614_transmit(struct gemtek *gt) |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 171 | { |
| 172 | int i, bit, q, mute; |
| 173 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 174 | mutex_lock(>->lock); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 175 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 176 | mute = gt->muted ? GEMTEK_MT : 0x00; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 177 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 178 | outb_p(mute | GEMTEK_DA | GEMTEK_CK, gt->io); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 179 | udelay(SHORT_DELAY); |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 180 | outb_p(mute | GEMTEK_CE | GEMTEK_DA | GEMTEK_CK, gt->io); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 181 | udelay(LONG_DELAY); |
| 182 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 183 | for (i = 0, q = gt->bu2614data; i < 32; i++, q >>= 1) { |
| 184 | bit = (q & 1) ? GEMTEK_DA : 0; |
| 185 | outb_p(mute | GEMTEK_CE | bit, gt->io); |
| 186 | udelay(SHORT_DELAY); |
| 187 | outb_p(mute | GEMTEK_CE | bit | GEMTEK_CK, gt->io); |
| 188 | udelay(SHORT_DELAY); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 189 | } |
| 190 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 191 | outb_p(mute | GEMTEK_DA | GEMTEK_CK, gt->io); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 192 | udelay(SHORT_DELAY); |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 193 | outb_p(mute | GEMTEK_CE | GEMTEK_DA | GEMTEK_CK, gt->io); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 194 | udelay(LONG_DELAY); |
| 195 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 196 | mutex_unlock(>->lock); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 197 | } |
| 198 | |
| 199 | /* |
Trent Piepho | 857e594 | 2007-10-01 00:32:25 -0300 | [diff] [blame] | 200 | * Calculate divisor from FM-frequency for BU2614FS (3.125 KHz STDF expected). |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 201 | */ |
Trent Piepho | 857e594 | 2007-10-01 00:32:25 -0300 | [diff] [blame] | 202 | static unsigned long gemtek_convfreq(unsigned long freq) |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 203 | { |
Trent Piepho | 857e594 | 2007-10-01 00:32:25 -0300 | [diff] [blame] | 204 | return ((freq<<FSCALE) + IF_OFFSET + REF_FREQ/2) / REF_FREQ; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 205 | } |
| 206 | |
| 207 | /* |
| 208 | * Set FM-frequency. |
| 209 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 210 | static void gemtek_setfreq(struct gemtek *gt, unsigned long freq) |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 211 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 212 | if (keepmuted && hardmute && gt->muted) |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 213 | return; |
| 214 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 215 | freq = clamp_val(freq, GEMTEK_LOWFREQ, GEMTEK_HIGHFREQ); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 216 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 217 | gt->lastfreq = freq; |
| 218 | gt->muted = 0; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 219 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 220 | gemtek_bu2614_set(gt, BU2614_PORT, 0); |
| 221 | gemtek_bu2614_set(gt, BU2614_FMES, 0); |
| 222 | gemtek_bu2614_set(gt, BU2614_SWIN, 0); /* FM-mode */ |
| 223 | gemtek_bu2614_set(gt, BU2614_SWAL, 0); |
| 224 | gemtek_bu2614_set(gt, BU2614_FMUN, 1); /* GT bit set */ |
| 225 | gemtek_bu2614_set(gt, BU2614_TEST, 0); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 226 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 227 | gemtek_bu2614_set(gt, BU2614_STDF, GEMTEK_STDF_3_125_KHZ); |
| 228 | gemtek_bu2614_set(gt, BU2614_FREQ, gemtek_convfreq(freq)); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 229 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 230 | gemtek_bu2614_transmit(gt); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 231 | } |
| 232 | |
| 233 | /* |
| 234 | * Set mute flag. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 235 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 236 | static void gemtek_mute(struct gemtek *gt) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 237 | { |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 238 | int i; |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 239 | |
| 240 | gt->muted = 1; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 241 | |
| 242 | if (hardmute) { |
| 243 | /* Turn off PLL, disable data output */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 244 | gemtek_bu2614_set(gt, BU2614_PORT, 0); |
| 245 | gemtek_bu2614_set(gt, BU2614_FMES, 0); /* CT bit off */ |
| 246 | gemtek_bu2614_set(gt, BU2614_SWIN, 0); /* FM-mode */ |
| 247 | gemtek_bu2614_set(gt, BU2614_SWAL, 0); |
| 248 | gemtek_bu2614_set(gt, BU2614_FMUN, 0); /* GT bit off */ |
| 249 | gemtek_bu2614_set(gt, BU2614_TEST, 0); |
| 250 | gemtek_bu2614_set(gt, BU2614_STDF, GEMTEK_PLL_OFF); |
| 251 | gemtek_bu2614_set(gt, BU2614_FREQ, 0); |
| 252 | gemtek_bu2614_transmit(gt); |
| 253 | return; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 254 | } |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 255 | |
| 256 | mutex_lock(>->lock); |
| 257 | |
| 258 | /* Read bus contents (CE, CK and DA). */ |
| 259 | i = inb_p(gt->io); |
| 260 | /* Write it back with mute flag set. */ |
| 261 | outb_p((i >> 5) | GEMTEK_MT, gt->io); |
| 262 | udelay(SHORT_DELAY); |
| 263 | |
| 264 | mutex_unlock(>->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 265 | } |
| 266 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 267 | /* |
| 268 | * Unset mute flag. |
| 269 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 270 | static void gemtek_unmute(struct gemtek *gt) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 271 | { |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 272 | int i; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 273 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 274 | gt->muted = 0; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 275 | if (hardmute) { |
| 276 | /* Turn PLL back on. */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 277 | gemtek_setfreq(gt, gt->lastfreq); |
| 278 | return; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 279 | } |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 280 | mutex_lock(>->lock); |
| 281 | |
| 282 | i = inb_p(gt->io); |
| 283 | outb_p(i >> 5, gt->io); |
| 284 | udelay(SHORT_DELAY); |
| 285 | |
| 286 | mutex_unlock(>->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 287 | } |
| 288 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 289 | /* |
| 290 | * Get signal strength (= stereo status). |
| 291 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 292 | static inline int gemtek_getsigstr(struct gemtek *gt) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 293 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 294 | int sig; |
| 295 | |
| 296 | mutex_lock(>->lock); |
| 297 | sig = inb_p(gt->io) & GEMTEK_NS ? 0 : 1; |
| 298 | mutex_unlock(>->lock); |
| 299 | return sig; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | } |
| 301 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 302 | /* |
| 303 | * Check if requested card acts like GemTek Radio card. |
| 304 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 305 | static int gemtek_verify(struct gemtek *gt, int port) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 306 | { |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 307 | int i, q; |
| 308 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 309 | if (gt->verified == port) |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 310 | return 1; |
| 311 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 312 | mutex_lock(>->lock); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 313 | |
| 314 | q = inb_p(port); /* Read bus contents before probing. */ |
| 315 | /* Try to turn on CE, CK and DA respectively and check if card responds |
| 316 | properly. */ |
| 317 | for (i = 0; i < 3; ++i) { |
| 318 | outb_p(1 << i, port); |
| 319 | udelay(SHORT_DELAY); |
| 320 | |
| 321 | if ((inb_p(port) & (~GEMTEK_NS)) != (0x17 | (1 << (i + 5)))) { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 322 | mutex_unlock(>->lock); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 323 | return 0; |
| 324 | } |
| 325 | } |
| 326 | outb_p(q >> 5, port); /* Write bus contents back. */ |
| 327 | udelay(SHORT_DELAY); |
| 328 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 329 | mutex_unlock(>->lock); |
| 330 | gt->verified = port; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 331 | |
| 332 | return 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 333 | } |
| 334 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 335 | /* |
| 336 | * Automatic probing for card. |
| 337 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 338 | static int gemtek_probe(struct gemtek *gt) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 340 | struct v4l2_device *v4l2_dev = >->v4l2_dev; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 341 | int ioports[] = { 0x20c, 0x30c, 0x24c, 0x34c, 0x248, 0x28c }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 342 | int i; |
| 343 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 344 | if (!probe) { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 345 | v4l2_info(v4l2_dev, "Automatic device probing disabled.\n"); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 346 | return -1; |
| 347 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 349 | v4l2_info(v4l2_dev, "Automatic device probing enabled.\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 350 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 351 | for (i = 0; i < ARRAY_SIZE(ioports); ++i) { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 352 | v4l2_info(v4l2_dev, "Trying I/O port 0x%x...\n", ioports[i]); |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 353 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 354 | if (!request_region(ioports[i], 1, "gemtek-probe")) { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 355 | v4l2_warn(v4l2_dev, "I/O port 0x%x busy!\n", |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 356 | ioports[i]); |
| 357 | continue; |
| 358 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 359 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 360 | if (gemtek_verify(gt, ioports[i])) { |
| 361 | v4l2_info(v4l2_dev, "Card found from I/O port " |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 362 | "0x%x!\n", ioports[i]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 363 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 364 | release_region(ioports[i], 1); |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 365 | gt->io = ioports[i]; |
| 366 | return gt->io; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 367 | } |
Mauro Carvalho Chehab | 4286c6f | 2006-04-08 16:06:16 -0300 | [diff] [blame] | 368 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 369 | release_region(ioports[i], 1); |
| 370 | } |
| 371 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 372 | v4l2_err(v4l2_dev, "Automatic probing failed!\n"); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 373 | return -1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 374 | } |
| 375 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 376 | /* |
| 377 | * Video 4 Linux stuff. |
| 378 | */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 379 | static int gemtek_open(struct file *file) |
Hans Verkuil | 3ca685a | 2008-08-23 04:49:13 -0300 | [diff] [blame] | 380 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 381 | return 0; |
Hans Verkuil | 3ca685a | 2008-08-23 04:49:13 -0300 | [diff] [blame] | 382 | } |
| 383 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 384 | static int gemtek_release(struct file *file) |
Hans Verkuil | 3ca685a | 2008-08-23 04:49:13 -0300 | [diff] [blame] | 385 | { |
Hans Verkuil | 3ca685a | 2008-08-23 04:49:13 -0300 | [diff] [blame] | 386 | return 0; |
| 387 | } |
| 388 | |
Hans Verkuil | bec4366 | 2008-12-30 06:58:20 -0300 | [diff] [blame] | 389 | static const struct v4l2_file_operations gemtek_fops = { |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 390 | .owner = THIS_MODULE, |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 391 | .open = gemtek_open, |
| 392 | .release = gemtek_release, |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 393 | .ioctl = video_ioctl2, |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 394 | }; |
| 395 | |
| 396 | static int vidioc_querycap(struct file *file, void *priv, |
| 397 | struct v4l2_capability *v) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 398 | { |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 399 | strlcpy(v->driver, "radio-gemtek", sizeof(v->driver)); |
| 400 | strlcpy(v->card, "GemTek", sizeof(v->card)); |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 401 | strlcpy(v->bus_info, "ISA", sizeof(v->bus_info)); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 402 | v->version = RADIO_VERSION; |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 403 | v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO; |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 404 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | } |
| 406 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 407 | static int vidioc_g_tuner(struct file *file, void *priv, struct v4l2_tuner *v) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 408 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 409 | struct gemtek *gt = video_drvdata(file); |
| 410 | |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 411 | if (v->index > 0) |
| 412 | return -EINVAL; |
| 413 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 414 | strlcpy(v->name, "FM", sizeof(v->name)); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 415 | v->type = V4L2_TUNER_RADIO; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 416 | v->rangelow = GEMTEK_LOWFREQ; |
| 417 | v->rangehigh = GEMTEK_HIGHFREQ; |
| 418 | v->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO; |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 419 | v->signal = 0xffff * gemtek_getsigstr(gt); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 420 | if (v->signal) { |
| 421 | v->audmode = V4L2_TUNER_MODE_STEREO; |
| 422 | v->rxsubchans = V4L2_TUNER_SUB_STEREO; |
| 423 | } else { |
| 424 | v->audmode = V4L2_TUNER_MODE_MONO; |
| 425 | v->rxsubchans = V4L2_TUNER_SUB_MONO; |
| 426 | } |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 427 | return 0; |
| 428 | } |
| 429 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 430 | static int vidioc_s_tuner(struct file *file, void *priv, struct v4l2_tuner *v) |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 431 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 432 | return (v->index != 0) ? -EINVAL : 0; |
| 433 | } |
| 434 | |
| 435 | static int vidioc_g_frequency(struct file *file, void *priv, |
| 436 | struct v4l2_frequency *f) |
| 437 | { |
| 438 | struct gemtek *gt = video_drvdata(file); |
| 439 | |
| 440 | if (f->tuner != 0) |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 441 | return -EINVAL; |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 442 | f->type = V4L2_TUNER_RADIO; |
| 443 | f->frequency = gt->lastfreq; |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 444 | return 0; |
| 445 | } |
| 446 | |
| 447 | static int vidioc_s_frequency(struct file *file, void *priv, |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 448 | struct v4l2_frequency *f) |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 449 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 450 | struct gemtek *gt = video_drvdata(file); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 451 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 452 | if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO) |
| 453 | return -EINVAL; |
| 454 | gemtek_setfreq(gt, f->frequency); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 455 | return 0; |
| 456 | } |
| 457 | |
| 458 | static int vidioc_queryctrl(struct file *file, void *priv, |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 459 | struct v4l2_queryctrl *qc) |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 460 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 461 | switch (qc->id) { |
| 462 | case V4L2_CID_AUDIO_MUTE: |
| 463 | return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0); |
| 464 | default: |
| 465 | return -EINVAL; |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 466 | } |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 467 | } |
| 468 | |
| 469 | static int vidioc_g_ctrl(struct file *file, void *priv, |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 470 | struct v4l2_control *ctrl) |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 471 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 472 | struct gemtek *gt = video_drvdata(file); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 473 | |
| 474 | switch (ctrl->id) { |
| 475 | case V4L2_CID_AUDIO_MUTE: |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 476 | ctrl->value = gt->muted; |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 477 | return 0; |
| 478 | } |
| 479 | return -EINVAL; |
| 480 | } |
| 481 | |
| 482 | static int vidioc_s_ctrl(struct file *file, void *priv, |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 483 | struct v4l2_control *ctrl) |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 484 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 485 | struct gemtek *gt = video_drvdata(file); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 486 | |
| 487 | switch (ctrl->id) { |
| 488 | case V4L2_CID_AUDIO_MUTE: |
| 489 | if (ctrl->value) |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 490 | gemtek_mute(gt); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 491 | else |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 492 | gemtek_unmute(gt); |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 493 | return 0; |
| 494 | } |
| 495 | return -EINVAL; |
| 496 | } |
| 497 | |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 498 | static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i) |
| 499 | { |
| 500 | *i = 0; |
| 501 | return 0; |
| 502 | } |
| 503 | |
| 504 | static int vidioc_s_input(struct file *filp, void *priv, unsigned int i) |
| 505 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 506 | return (i != 0) ? -EINVAL : 0; |
| 507 | } |
| 508 | |
| 509 | static int vidioc_g_audio(struct file *file, void *priv, struct v4l2_audio *a) |
| 510 | { |
| 511 | a->index = 0; |
| 512 | strlcpy(a->name, "Radio", sizeof(a->name)); |
| 513 | a->capability = V4L2_AUDCAP_STEREO; |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 514 | return 0; |
| 515 | } |
| 516 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 517 | static int vidioc_s_audio(struct file *file, void *priv, struct v4l2_audio *a) |
Douglas Landgraf | e9bb9c6 | 2007-04-25 00:15:46 -0300 | [diff] [blame] | 518 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 519 | return (a->index != 0) ? -EINVAL : 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 520 | } |
| 521 | |
Hans Verkuil | a399810 | 2008-07-21 02:57:38 -0300 | [diff] [blame] | 522 | static const struct v4l2_ioctl_ops gemtek_ioctl_ops = { |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 523 | .vidioc_querycap = vidioc_querycap, |
| 524 | .vidioc_g_tuner = vidioc_g_tuner, |
| 525 | .vidioc_s_tuner = vidioc_s_tuner, |
| 526 | .vidioc_g_audio = vidioc_g_audio, |
| 527 | .vidioc_s_audio = vidioc_s_audio, |
| 528 | .vidioc_g_input = vidioc_g_input, |
| 529 | .vidioc_s_input = vidioc_s_input, |
| 530 | .vidioc_g_frequency = vidioc_g_frequency, |
| 531 | .vidioc_s_frequency = vidioc_s_frequency, |
| 532 | .vidioc_queryctrl = vidioc_queryctrl, |
| 533 | .vidioc_g_ctrl = vidioc_g_ctrl, |
| 534 | .vidioc_s_ctrl = vidioc_s_ctrl |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 535 | }; |
| 536 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 537 | /* |
| 538 | * Initialization / cleanup related stuff. |
| 539 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 540 | |
| 541 | static int __init gemtek_init(void) |
| 542 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 543 | struct gemtek *gt = &gemtek_card; |
| 544 | struct v4l2_device *v4l2_dev = >->v4l2_dev; |
| 545 | int res; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 546 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 547 | strlcpy(v4l2_dev->name, "gemtek", sizeof(v4l2_dev->name)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 548 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 549 | v4l2_info(v4l2_dev, "GemTek Radio card driver: v0.0.3\n"); |
| 550 | |
| 551 | mutex_init(>->lock); |
| 552 | |
| 553 | gt->verified = -1; |
| 554 | gt->io = io; |
| 555 | gemtek_probe(gt); |
| 556 | if (gt->io) { |
| 557 | if (!request_region(gt->io, 1, "gemtek")) { |
| 558 | v4l2_err(v4l2_dev, "I/O port 0x%x already in use.\n", gt->io); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 559 | return -EBUSY; |
| 560 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 561 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 562 | if (!gemtek_verify(gt, gt->io)) |
| 563 | v4l2_warn(v4l2_dev, "Card at I/O port 0x%x does not " |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 564 | "respond properly, check your " |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 565 | "configuration.\n", gt->io); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 566 | else |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 567 | v4l2_info(v4l2_dev, "Using I/O port 0x%x.\n", gt->io); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 568 | } else if (probe) { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 569 | v4l2_err(v4l2_dev, "Automatic probing failed and no " |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 570 | "fixed I/O port defined.\n"); |
| 571 | return -ENODEV; |
| 572 | } else { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 573 | v4l2_err(v4l2_dev, "Automatic probing disabled but no fixed " |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 574 | "I/O port defined."); |
| 575 | return -EINVAL; |
| 576 | } |
| 577 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 578 | res = v4l2_device_register(NULL, v4l2_dev); |
| 579 | if (res < 0) { |
| 580 | v4l2_err(v4l2_dev, "Could not register v4l2_device\n"); |
| 581 | release_region(gt->io, 1); |
| 582 | return res; |
| 583 | } |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 584 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 585 | strlcpy(gt->vdev.name, v4l2_dev->name, sizeof(gt->vdev.name)); |
| 586 | gt->vdev.v4l2_dev = v4l2_dev; |
| 587 | gt->vdev.fops = &gemtek_fops; |
| 588 | gt->vdev.ioctl_ops = &gemtek_ioctl_ops; |
| 589 | gt->vdev.release = video_device_release_empty; |
| 590 | video_set_drvdata(>->vdev, gt); |
| 591 | |
| 592 | if (video_register_device(>->vdev, VFL_TYPE_RADIO, radio_nr) < 0) { |
| 593 | v4l2_device_unregister(v4l2_dev); |
| 594 | release_region(gt->io, 1); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 595 | return -EBUSY; |
| 596 | } |
| 597 | |
| 598 | /* Set defaults */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 599 | gt->lastfreq = GEMTEK_LOWFREQ; |
| 600 | gt->bu2614data = 0; |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 601 | |
| 602 | if (initmute) |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 603 | gemtek_mute(gt); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 604 | |
| 605 | return 0; |
| 606 | } |
| 607 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 608 | /* |
| 609 | * Module cleanup |
| 610 | */ |
| 611 | static void __exit gemtek_exit(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 612 | { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 613 | struct gemtek *gt = &gemtek_card; |
| 614 | struct v4l2_device *v4l2_dev = >->v4l2_dev; |
| 615 | |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 616 | if (shutdown) { |
| 617 | hardmute = 1; /* Turn off PLL */ |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 618 | gemtek_mute(gt); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 619 | } else { |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 620 | v4l2_info(v4l2_dev, "Module unloaded but card not muted!\n"); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 621 | } |
| 622 | |
Hans Verkuil | 502b71b | 2009-03-06 13:50:42 -0300 | [diff] [blame^] | 623 | video_unregister_device(>->vdev); |
| 624 | v4l2_device_unregister(>->v4l2_dev); |
| 625 | release_region(gt->io, 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 626 | } |
| 627 | |
| 628 | module_init(gemtek_init); |
Pekka Seppanen | 4753647 | 2007-10-01 00:27:55 -0300 | [diff] [blame] | 629 | module_exit(gemtek_exit); |