blob: 44b4dbedb322a57108483494f4785b7b02252076 [file] [log] [blame]
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -03001/*
2 * Guillemot Maxi Radio FM 2000 PCI radio card driver for Linux
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 * (C) 2001 Dimitromanolakis Apostolos <apdim@grecian.net>
4 *
5 * Based in the radio Maestro PCI driver. Actually it uses the same chip
6 * for radio but different pci controller.
7 *
8 * I didn't have any specs I reversed engineered the protocol from
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -03009 * the windows driver (radio.dll).
Linus Torvalds1da177e2005-04-16 15:20:36 -070010 *
11 * The card uses the TEA5757 chip that includes a search function but it
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -030012 * is useless as I haven't found any way to read back the frequency. If
Linus Torvalds1da177e2005-04-16 15:20:36 -070013 * anybody does please mail me.
14 *
15 * For the pdf file see:
16 * http://www.semiconductors.philips.com/pip/TEA5757H/V1
17 *
18 *
19 * CHANGES:
20 * 0.75b
21 * - better pci interface thanks to Francois Romieu <romieu@cogenit.fr>
22 *
Mauro Carvalho Chehabe84fef62006-08-08 09:10:05 -030023 * 0.75 Sun Feb 4 22:51:27 EET 2001
Linus Torvalds1da177e2005-04-16 15:20:36 -070024 * - tiding up
25 * - removed support for multiple devices as it didn't work anyway
26 *
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -030027 * BUGS:
Linus Torvalds1da177e2005-04-16 15:20:36 -070028 * - card unmutes if you change frequency
29 *
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -030030 * (c) 2006, 2007 by Mauro Carvalho Chehab <mchehab@infradead.org>:
31 * - Conversion to V4L2 API
32 * - Uses video_ioctl2 for parsing and to add debug support
Linus Torvalds1da177e2005-04-16 15:20:36 -070033 */
34
35
36#include <linux/module.h>
37#include <linux/init.h>
38#include <linux/ioport.h>
39#include <linux/delay.h>
Ingo Molnar3593cab2006-02-07 06:49:14 -020040#include <linux/mutex.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070041#include <linux/pci.h>
Mauro Carvalho Chehabe84fef62006-08-08 09:10:05 -030042#include <linux/videodev2.h>
Hans Verkuil2710e6a2009-03-06 13:51:33 -030043#include <linux/version.h> /* for KERNEL_VERSION MACRO */
44#include <linux/io.h>
Hans Verkuil2710e6a2009-03-06 13:51:33 -030045#include <media/v4l2-device.h>
Hans Verkuil35ea11f2008-07-20 08:12:02 -030046#include <media/v4l2-ioctl.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
Hans Verkuil2710e6a2009-03-06 13:51:33 -030048MODULE_AUTHOR("Dimitromanolakis Apostolos, apdim@grecian.net");
49MODULE_DESCRIPTION("Radio driver for the Guillemot Maxi Radio FM2000 radio.");
50MODULE_LICENSE("GPL");
51
52static int radio_nr = -1;
53module_param(radio_nr, int, 0);
54
55static int debug;
56
57module_param(debug, int, 0644);
58MODULE_PARM_DESC(debug, "activates debug info");
59
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -030060#define DRIVER_VERSION "0.77"
Mauro Carvalho Chehabe84fef62006-08-08 09:10:05 -030061
Hans Verkuil2710e6a2009-03-06 13:51:33 -030062#define RADIO_VERSION KERNEL_VERSION(0, 7, 7)
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -030063
Hans Verkuil2710e6a2009-03-06 13:51:33 -030064#define dprintk(dev, num, fmt, arg...) \
65 v4l2_dbg(num, debug, &dev->v4l2_dev, fmt, ## arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
67#ifndef PCI_VENDOR_ID_GUILLEMOT
68#define PCI_VENDOR_ID_GUILLEMOT 0x5046
69#endif
70
71#ifndef PCI_DEVICE_ID_GUILLEMOT
72#define PCI_DEVICE_ID_GUILLEMOT_MAXIRADIO 0x1001
73#endif
74
75
76/* TEA5757 pin mappings */
Hans Verkuil2710e6a2009-03-06 13:51:33 -030077static const int clk = 1, data = 2, wren = 4, mo_st = 8, power = 16;
Linus Torvalds1da177e2005-04-16 15:20:36 -070078
Hans Verkuil2710e6a2009-03-06 13:51:33 -030079#define FREQ_LO (50 * 16000)
80#define FREQ_HI (150 * 16000)
Linus Torvalds1da177e2005-04-16 15:20:36 -070081
82#define FREQ_IF 171200 /* 10.7*16000 */
83#define FREQ_STEP 200 /* 12.5*16 */
84
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -030085/* (x==fmhz*16*1000) -> bits */
Hans Verkuil2710e6a2009-03-06 13:51:33 -030086#define FREQ2BITS(x) \
87 ((((unsigned int)(x) + FREQ_IF + (FREQ_STEP << 1)) / (FREQ_STEP << 2)) << 2)
Linus Torvalds1da177e2005-04-16 15:20:36 -070088
89#define BITS2FREQ(x) ((x) * FREQ_STEP - FREQ_IF)
90
91
Hans Verkuil2710e6a2009-03-06 13:51:33 -030092struct maxiradio
Hans Verkuil3ca685a2008-08-23 04:49:13 -030093{
Hans Verkuil2710e6a2009-03-06 13:51:33 -030094 struct v4l2_device v4l2_dev;
95 struct video_device vdev;
96 struct pci_dev *pdev;
Hans Verkuil3ca685a2008-08-23 04:49:13 -030097
Hans Verkuil2710e6a2009-03-06 13:51:33 -030098 u16 io; /* base of radio io */
99 u16 muted; /* VIDEO_AUDIO_MUTE */
100 u16 stereo; /* VIDEO_TUNER_STEREO_ON */
101 u16 tuned; /* signal strength (0 or 0xffff) */
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300102
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 unsigned long freq;
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300104
Ingo Molnar3593cab2006-02-07 06:49:14 -0200105 struct mutex lock;
Mauro Carvalho Chehab712642b2007-01-26 07:33:07 -0300106};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300108static inline struct maxiradio *to_maxiradio(struct v4l2_device *v4l2_dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300110 return container_of(v4l2_dev, struct maxiradio, v4l2_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111}
112
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300113static void outbit(unsigned long bit, u16 io)
114{
115 int val = power | wren | (bit ? data : 0);
116
117 outb(val, io);
118 udelay(4);
119 outb(val | clk, io);
120 udelay(4);
121 outb(val, io);
122 udelay(4);
123}
124
125static void turn_power(struct maxiradio *dev, int p)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126{
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300127 if (p != 0) {
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300128 dprintk(dev, 1, "Radio powered on\n");
129 outb(power, dev->io);
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300130 } else {
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300131 dprintk(dev, 1, "Radio powered off\n");
132 outb(0, dev->io);
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300133 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134}
135
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300136static void set_freq(struct maxiradio *dev, u32 freq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137{
138 unsigned long int si;
139 int bl;
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300140 int io = dev->io;
Hans Verkuilc6eb8ea2008-09-03 17:11:54 -0300141 int val = FREQ2BITS(freq);
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300142
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143 /* TEA5757 shift register bits (see pdf) */
144
Hans Verkuilc6eb8ea2008-09-03 17:11:54 -0300145 outbit(0, io); /* 24 search */
146 outbit(1, io); /* 23 search up/down */
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300147
Hans Verkuilc6eb8ea2008-09-03 17:11:54 -0300148 outbit(0, io); /* 22 stereo/mono */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149
Hans Verkuilc6eb8ea2008-09-03 17:11:54 -0300150 outbit(0, io); /* 21 band */
151 outbit(0, io); /* 20 band (only 00=FM works I think) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152
Hans Verkuilc6eb8ea2008-09-03 17:11:54 -0300153 outbit(0, io); /* 19 port ? */
154 outbit(0, io); /* 18 port ? */
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300155
Hans Verkuilc6eb8ea2008-09-03 17:11:54 -0300156 outbit(0, io); /* 17 search level */
157 outbit(0, io); /* 16 search level */
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300158
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 si = 0x8000;
Hans Verkuilc6eb8ea2008-09-03 17:11:54 -0300160 for (bl = 1; bl <= 16; bl++) {
161 outbit(val & si, io);
162 si >>= 1;
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300163 }
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300164
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300165 dprintk(dev, 1, "Radio freq set to %d.%02d MHz\n",
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300166 freq / 16000,
167 freq % 16000 * 100 / 16000);
168
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300169 turn_power(dev, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170}
171
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300172static int get_stereo(u16 io)
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300173{
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300174 outb(power,io);
175 udelay(4);
176
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177 return !(inb(io) & mo_st);
178}
179
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300180static int get_tune(u16 io)
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300181{
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300182 outb(power+clk,io);
183 udelay(4);
184
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185 return !(inb(io) & mo_st);
186}
187
188
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300189static int vidioc_querycap(struct file *file, void *priv,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300190 struct v4l2_capability *v)
191{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300192 struct maxiradio *dev = video_drvdata(file);
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300193
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300194 strlcpy(v->driver, "radio-maxiradio", sizeof(v->driver));
195 strlcpy(v->card, "Maxi Radio FM2000 radio", sizeof(v->card));
196 snprintf(v->bus_info, sizeof(v->bus_info), "PCI:%s", pci_name(dev->pdev));
197 v->version = RADIO_VERSION;
198 v->capabilities = V4L2_CAP_TUNER | V4L2_CAP_RADIO;
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300199 return 0;
200}
201
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300202static int vidioc_g_tuner(struct file *file, void *priv,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300203 struct v4l2_tuner *v)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300205 struct maxiradio *dev = video_drvdata(file);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300207 if (v->index > 0)
208 return -EINVAL;
Mauro Carvalho Chehabe84fef62006-08-08 09:10:05 -0300209
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300210 mutex_lock(&dev->lock);
211 strlcpy(v->name, "FM", sizeof(v->name));
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300212 v->type = V4L2_TUNER_RADIO;
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300213 v->rangelow = FREQ_LO;
214 v->rangehigh = FREQ_HI;
215 v->rxsubchans = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
216 v->capability = V4L2_TUNER_CAP_LOW;
217 if (get_stereo(dev->io))
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300218 v->audmode = V4L2_TUNER_MODE_STEREO;
219 else
220 v->audmode = V4L2_TUNER_MODE_MONO;
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300221 v->signal = 0xffff * get_tune(dev->io);
222 mutex_unlock(&dev->lock);
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300223
224 return 0;
225}
226
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300227static int vidioc_s_tuner(struct file *file, void *priv,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300228 struct v4l2_tuner *v)
229{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300230 return v->index ? -EINVAL : 0;
Mauro Carvalho Chehab140dcc42007-01-25 15:00:45 -0300231}
232
Mauro Carvalho Chehaba0c05ab2007-01-25 16:48:13 -0300233static int vidioc_g_input(struct file *filp, void *priv, unsigned int *i)
234{
235 *i = 0;
236 return 0;
237}
238
239static int vidioc_s_input(struct file *filp, void *priv, unsigned int i)
240{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300241 return i ? -EINVAL : 0;
Mauro Carvalho Chehaba0c05ab2007-01-25 16:48:13 -0300242}
243
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300244static int vidioc_g_audio(struct file *file, void *priv,
Mauro Carvalho Chehab140dcc42007-01-25 15:00:45 -0300245 struct v4l2_audio *a)
246{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300247 a->index = 0;
248 strlcpy(a->name, "Radio", sizeof(a->name));
249 a->capability = V4L2_AUDCAP_STEREO;
Mauro Carvalho Chehab140dcc42007-01-25 15:00:45 -0300250 return 0;
251}
252
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300253
254static int vidioc_s_audio(struct file *file, void *priv,
255 struct v4l2_audio *a)
256{
257 return a->index ? -EINVAL : 0;
258}
259
260static int vidioc_s_frequency(struct file *file, void *priv,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300261 struct v4l2_frequency *f)
262{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300263 struct maxiradio *dev = video_drvdata(file);
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300264
Hans Verkuila3a9e282009-11-27 04:33:25 -0300265 if (f->tuner != 0 || f->type != V4L2_TUNER_RADIO)
266 return -EINVAL;
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300267 if (f->frequency < FREQ_LO || f->frequency > FREQ_HI) {
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300268 dprintk(dev, 1, "radio freq (%d.%02d MHz) out of range (%d-%d)\n",
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300269 f->frequency / 16000,
270 f->frequency % 16000 * 100 / 16000,
271 FREQ_LO / 16000, FREQ_HI / 16000);
272
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300273 return -EINVAL;
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300274 }
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300275
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300276 mutex_lock(&dev->lock);
277 dev->freq = f->frequency;
278 set_freq(dev, dev->freq);
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300279 msleep(125);
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300280 mutex_unlock(&dev->lock);
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300281
282 return 0;
283}
284
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300285static int vidioc_g_frequency(struct file *file, void *priv,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300286 struct v4l2_frequency *f)
287{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300288 struct maxiradio *dev = video_drvdata(file);
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300289
Hans Verkuila3a9e282009-11-27 04:33:25 -0300290 if (f->tuner != 0)
291 return -EINVAL;
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300292 f->type = V4L2_TUNER_RADIO;
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300293 f->frequency = dev->freq;
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300294
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300295 dprintk(dev, 4, "radio freq is %d.%02d MHz",
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300296 f->frequency / 16000,
297 f->frequency % 16000 * 100 / 16000);
298
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300299 return 0;
300}
301
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300302static int vidioc_queryctrl(struct file *file, void *priv,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300303 struct v4l2_queryctrl *qc)
304{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300305 switch (qc->id) {
306 case V4L2_CID_AUDIO_MUTE:
307 return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700308 }
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300309 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310}
311
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300312static int vidioc_g_ctrl(struct file *file, void *priv,
313 struct v4l2_control *ctrl)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700314{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300315 struct maxiradio *dev = video_drvdata(file);
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300316
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300317 switch (ctrl->id) {
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300318 case V4L2_CID_AUDIO_MUTE:
319 ctrl->value = dev->muted;
320 return 0;
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300321 }
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300322
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300323 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324}
325
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300326static int vidioc_s_ctrl(struct file *file, void *priv,
327 struct v4l2_control *ctrl)
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300328{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300329 struct maxiradio *dev = video_drvdata(file);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300331 switch (ctrl->id) {
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300332 case V4L2_CID_AUDIO_MUTE:
333 mutex_lock(&dev->lock);
334 dev->muted = ctrl->value;
335 if (dev->muted)
336 turn_power(dev, 0);
337 else
338 set_freq(dev, dev->freq);
339 mutex_unlock(&dev->lock);
340 return 0;
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300341 }
Mauro Carvalho Chehabf1557ce2007-01-26 07:23:44 -0300342
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300343 return -EINVAL;
344}
345
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300346static const struct v4l2_file_operations maxiradio_fops = {
347 .owner = THIS_MODULE,
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300348 .ioctl = video_ioctl2,
349};
350
Hans Verkuila3998102008-07-21 02:57:38 -0300351static const struct v4l2_ioctl_ops maxiradio_ioctl_ops = {
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300352 .vidioc_querycap = vidioc_querycap,
353 .vidioc_g_tuner = vidioc_g_tuner,
354 .vidioc_s_tuner = vidioc_s_tuner,
Mauro Carvalho Chehab140dcc42007-01-25 15:00:45 -0300355 .vidioc_g_audio = vidioc_g_audio,
356 .vidioc_s_audio = vidioc_s_audio,
Mauro Carvalho Chehaba0c05ab2007-01-25 16:48:13 -0300357 .vidioc_g_input = vidioc_g_input,
358 .vidioc_s_input = vidioc_s_input,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300359 .vidioc_g_frequency = vidioc_g_frequency,
360 .vidioc_s_frequency = vidioc_s_frequency,
361 .vidioc_queryctrl = vidioc_queryctrl,
362 .vidioc_g_ctrl = vidioc_g_ctrl,
363 .vidioc_s_ctrl = vidioc_s_ctrl,
Mauro Carvalho Chehab06470ed2007-01-25 09:04:34 -0300364};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365
366static int __devinit maxiradio_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
367{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300368 struct maxiradio *dev;
369 struct v4l2_device *v4l2_dev;
370 int retval = -ENOMEM;
371
372 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
373 if (dev == NULL) {
374 dev_err(&pdev->dev, "not enough memory\n");
375 return -ENOMEM;
376 }
377
378 v4l2_dev = &dev->v4l2_dev;
379 mutex_init(&dev->lock);
380 dev->pdev = pdev;
381 dev->muted = 1;
382 dev->freq = FREQ_LO;
383
384 strlcpy(v4l2_dev->name, "maxiradio", sizeof(v4l2_dev->name));
385
386 retval = v4l2_device_register(&pdev->dev, v4l2_dev);
387 if (retval < 0) {
388 v4l2_err(v4l2_dev, "Could not register v4l2_device\n");
389 goto errfr;
390 }
391
392 if (!request_region(pci_resource_start(pdev, 0),
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300393 pci_resource_len(pdev, 0), "Maxi Radio FM 2000")) {
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300394 v4l2_err(v4l2_dev, "can't reserve I/O ports\n");
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300395 goto err_out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396 }
397
398 if (pci_enable_device(pdev))
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300399 goto err_out_free_region;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700400
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300401 dev->io = pci_resource_start(pdev, 0);
402 strlcpy(dev->vdev.name, v4l2_dev->name, sizeof(dev->vdev.name));
403 dev->vdev.v4l2_dev = v4l2_dev;
404 dev->vdev.fops = &maxiradio_fops;
405 dev->vdev.ioctl_ops = &maxiradio_ioctl_ops;
406 dev->vdev.release = video_device_release_empty;
407 video_set_drvdata(&dev->vdev, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300409 if (video_register_device(&dev->vdev, VFL_TYPE_RADIO, radio_nr) < 0) {
410 v4l2_err(v4l2_dev, "can't register device!");
Mauro Carvalho Chehab4286c6f2006-04-08 16:06:16 -0300411 goto err_out_free_region;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412 }
413
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300414 v4l2_info(v4l2_dev, "version " DRIVER_VERSION
415 " time " __TIME__ " " __DATE__ "\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300417 v4l2_info(v4l2_dev, "found Guillemot MAXI Radio device (io = 0x%x)\n",
418 dev->io);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419 return 0;
420
421err_out_free_region:
422 release_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0));
423err_out:
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300424 v4l2_device_unregister(v4l2_dev);
425errfr:
426 kfree(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427 return -ENODEV;
428}
429
430static void __devexit maxiradio_remove_one(struct pci_dev *pdev)
431{
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300432 struct v4l2_device *v4l2_dev = dev_get_drvdata(&pdev->dev);
433 struct maxiradio *dev = to_maxiradio(v4l2_dev);
434
435 video_unregister_device(&dev->vdev);
436 v4l2_device_unregister(&dev->v4l2_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437 release_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0));
438}
439
440static struct pci_device_id maxiradio_pci_tbl[] = {
441 { PCI_VENDOR_ID_GUILLEMOT, PCI_DEVICE_ID_GUILLEMOT_MAXIRADIO,
442 PCI_ANY_ID, PCI_ANY_ID, },
Hans Verkuil2710e6a2009-03-06 13:51:33 -0300443 { 0 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444};
445
446MODULE_DEVICE_TABLE(pci, maxiradio_pci_tbl);
447
448static struct pci_driver maxiradio_driver = {
449 .name = "radio-maxiradio",
450 .id_table = maxiradio_pci_tbl,
451 .probe = maxiradio_init_one,
452 .remove = __devexit_p(maxiradio_remove_one),
453};
454
455static int __init maxiradio_radio_init(void)
456{
Richard Knutsson9bfab8c2005-11-30 00:59:34 +0100457 return pci_register_driver(&maxiradio_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700458}
459
460static void __exit maxiradio_radio_exit(void)
461{
462 pci_unregister_driver(&maxiradio_driver);
463}
464
465module_init(maxiradio_radio_init);
466module_exit(maxiradio_radio_exit);