xref: /OK3568_Linux_fs/kernel/drivers/input/gameport/emu10k1-gp.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *  Copyright (c) 2001 Vojtech Pavlik
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun 
6*4882a593Smuzhiyun /*
7*4882a593Smuzhiyun  * EMU10k1 - SB Live / Audigy - gameport driver for Linux
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun /*
11*4882a593Smuzhiyun  */
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <asm/io.h>
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #include <linux/module.h>
16*4882a593Smuzhiyun #include <linux/ioport.h>
17*4882a593Smuzhiyun #include <linux/gameport.h>
18*4882a593Smuzhiyun #include <linux/slab.h>
19*4882a593Smuzhiyun #include <linux/pci.h>
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
22*4882a593Smuzhiyun MODULE_DESCRIPTION("EMU10k1 gameport driver");
23*4882a593Smuzhiyun MODULE_LICENSE("GPL");
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun struct emu {
26*4882a593Smuzhiyun 	struct pci_dev *dev;
27*4882a593Smuzhiyun 	struct gameport *gameport;
28*4882a593Smuzhiyun 	int io;
29*4882a593Smuzhiyun 	int size;
30*4882a593Smuzhiyun };
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun static const struct pci_device_id emu_tbl[] = {
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun 	{ 0x1102, 0x7002, PCI_ANY_ID, PCI_ANY_ID }, /* SB Live gameport */
35*4882a593Smuzhiyun 	{ 0x1102, 0x7003, PCI_ANY_ID, PCI_ANY_ID }, /* Audigy gameport */
36*4882a593Smuzhiyun 	{ 0x1102, 0x7004, PCI_ANY_ID, PCI_ANY_ID }, /* Dell SB Live */
37*4882a593Smuzhiyun 	{ 0x1102, 0x7005, PCI_ANY_ID, PCI_ANY_ID }, /* Audigy LS gameport */
38*4882a593Smuzhiyun 	{ 0, }
39*4882a593Smuzhiyun };
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pci, emu_tbl);
42*4882a593Smuzhiyun 
emu_probe(struct pci_dev * pdev,const struct pci_device_id * ent)43*4882a593Smuzhiyun static int emu_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
44*4882a593Smuzhiyun {
45*4882a593Smuzhiyun 	struct emu *emu;
46*4882a593Smuzhiyun 	struct gameport *port;
47*4882a593Smuzhiyun 	int error;
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun 	emu = kzalloc(sizeof(struct emu), GFP_KERNEL);
50*4882a593Smuzhiyun 	port = gameport_allocate_port();
51*4882a593Smuzhiyun 	if (!emu || !port) {
52*4882a593Smuzhiyun 		printk(KERN_ERR "emu10k1-gp: Memory allocation failed\n");
53*4882a593Smuzhiyun 		error = -ENOMEM;
54*4882a593Smuzhiyun 		goto err_out_free;
55*4882a593Smuzhiyun 	}
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun 	error = pci_enable_device(pdev);
58*4882a593Smuzhiyun 	if (error)
59*4882a593Smuzhiyun 		goto err_out_free;
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun 	emu->io = pci_resource_start(pdev, 0);
62*4882a593Smuzhiyun 	emu->size = pci_resource_len(pdev, 0);
63*4882a593Smuzhiyun 
64*4882a593Smuzhiyun 	emu->dev = pdev;
65*4882a593Smuzhiyun 	emu->gameport = port;
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun 	gameport_set_name(port, "EMU10K1");
68*4882a593Smuzhiyun 	gameport_set_phys(port, "pci%s/gameport0", pci_name(pdev));
69*4882a593Smuzhiyun 	port->dev.parent = &pdev->dev;
70*4882a593Smuzhiyun 	port->io = emu->io;
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun 	if (!request_region(emu->io, emu->size, "emu10k1-gp")) {
73*4882a593Smuzhiyun 		printk(KERN_ERR "emu10k1-gp: unable to grab region 0x%x-0x%x\n",
74*4882a593Smuzhiyun 			emu->io, emu->io + emu->size - 1);
75*4882a593Smuzhiyun 		error = -EBUSY;
76*4882a593Smuzhiyun 		goto err_out_disable_dev;
77*4882a593Smuzhiyun 	}
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun 	pci_set_drvdata(pdev, emu);
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun 	gameport_register_port(port);
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun 	return 0;
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun  err_out_disable_dev:
86*4882a593Smuzhiyun 	pci_disable_device(pdev);
87*4882a593Smuzhiyun  err_out_free:
88*4882a593Smuzhiyun 	gameport_free_port(port);
89*4882a593Smuzhiyun 	kfree(emu);
90*4882a593Smuzhiyun 	return error;
91*4882a593Smuzhiyun }
92*4882a593Smuzhiyun 
emu_remove(struct pci_dev * pdev)93*4882a593Smuzhiyun static void emu_remove(struct pci_dev *pdev)
94*4882a593Smuzhiyun {
95*4882a593Smuzhiyun 	struct emu *emu = pci_get_drvdata(pdev);
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	gameport_unregister_port(emu->gameport);
98*4882a593Smuzhiyun 	release_region(emu->io, emu->size);
99*4882a593Smuzhiyun 	kfree(emu);
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun 	pci_disable_device(pdev);
102*4882a593Smuzhiyun }
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun static struct pci_driver emu_driver = {
105*4882a593Smuzhiyun         .name =         "Emu10k1_gameport",
106*4882a593Smuzhiyun         .id_table =     emu_tbl,
107*4882a593Smuzhiyun         .probe =        emu_probe,
108*4882a593Smuzhiyun 	.remove =	emu_remove,
109*4882a593Smuzhiyun };
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun module_pci_driver(emu_driver);
112