cregit-Linux how code gets into the kernel

Release 4.11 drivers/input/joystick/turbografx.c

/*
 *  Copyright (c) 1998-2001 Vojtech Pavlik
 *
 *  Based on the work of:
 *      Steffen Schwenke
 */

/*
 * TurboGraFX parallel port interface driver for Linux.
 */

/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 *
 * Should you need to contact me, the author, you can do so either by
 * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
 * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
 */

#include <linux/kernel.h>
#include <linux/parport.h>
#include <linux/input.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/mutex.h>
#include <linux/slab.h>

MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
MODULE_DESCRIPTION("TurboGraFX parallel port interface driver");
MODULE_LICENSE("GPL");


#define TGFX_MAX_PORTS		3

#define TGFX_MAX_DEVICES	7


struct tgfx_config {
	
int args[TGFX_MAX_DEVICES + 1];
	
unsigned int nargs;
};


static struct tgfx_config tgfx_cfg[TGFX_MAX_PORTS];

module_param_array_named(map, tgfx_cfg[0].args, int, &tgfx_cfg[0].nargs, 0);
MODULE_PARM_DESC(map, "Describes first set of devices (<parport#>,<js1>,<js2>,..<js7>");
module_param_array_named(map2, tgfx_cfg[1].args, int, &tgfx_cfg[1].nargs, 0);
MODULE_PARM_DESC(map2, "Describes second set of devices");
module_param_array_named(map3, tgfx_cfg[2].args, int, &tgfx_cfg[2].nargs, 0);
MODULE_PARM_DESC(map3, "Describes third set of devices");


#define TGFX_REFRESH_TIME	HZ/100	
/* 10 ms */


#define TGFX_TRIGGER		0x08

#define TGFX_UP			0x10

#define TGFX_DOWN		0x20

#define TGFX_LEFT		0x40

#define TGFX_RIGHT		0x80


#define TGFX_THUMB		0x02

#define TGFX_THUMB2		0x04

#define TGFX_TOP		0x01

#define TGFX_TOP2		0x08


static int tgfx_buttons[] = { BTN_TRIGGER, BTN_THUMB, BTN_THUMB2, BTN_TOP, BTN_TOP2 };


static struct tgfx {
	
struct pardevice *pd;
	
struct timer_list timer;
	
struct input_dev *dev[TGFX_MAX_DEVICES];
	
char name[TGFX_MAX_DEVICES][64];
	
char phys[TGFX_MAX_DEVICES][32];
	
int sticks;
	
int used;
	
int parportno;
	
struct mutex sem;
} 
*tgfx_base[TGFX_MAX_PORTS];

/*
 * tgfx_timer() reads and analyzes TurboGraFX joystick data.
 */


static void tgfx_timer(unsigned long private) { struct tgfx *tgfx = (void *) private; struct input_dev *dev; int data1, data2, i; for (i = 0; i < 7; i++) if (tgfx->sticks & (1 << i)) { dev = tgfx->dev[i]; parport_write_data(tgfx->pd->port, ~(1 << i)); data1 = parport_read_status(tgfx->pd->port) ^ 0x7f; data2 = parport_read_control(tgfx->pd->port) ^ 0x04; /* CAVEAT parport */ input_report_abs(dev, ABS_X, !!(data1 & TGFX_RIGHT) - !!(data1 & TGFX_LEFT)); input_report_abs(dev, ABS_Y, !!(data1 & TGFX_DOWN ) - !!(data1 & TGFX_UP )); input_report_key(dev, BTN_TRIGGER, (data1 & TGFX_TRIGGER)); input_report_key(dev, BTN_THUMB, (data2 & TGFX_THUMB )); input_report_key(dev, BTN_THUMB2, (data2 & TGFX_THUMB2 )); input_report_key(dev, BTN_TOP, (data2 & TGFX_TOP )); input_report_key(dev, BTN_TOP2, (data2 & TGFX_TOP2 )); input_sync(dev); } mod_timer(&tgfx->timer, jiffies + TGFX_REFRESH_TIME); }

Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)23397.08%360.00%
Vojtech Pavlik52.08%120.00%
Dmitry Torokhov20.83%120.00%
Total240100.00%5100.00%


static int tgfx_open(struct input_dev *dev) { struct tgfx *tgfx = input_get_drvdata(dev); int err; err = mutex_lock_interruptible(&tgfx->sem); if (err) return err; if (!tgfx->used++) { parport_claim(tgfx->pd); parport_write_control(tgfx->pd->port, 0x04); mod_timer(&tgfx->timer, jiffies + TGFX_REFRESH_TIME); } mutex_unlock(&tgfx->sem); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)6166.30%457.14%
Dmitry Torokhov2931.52%228.57%
Ingo Molnar22.17%114.29%
Total92100.00%7100.00%


static void tgfx_close(struct input_dev *dev) { struct tgfx *tgfx = input_get_drvdata(dev); mutex_lock(&tgfx->sem); if (!--tgfx->used) { del_timer_sync(&tgfx->timer); parport_write_control(tgfx->pd->port, 0x00); parport_release(tgfx->pd); } mutex_unlock(&tgfx->sem); }

Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)5372.60%240.00%
Dmitry Torokhov1824.66%240.00%
Ingo Molnar22.74%120.00%
Total73100.00%5100.00%

/* * tgfx_probe() probes for tg gamepads. */
static void tgfx_attach(struct parport *pp) { struct tgfx *tgfx; struct input_dev *input_dev; struct pardevice *pd; int i, j, port_idx; int *n_buttons, n_devs; struct pardev_cb tgfx_parport_cb; for (port_idx = 0; port_idx < TGFX_MAX_PORTS; port_idx++) { if (tgfx_cfg[port_idx].nargs == 0 || tgfx_cfg[port_idx].args[0] < 0) continue; if (tgfx_cfg[port_idx].args[0] == pp->number) break; } if (port_idx == TGFX_MAX_PORTS) { pr_debug("Not using parport%d.\n", pp->number); return; } n_buttons = tgfx_cfg[port_idx].args + 1; n_devs = tgfx_cfg[port_idx].nargs - 1; memset(&tgfx_parport_cb, 0, sizeof(tgfx_parport_cb)); tgfx_parport_cb.flags = PARPORT_FLAG_EXCL; pd = parport_register_dev_model(pp, "turbografx", &tgfx_parport_cb, port_idx); if (!pd) { pr_err("parport busy already - lp.o loaded?\n"); return; } tgfx = kzalloc(sizeof(struct tgfx), GFP_KERNEL); if (!tgfx) { printk(KERN_ERR "turbografx.c: Not enough memory\n"); goto err_unreg_pardev; } mutex_init(&tgfx->sem); tgfx->pd = pd; tgfx->parportno = pp->number; init_timer(&tgfx->timer); tgfx->timer.data = (long) tgfx; tgfx->timer.function = tgfx_timer; for (i = 0; i < n_devs; i++) { if (n_buttons[i] < 1) continue; if (n_buttons[i] > ARRAY_SIZE(tgfx_buttons)) { printk(KERN_ERR "turbografx.c: Invalid number of buttons %d\n", n_buttons[i]); goto err_unreg_devs; } tgfx->dev[i] = input_dev = input_allocate_device(); if (!input_dev) { printk(KERN_ERR "turbografx.c: Not enough memory for input device\n"); goto err_unreg_devs; } tgfx->sticks |= (1 << i); snprintf(tgfx->name[i], sizeof(tgfx->name[i]), "TurboGraFX %d-button Multisystem joystick", n_buttons[i]); snprintf(tgfx->phys[i], sizeof(tgfx->phys[i]), "%s/input%d", tgfx->pd->port->name, i); input_dev->name = tgfx->name[i]; input_dev->phys = tgfx->phys[i]; input_dev->id.bustype = BUS_PARPORT; input_dev->id.vendor = 0x0003; input_dev->id.product = n_buttons[i]; input_dev->id.version = 0x0100; input_set_drvdata(input_dev, tgfx); input_dev->open = tgfx_open; input_dev->close = tgfx_close; input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); input_set_abs_params(input_dev, ABS_X, -1, 1, 0, 0); input_set_abs_params(input_dev, ABS_Y, -1, 1, 0, 0); for (j = 0; j < n_buttons[i]; j++) set_bit(tgfx_buttons[j], input_dev->keybit); if (input_register_device(tgfx->dev[i])) goto err_free_dev; } if (!tgfx->sticks) { printk(KERN_ERR "turbografx.c: No valid devices specified\n"); goto err_free_tgfx; } tgfx_base[port_idx] = tgfx; return; err_free_dev: input_free_device(tgfx->dev[i]); err_unreg_devs: while (--i >= 0) if (tgfx->dev[i]) input_unregister_device(tgfx->dev[i]); err_free_tgfx: kfree(tgfx); err_unreg_pardev: parport_unregister_device(pd); }

Contributors

PersonTokensPropCommitsCommitProp
Dmitry Torokhov24436.91%631.58%
Linus Torvalds (pre-git)22534.04%421.05%
Sudip Mukherjee14121.33%315.79%
Vojtech Pavlik406.05%210.53%
Al Viro71.06%15.26%
Jiri Slaby20.30%15.26%
Pekka J Enberg10.15%15.26%
Ingo Molnar10.15%15.26%
Total661100.00%19100.00%


static void tgfx_detach(struct parport *port) { int i; struct tgfx *tgfx; for (i = 0; i < TGFX_MAX_PORTS; i++) { if (tgfx_base[i] && tgfx_base[i]->parportno == port->number) break; } if (i == TGFX_MAX_PORTS) return; tgfx = tgfx_base[i]; tgfx_base[i] = NULL; for (i = 0; i < TGFX_MAX_DEVICES; i++) if (tgfx->dev[i]) input_unregister_device(tgfx->dev[i]); parport_unregister_device(tgfx->pd); kfree(tgfx); }

Contributors

PersonTokensPropCommitsCommitProp
Sudip Mukherjee6353.39%120.00%
Dmitry Torokhov3731.36%120.00%
Linus Torvalds (pre-git)1815.25%360.00%
Total118100.00%5100.00%

static struct parport_driver tgfx_parport_driver = { .name = "turbografx", .match_port = tgfx_attach, .detach = tgfx_detach, .devmodel = true, };
static int __init tgfx_init(void) { int i; int have_dev = 0; for (i = 0; i < TGFX_MAX_PORTS; i++) { if (tgfx_cfg[i].nargs == 0 || tgfx_cfg[i].args[0] < 0) continue; if (tgfx_cfg[i].nargs < 2) { printk(KERN_ERR "turbografx.c: at least one joystick must be specified\n"); return -EINVAL; } have_dev = 1; } if (!have_dev) return -ENODEV; return parport_register_driver(&tgfx_parport_driver); }

Contributors

PersonTokensPropCommitsCommitProp
Dmitry Torokhov6767.68%233.33%
Linus Torvalds (pre-git)2020.20%233.33%
Sudip Mukherjee1111.11%116.67%
Adrian Bunk11.01%116.67%
Total99100.00%6100.00%


static void __exit tgfx_exit(void) { parport_unregister_driver(&tgfx_parport_driver); }

Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)1173.33%133.33%
Sudip Mukherjee320.00%133.33%
Adrian Bunk16.67%133.33%
Total15100.00%3100.00%

module_init(tgfx_init); module_exit(tgfx_exit);

Overall Contributors

PersonTokensPropCommitsCommitProp
Linus Torvalds (pre-git)75346.51%517.86%
Dmitry Torokhov52532.43%828.57%
Sudip Mukherjee24815.32%310.71%
Vojtech Pavlik593.64%310.71%
Ingo Molnar90.56%13.57%
Al Viro70.43%13.57%
Linus Torvalds50.31%13.57%
Adrian Bunk40.25%27.14%
Rusty Russell30.19%13.57%
Tejun Heo30.19%13.57%
Jiri Slaby20.12%13.57%
Pekka J Enberg10.06%13.57%
Total1619100.00%28100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.