AcoSail/kernel_optimize_test
8
0
Fork 0
forked from luck/tmp_suning_uos_patched
Code Pull Requests Activity

[PATCH] media-radio: Pci probing for maestro radio

Browse Source 
- Pci probing functions added, some functions were rewrited.

- Use PCI_DEVICE macro.

- dev_* used for printing when pci_dev available.

- some static variables changed to dynamicto allow operation with multiple
  cards.

- Deleted macros for DEVICE_IDS, they are in pci_ids.h yet.

Signed-off-by: Jiri Slaby <jirislaby@gmail.com>
Cc: Greg KH <greg@kroah.com>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Linus Torvalds <torvalds@osdl.org>
This commit is contained in:
Jiri Slaby 2006-01-09 20:52:47 -08:00 committed by Linus Torvalds
parent a0d50069ed
commit 89dad8f07f
1 changed files with 111 additions and 64 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

175
drivers/media/radio/radio-maestro.c
View File

@ -27,11 +27,7 @@
#include <linux/pci.h> #include <linux/pci.h>
#include <linux/videodev.h> #include <linux/videodev.h>
#define DRIVER_VERSION "0.04" #define DRIVER_VERSION "0.05"
#define PCI_VENDOR_ESS 0x125D
#define PCI_DEVICE_ID_ESS_ESS1968 0x1968 /* Maestro 2 */
#define PCI_DEVICE_ID_ESS_ESS1978 0x1978 /* Maestro 2E */
#define GPIO_DATA 0x60 /* port offset from ESS_IO_BASE */ #define GPIO_DATA 0x60 /* port offset from ESS_IO_BASE */
@ -66,6 +62,26 @@ module_param(radio_nr, int, 0);
static int radio_ioctl(struct inode *inode, struct file *file, static int radio_ioctl(struct inode *inode, struct file *file,
unsigned int cmd, unsigned long arg); unsigned int cmd, unsigned long arg);
static int maestro_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
static void maestro_remove(struct pci_dev *pdev);
static struct pci_device_id maestro_r_pci_tbl[] = {
{ PCI_DEVICE(PCI_VENDOR_ID_ESS, PCI_DEVICE_ID_ESS_ESS1968),
.class = PCI_CLASS_MULTIMEDIA_AUDIO << 8,
.class_mask = 0xffff00 },
{ PCI_DEVICE(PCI_VENDOR_ID_ESS, PCI_DEVICE_ID_ESS_ESS1978),
.class = PCI_CLASS_MULTIMEDIA_AUDIO << 8,
.class_mask = 0xffff00 },
{ 0 }
};
MODULE_DEVICE_TABLE(pci, maestro_r_pci_tbl);
static struct pci_driver maestro_r_driver = {
.name = "maestro_radio",
.id_table = maestro_r_pci_tbl,
.probe = maestro_probe,
.remove = __devexit_p(maestro_remove),
};
static struct file_operations maestro_fops = { static struct file_operations maestro_fops = {
.owner = THIS_MODULE, .owner = THIS_MODULE,
@ -85,14 +101,14 @@ static struct video_device maestro_radio=
.fops = &maestro_fops, .fops = &maestro_fops,
}; };
static struct radio_device struct radio_device
{ {
__u16 io, /* base of Maestro card radio io (GPIO_DATA)*/ __u16 io, /* base of Maestro card radio io (GPIO_DATA)*/
muted, /* VIDEO_AUDIO_MUTE */ muted, /* VIDEO_AUDIO_MUTE */
stereo, /* VIDEO_TUNER_STEREO_ON */ stereo, /* VIDEO_TUNER_STEREO_ON */
tuned; /* signal strength (0 or 0xffff) */ tuned; /* signal strength (0 or 0xffff) */
struct semaphore lock; struct semaphore lock;
} radio_unit = {0, 0, 0, 0, }; };
static __u32 radio_bits_get(struct radio_device *dev) static __u32 radio_bits_get(struct radio_device *dev)
{ {
@ -251,40 +267,7 @@ static int radio_ioctl(struct inode *inode, struct file *file,
return ret; return ret;
} }
static __u16 radio_install(struct pci_dev *pcidev); static __u16 __devinit radio_power_on(struct radio_device *dev)
MODULE_AUTHOR("Adam Tlalka, atlka@pg.gda.pl");
MODULE_DESCRIPTION("Radio driver for the Maestro PCI sound card radio.");
MODULE_LICENSE("GPL");
static void __exit maestro_radio_exit(void)
{
video_unregister_device(&maestro_radio);
}
static int __init maestro_radio_init(void)
{
register __u16 found=0;
struct pci_dev *pcidev = NULL;
while(!found && (pcidev = pci_find_device(PCI_VENDOR_ESS,
PCI_DEVICE_ID_ESS_ESS1968,
pcidev)))
found |= radio_install(pcidev);
while(!found && (pcidev = pci_find_device(PCI_VENDOR_ESS,
PCI_DEVICE_ID_ESS_ESS1978,
pcidev)))
found |= radio_install(pcidev);
if(!found) {
printk(KERN_INFO "radio-maestro: no devices found.\n");
return -ENODEV;
}
return 0;
}
module_init(maestro_radio_init);
module_exit(maestro_radio_exit);
static inline __u16 radio_power_on(struct radio_device *dev)
{ {
register __u16 io=dev->io; register __u16 io=dev->io;
register __u32 ofreq; register __u32 ofreq;
@ -305,29 +288,93 @@ static inline __u16 radio_power_on(struct radio_device *dev)
return (ofreq == radio_bits_get(dev)); return (ofreq == radio_bits_get(dev));
} }
static __u16 radio_install(struct pci_dev *pcidev) static int __devinit maestro_probe(struct pci_dev *pdev,
const struct pci_device_id *ent)
{ {
if(((pcidev->class >> 8) & 0xffff) != PCI_CLASS_MULTIMEDIA_AUDIO) struct radio_device *radio_unit;
return 0; struct video_device *maestro_radio_inst;
int retval;
radio_unit.io = pcidev->resource[0].start + GPIO_DATA;
maestro_radio.priv = &radio_unit; retval = pci_enable_device(pdev);
init_MUTEX(&radio_unit.lock); if (retval) {
dev_err(&pdev->dev, "enabling pci device failed!\n");
if(radio_power_on(&radio_unit)) { goto err;
if(video_register_device(&maestro_radio, VFL_TYPE_RADIO, radio_nr)==-1) { }
printk("radio-maestro: can't register device!");
return 0; retval = -ENOMEM;
}
printk(KERN_INFO "radio-maestro: version " radio_unit = kzalloc(sizeof(*radio_unit), GFP_KERNEL);
DRIVER_VERSION if (radio_unit == NULL) {
" time " dev_err(&pdev->dev, "not enough memory\n");
__TIME__ " " goto err;
__DATE__ }
"\n");
printk(KERN_INFO "radio-maestro: radio chip initialized\n"); radio_unit->io = pci_resource_start(pdev, 0) + GPIO_DATA;
return 1; init_MUTEX(&radio_unit->lock);
} else
return 0; maestro_radio_inst = video_device_alloc();
if (maestro_radio_inst == NULL) {
dev_err(&pdev->dev, "not enough memory\n");
goto errfr;
}
memcpy(maestro_radio_inst, &maestro_radio, sizeof(maestro_radio));
video_set_drvdata(maestro_radio_inst, radio_unit);
pci_set_drvdata(pdev, maestro_radio_inst);
retval = video_register_device(maestro_radio_inst, VFL_TYPE_RADIO,
radio_nr);
if (retval) {
printk(KERN_ERR "can't register video device!\n");
goto errfr1;
}
if (!radio_power_on(radio_unit)) {
retval = -EIO;
goto errunr;
}
dev_info(&pdev->dev, "version " DRIVER_VERSION " time " __TIME__ " "
__DATE__ "\n");
dev_info(&pdev->dev, "radio chip initialized\n");
return 0;
errunr:
video_unregister_device(maestro_radio_inst);
errfr1:
kfree(maestro_radio_inst);
errfr:
kfree(radio_unit);
err:
return retval;
} }
static void __devexit maestro_remove(struct pci_dev *pdev)
{
struct video_device *vdev = pci_get_drvdata(pdev);
video_unregister_device(vdev);
}
MODULE_AUTHOR("Adam Tlalka, atlka@pg.gda.pl");
MODULE_DESCRIPTION("Radio driver for the Maestro PCI sound card radio.");
MODULE_LICENSE("GPL");
static int __init maestro_radio_init(void)
{
int retval = pci_register_driver(&maestro_r_driver);
if (retval)
printk(KERN_ERR "error during registration pci driver\n");
return retval;
}
static void __exit maestro_radio_exit(void)
{
pci_unregister_driver(&maestro_r_driver);
}
module_init(maestro_radio_init);
module_exit(maestro_radio_exit);