Merge pull request #37 from loganmc10/master
[pcsx_rearmed.git] / 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