LXR linux/drivers/input/gameport/emu10k1-gp.c

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