^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (c) 1996-2001 Vojtech Pavlik
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * This is just a very simple driver that can dump the data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * out of the joystick port into the syslog ...
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/gameport.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define DRIVER_DESC "Gameport data dumper module"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) MODULE_DESCRIPTION(DRIVER_DESC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define BUF_SIZE 256
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) struct joydump {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) unsigned int time;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) unsigned char data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) static int joydump_connect(struct gameport *gameport, struct gameport_driver *drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) struct joydump *buf; /* all entries */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct joydump *dump, *prev; /* one entry each */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) int axes[4], buttons;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int i, j, t, timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) unsigned char u;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) printk(KERN_INFO "joydump: ,------------------ START ----------------.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) printk(KERN_INFO "joydump: | Dumping: %30s |\n", gameport->phys);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) printk(KERN_INFO "joydump: | Speed: %28d kHz |\n", gameport->speed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) if (gameport_open(gameport, drv, GAMEPORT_MODE_RAW)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) printk(KERN_INFO "joydump: | Raw mode not available - trying cooked. |\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) if (gameport_open(gameport, drv, GAMEPORT_MODE_COOKED)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) printk(KERN_INFO "joydump: | Cooked not available either. Failing. |\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) printk(KERN_INFO "joydump: `------------------- END -----------------'\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) gameport_cooked_read(gameport, axes, &buttons);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) for (i = 0; i < 4; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) printk(KERN_INFO "joydump: | Axis %d: %4d. |\n", i, axes[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) printk(KERN_INFO "joydump: | Buttons %02x. |\n", buttons);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) printk(KERN_INFO "joydump: `------------------- END -----------------'\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) timeout = gameport_time(gameport, 10000); /* 10 ms */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) buf = kmalloc_array(BUF_SIZE, sizeof(struct joydump), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) if (!buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) printk(KERN_INFO "joydump: no memory for testing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) goto jd_end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) dump = buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) t = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) i = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) local_irq_save(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) u = gameport_read(gameport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) dump->data = u;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) dump->time = t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) dump++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) gameport_trigger(gameport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) while (i < BUF_SIZE && t < timeout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) dump->data = gameport_read(gameport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (dump->data ^ u) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) u = dump->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) dump->time = t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) dump++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) t++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) local_irq_restore(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) * Dump data.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) t = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) dump = buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) prev = dump;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) printk(KERN_INFO "joydump: >------------------ DATA -----------------<\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) printk(KERN_INFO "joydump: | index: %3d delta: %3d us data: ", 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) for (j = 7; j >= 0; j--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) printk("%d", (dump->data >> j) & 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) printk(" |\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) dump++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) for (i = 1; i < t; i++, dump++, prev++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) printk(KERN_INFO "joydump: | index: %3d delta: %3d us data: ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) i, dump->time - prev->time);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) for (j = 7; j >= 0; j--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) printk("%d", (dump->data >> j) & 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) printk(" |\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) kfree(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) jd_end:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) printk(KERN_INFO "joydump: `------------------- END -----------------'\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) static void joydump_disconnect(struct gameport *gameport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) gameport_close(gameport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) static struct gameport_driver joydump_drv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) .name = "joydump",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) .description = DRIVER_DESC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) .connect = joydump_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) .disconnect = joydump_disconnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) module_gameport_driver(joydump_drv);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags