plugins/dfinput/guncon.c

   1 /*
   2  * (C) Gražvydas "notaz" Ignotas, 2011
   3  *
   4  * This work is licensed under the terms of any of these licenses
   5  * (at your option):
   6  *  - GNU GPL, version 2 or later.
   7  *  - GNU LGPL, version 2.1 or later.
   8  * See the COPYING file in the top-level directory.
   9  */
  10
  11 #include <string.h>
  12 #include "main.h"
  13
  14 static unsigned char buf[8];
  15
  16 unsigned char PADpoll_guncon(unsigned char value)
  17 {
  18         if (CurByte == 0) {
  19                 CurCmd = value;
  20                 CurByte++;
  21                 return 0x63;    // regardless of cmd
  22         }
  23
  24         if (CurCmd != 0x42 || CurByte >= 8)
  25                 return 0xff;    // verified
  26
  27         return buf[CurByte++];
  28 }
  29
  30 unsigned char PADstartPoll_guncon(int pad)
  31 {
  32         int x, y, xn = 0, yn = 0, in = 0, xres = 256, yres = 240;
  33         CurByte = 0;
  34
  35         buf[2] = buf[3] = 0xff;
  36         pl_update_gun(&xn, &yn, &xres, &yres, &in);
  37
  38         // while y = const + line counter, what is x?
  39         // for 256 mode, hw dumped offsets x, y: 0x5a, 0x20
  40         //x = 0x5a + (356 * xn >> 10);
  41         x = 0x5a - (xres - 256) / 3 + (((xres - 256) / 3 + 356) * xn >> 10);
  42         y = 0x20 + (yres * yn >> 10);
  43
  44         if (in & GUNIN_TRIGGER)
  45                 buf[3] &= ~0x20;
  46         if (in & GUNIN_BTNA)
  47                 buf[2] &= ~0x08;
  48         if (in & GUNIN_BTNB)
  49                 buf[3] &= ~0x40;
  50         if (in & GUNIN_TRIGGER2) {
  51                 buf[3] &= ~0x20;
  52                 x = 1;
  53                 y = 10;
  54         }
  55         buf[4] = x;
  56         buf[5] = x >> 8;
  57         buf[6] = y;
  58         buf[7] = y >> 8;
  59
  60         return 0xff;
  61 }
  62
  63 void guncon_init(void)
  64 {
  65         memset(buf, 0xff, sizeof(buf));
  66         buf[1] = 0x5a;
  67 }
  68