joystick.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:4k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * Atari Joystick Driver for Linux
  3.  * by Robert de Vries (robert@and.nl) 19Jul93
  4.  *
  5.  * 16 Nov 1994 Andreas Schwab
  6.  * Support for three button mouse (shamelessly stolen from MiNT)
  7.  * third button wired to one of the joystick directions on joystick 1
  8.  */
  9. #include <linux/sched.h>
  10. #include <linux/errno.h>
  11. #include <linux/major.h>
  12. #include <linux/poll.h>
  13. #include <linux/init.h>
  14. #include <linux/devfs_fs_kernel.h>
  15. #include <linux/smp_lock.h>
  16. #include <asm/atarikb.h>
  17. #include <asm/atari_joystick.h>
  18. #include <asm/uaccess.h>
  19. #define MAJOR_NR    JOYSTICK_MAJOR
  20. #define ANALOG_JOY(n) (!(n & 0x80))
  21. #define DIGITAL_JOY(n) (n & 0x80)
  22. #define DEVICE_NR(n) (MINOR(n) & 0x7f)
  23. static struct joystick_status joystick[2];
  24. int atari_mouse_buttons; /* for three-button mouse */
  25. void atari_joystick_interrupt(char *buf)
  26. {
  27.     int j;
  28. /*    ikbd_joystick_disable(); */
  29.     j = buf[0] & 0x1;
  30.     joystick[j].dir   = buf[1] & 0xF;
  31.     joystick[j].fire  = (buf[1] & 0x80) >> 7;
  32.     joystick[j].ready = 1;
  33.     wake_up_interruptible(&joystick[j].wait);
  34.     /* For three-button mouse emulation fake a mouse packet */
  35.     if (atari_mouse_interrupt_hook &&
  36. j == 1 && (buf[1] & 1) != ((atari_mouse_buttons & 2) >> 1))
  37.       {
  38. char faked_packet[3];
  39. atari_mouse_buttons = (atari_mouse_buttons & 5) | ((buf[1] & 1) << 1);
  40. faked_packet[0] = (atari_mouse_buttons & 1) | 
  41.   (atari_mouse_buttons & 4 ? 2 : 0);
  42. faked_packet[1] = 0;
  43. faked_packet[2] = 0;
  44. atari_mouse_interrupt_hook (faked_packet);
  45.       }
  46. /*    ikbd_joystick_event_on(); */
  47. }
  48. static int release_joystick(struct inode *inode, struct file *file)
  49. {
  50.     int minor = DEVICE_NR(inode->i_rdev);
  51.     lock_kernel();
  52.     joystick[minor].active = 0;
  53.     joystick[minor].ready = 0;
  54.     if ((joystick[0].active == 0) && (joystick[1].active == 0))
  55. ikbd_joystick_disable();
  56.     unlock_kernel();
  57.     return 0;
  58. }
  59. static int open_joystick(struct inode *inode, struct file *file)
  60. {
  61.     int minor = DEVICE_NR(inode->i_rdev);
  62.     if (!DIGITAL_JOY(inode->i_rdev) || minor > 1)
  63. return -ENODEV;
  64.     if (joystick[minor].active)
  65. return -EBUSY;
  66.     joystick[minor].active = 1;
  67.     joystick[minor].ready = 0;
  68.     ikbd_joystick_event_on();
  69.     return 0;
  70. }
  71. static ssize_t write_joystick(struct file *file, const char *buffer,
  72.       size_t count, loff_t *ppos)
  73. {
  74.     return -EINVAL;
  75. }
  76. static ssize_t read_joystick(struct file *file, char *buffer, size_t count,
  77.      loff_t *ppos)
  78. {
  79.     struct inode *inode = file->f_dentry->d_inode;
  80.     int minor = DEVICE_NR(inode->i_rdev);
  81.     if (count < 2)
  82. return -EINVAL;
  83.     if (!joystick[minor].ready)
  84. return -EAGAIN;
  85.     joystick[minor].ready = 0;
  86.     if (put_user(joystick[minor].fire, buffer++) ||
  87. put_user(joystick[minor].dir, buffer++))
  88. return -EFAULT;
  89.     if (count > 2)
  90. if (clear_user(buffer, count - 2))
  91.     return -EFAULT;
  92.     return count;
  93. }
  94. static unsigned int joystick_poll(struct file *file, poll_table *wait)
  95. {
  96.     int minor = DEVICE_NR(file->f_dentry->d_inode->i_rdev);
  97.     poll_wait(file, &joystick[minor].wait, wait);
  98.     if (joystick[minor].ready)
  99. return POLLIN | POLLRDNORM;
  100.     return 0;
  101. }
  102. struct file_operations atari_joystick_fops = {
  103. read: read_joystick,
  104. write: write_joystick,
  105. poll: joystick_poll,
  106. open: open_joystick,
  107. release: release_joystick,
  108. };
  109. int __init atari_joystick_init(void)
  110. {
  111.     joystick[0].active = joystick[1].active = 0;
  112.     joystick[0].ready = joystick[1].ready = 0;
  113.     init_waitqueue_head(&joystick[0].wait);
  114.     init_waitqueue_head(&joystick[1].wait);
  115.     if (devfs_register_chrdev(MAJOR_NR, "Joystick", &atari_joystick_fops))
  116. printk("unable to get major %d for joystick devicesn", MAJOR_NR);
  117.     devfs_register_series (NULL, "joysticks/digital%u", 2, DEVFS_FL_DEFAULT,
  118.    MAJOR_NR, 128, S_IFCHR | S_IRUSR | S_IWUSR,
  119.    &atari_joystick_fops, NULL);
  120.     return 0;
  121. }