Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
41 | ligi | 1 | /* x52pro driver library |
2 | * Copyright (C) 2007 Eduard Hasenleithner <eduard@hasenleithner.at> |
||
3 | * Licensed under the LGPL. Please see "COPYING". |
||
4 | */ |
||
5 | #include <stdio.h> |
||
6 | #include <string.h> |
||
7 | #include <usb.h> |
||
8 | #include "x52.h" |
||
9 | |||
10 | struct x52 { |
||
11 | usb_dev_handle *hdl; |
||
12 | }; |
||
13 | |||
14 | #define X52PRO_REQUEST 0x91 |
||
15 | |||
16 | #define X52PRO_CLEAR1 0xd9 |
||
17 | #define X52PRO_CLEAR2 0xda |
||
18 | #define X52PRO_CLEAR3 0xdc |
||
19 | #define X52PRO_WRITE1 0xd1 |
||
20 | #define X52PRO_WRITE2 0xd2 |
||
21 | #define X52PRO_WRITE3 0xd4 |
||
22 | #define X52PRO_SETLED 0xb8 |
||
23 | #define X52PRO_MFDBRI 0xb1 |
||
24 | #define X52PRO_LEDBRI 0xb2 |
||
25 | |||
26 | #define X52PRO_TIME 0xc0 |
||
27 | #define X52PRO_DATE 0xc4 |
||
28 | #define X52PRO_YEAR 0xc8 |
||
29 | |||
30 | int write_idx[3] = { |
||
31 | X52PRO_WRITE1, |
||
32 | X52PRO_WRITE2, |
||
33 | X52PRO_WRITE3, |
||
34 | }; |
||
35 | |||
36 | int clear_idx[3] = { |
||
37 | X52PRO_CLEAR1, |
||
38 | X52PRO_CLEAR2, |
||
39 | X52PRO_CLEAR3, |
||
40 | }; |
||
41 | |||
42 | int x52_settext(struct x52 *x52, int line, char *text, int length) |
||
43 | { |
||
44 | int r; |
||
45 | if (line > 3) return -1; |
||
46 | r = usb_control_msg(x52->hdl, |
||
47 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
48 | X52PRO_REQUEST, 0x00, clear_idx[line], NULL, 0, 1000); |
||
49 | if (r < 0) { |
||
50 | fprintf(stderr, "x52_settext failed at clear command (%s)\n", |
||
51 | usb_strerror()); |
||
52 | return -2; |
||
53 | } |
||
54 | |||
55 | while (length >= 1) { |
||
56 | int chars; |
||
57 | if (length == 1) chars = (' ' << 8) + *text; |
||
58 | else chars = *(unsigned short*) text; |
||
59 | r = usb_control_msg(x52->hdl, |
||
60 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
61 | X52PRO_REQUEST, chars, write_idx[line], NULL, 0, 1000); |
||
62 | if (r<0) { |
||
63 | fprintf(stderr, "x52_settext failed at write %d (%s)\n", |
||
64 | length, usb_strerror()); |
||
65 | return -2; |
||
66 | } |
||
67 | length -= 2; |
||
68 | text += 2; |
||
69 | } |
||
70 | return 0; |
||
71 | } |
||
72 | |||
73 | int x52_setbri(struct x52 *x52, int mfd, int brightness) |
||
74 | { |
||
75 | int r; |
||
76 | r = usb_control_msg(x52->hdl, |
||
77 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
78 | X52PRO_REQUEST, brightness, mfd ? X52PRO_MFDBRI : X52PRO_LEDBRI, |
||
79 | NULL, 0, 1000); |
||
80 | if (r < 0) { |
||
81 | fprintf(stderr, "x52_setbri failed (%s)\n", usb_strerror()); |
||
82 | return -2; |
||
83 | } |
||
84 | return 0; |
||
85 | } |
||
86 | |||
87 | int x52_setled(struct x52 *x52, int led, int on) |
||
88 | { |
||
89 | int r; |
||
90 | r = usb_control_msg(x52->hdl, |
||
91 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
92 | X52PRO_REQUEST, on | (led<<8), X52PRO_SETLED, |
||
93 | NULL, 0, 1000); |
||
94 | if (r < 0) { |
||
95 | fprintf(stderr, "x52_setled failed (%s)\n", usb_strerror()); |
||
96 | return -2; |
||
97 | } |
||
98 | return 0; |
||
99 | } |
||
100 | |||
101 | int x52_settime(struct x52 *x52, int h24, int hour, int minute) |
||
102 | { |
||
103 | int r; |
||
104 | r = usb_control_msg(x52->hdl, |
||
105 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
106 | X52PRO_REQUEST, minute | (hour<<8) | (h24?0x8000:0), X52PRO_TIME, |
||
107 | NULL, 0, 1000); |
||
108 | if (r < 0) { |
||
109 | fprintf(stderr, "x52_settime failed (%s)\n", usb_strerror()); |
||
110 | return -2; |
||
111 | } |
||
112 | return 0; |
||
113 | } |
||
114 | |||
115 | int x52_setdate(struct x52 *x52, int year, int month, int day) |
||
116 | { |
||
117 | int r; |
||
118 | r = usb_control_msg(x52->hdl, |
||
119 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
120 | X52PRO_REQUEST, day | (month<<8), X52PRO_DATE, |
||
121 | NULL, 0, 1000); |
||
122 | if (r < 0) { |
||
123 | fprintf(stderr, "x52_setdate failed (%s)\n", usb_strerror()); |
||
124 | return -2; |
||
125 | } |
||
126 | r = usb_control_msg(x52->hdl, |
||
127 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
128 | X52PRO_REQUEST, year, X52PRO_YEAR, |
||
129 | NULL, 0, 1000); |
||
130 | if (r < 0) { |
||
131 | fprintf(stderr, "x52_setdate failed for year (%s)\n", usb_strerror()); |
||
132 | return -2; |
||
133 | } |
||
134 | return 0; |
||
135 | } |
||
136 | |||
137 | int x52_custom(struct x52 *x52, int index, int value) |
||
138 | { |
||
139 | int r = usb_control_msg(x52->hdl, |
||
140 | USB_TYPE_VENDOR|USB_RECIP_DEVICE|USB_ENDPOINT_OUT, |
||
141 | X52PRO_REQUEST, value, index, NULL, 0, 1000); |
||
142 | if (r < 0) { |
||
143 | fprintf(stderr, "x52_settext failed at clear command (%s)\n", |
||
144 | usb_strerror()); |
||
145 | return -2; |
||
146 | } |
||
147 | return 0; |
||
148 | } |
||
149 | |||
150 | struct x52* x52_init(void) |
||
151 | { |
||
152 | struct x52 x52, *x52p; |
||
153 | |||
154 | usb_init(); |
||
155 | usb_find_busses(); |
||
156 | usb_find_devices(); |
||
157 | |||
158 | struct usb_bus *bus; |
||
159 | struct usb_device *joydev = NULL; |
||
160 | for (bus = usb_busses; bus; bus = bus->next) { |
||
161 | struct usb_device *dev; |
||
162 | for (dev = bus->devices; dev; dev = dev->next) { |
||
163 | struct usb_device_descriptor *dsc = &dev->descriptor; |
||
164 | if (dsc->idVendor == 0x6a3 && ((dsc->idProduct == 0x75c)||(dsc->idProduct == 0x762))) |
||
165 | { |
||
166 | joydev = dev; |
||
167 | break; |
||
168 | } |
||
169 | } |
||
170 | if (joydev) break; |
||
171 | } |
||
172 | if (!joydev) { |
||
173 | fprintf(stderr, "joystick not found\n"); |
||
174 | return NULL; |
||
175 | } |
||
176 | fprintf(stderr, "joystick found\n"); |
||
177 | x52.hdl = usb_open(joydev); |
||
178 | if (x52.hdl==NULL) { |
||
179 | fprintf(stderr, "joystick open failed\n"); |
||
180 | return NULL; |
||
181 | } |
||
182 | x52p = malloc(sizeof(*x52p)); |
||
183 | *x52p = x52; |
||
184 | return x52p; |
||
185 | } |
||
186 | |||
187 | |||
188 | void x52_close(struct x52* x52) |
||
189 | { |
||
190 | int r; |
||
191 | r = usb_close(x52->hdl); |
||
192 | free(x52); |
||
193 | printf("usb_close: %d\n", r); |
||
194 | } |