1 // SPDX-License-Identifier: GPL-2.0-or-later
3  *  Copyright (c) 1998-2001 Vojtech Pavlik
6  *	Trystan Larey-Williams
49 static const unsigned char tmdc_byte_d[16] = { 2, 5, 8, 9 };
56 	{ ABS_X, ABS_Y, ABS_RUDDER, -1, ABS_THROTTLE };
74 } tmdc_hat_to_axis[] = {{ 0, 0}, { 1, 0}, { 0,-1}, {-1, 0}, { 0, 1}};
86 	{   1, "ThrustMaster Millenium 3D Inceptor",	  6, 2, { 4, 2 }, { 4, 6 }, tmdc_abs, tmdc_btn_joy },
87 	{   3, "ThrustMaster Rage 3D Gamepad",		  2, 0, { 8, 2 }, { 0, 0 }, tmdc_abs, tmdc_btn_pad },
88 	{   4, "ThrustMaster Attack Throttle",		  5, 2, { 4, 6 }, { 4, 2 }, tmdc_abs_at, tmdc_btn_at },
89 	{   8, "ThrustMaster FragMaster",		  4, 0, { 8, 2 }, { 0, 0 }, tmdc_abs_fm, tmdc_btn_fm },
90 	{ 163, "Thrustmaster Fusion GamePad",		  2, 0, { 8, 2 }, { 0, 0 }, tmdc_abs, tmdc_btn_pad },
91 …{   0, "Unknown %d-axis, %d-button TM device %d", 0, 0, { 0, 0 }, { 0, 0 }, tmdc_abs, tmdc_btn_joy…
109 	struct tmdc_port *port[2];  member
111 	struct input_dev *dev[2];
112 	char name[2][64];
113 	char phys[2][32];
114 	int mode[2];
115 	signed char *abs[2];
116 	short *btn[2];
117 	unsigned char absc[2];
118 	unsigned char btnc[2][4];
119 	unsigned char btno[2][4];
130 static int tmdc_read_packet(struct gameport *gameport, unsigned char data[2][TMDC_MAX_LENGTH])  in tmdc_read_packet()
134 	int i[2], j[2], t[2], p, k;  in tmdc_read_packet()
138 	for (k = 0; k < 2; k++) {  in tmdc_read_packet()
152 		for (k = 0, v = w, u = x; k < 2; k++, v >>= 2, u >>= 2) {  in tmdc_read_packet()
153 			if (~v & u & 2) {  in tmdc_read_packet()
164 				data[k][i[k]] |= (~v & 1) << (j[k]++ - 1);	/* Data bit */  in tmdc_read_packet()
166 			t[k]--;  in tmdc_read_packet()
175 static int tmdc_parse_packet(struct tmdc_port *port, unsigned char *data)  in tmdc_parse_packet()  argument
179 	if (data[TMDC_BYTE_ID] != port->mode)  in tmdc_parse_packet()
180 		return -1;  in tmdc_parse_packet()
182 	for (i = 0; i < port->absc; i++) {  in tmdc_parse_packet()
183 		if (port->abs[i] < 0)  in tmdc_parse_packet()
186 		input_report_abs(port->dev, port->abs[i], data[tmdc_byte_a[i]]);  in tmdc_parse_packet()
189 	switch (port->mode) {  in tmdc_parse_packet()
194 			input_report_abs(port->dev, ABS_HAT0X, ((data[i] >> 3) & 1) - ((data[i] >> 1) & 1));  in tmdc_parse_packet()
195 			input_report_abs(port->dev, ABS_HAT0Y, ((data[i] >> 2) & 1) - ( data[i]       & 1));  in tmdc_parse_packet()
201 			input_report_abs(port->dev, ABS_HAT0X, tmdc_hat_to_axis[(data[i] - 141) / 25].x);  in tmdc_parse_packet()
202 			input_report_abs(port->dev, ABS_HAT0Y, tmdc_hat_to_axis[(data[i] - 141) / 25].y);  in tmdc_parse_packet()
208 		for (i = 0; i < port->btnc[k]; i++)  in tmdc_parse_packet()
209 			input_report_key(port->dev, port->btn[i + l],  in tmdc_parse_packet()
210 				((data[tmdc_byte_d[k]] >> (i + port->btno[k])) & 1));  in tmdc_parse_packet()
211 		l += port->btnc[k];  in tmdc_parse_packet()
214 	input_sync(port->dev);  in tmdc_parse_packet()
225 	unsigned char data[2][TMDC_MAX_LENGTH];  in tmdc_poll()
230 	tmdc->reads++;  in tmdc_poll()
232 	if ((r = tmdc_read_packet(tmdc->gameport, data)) != tmdc->exists)  in tmdc_poll()
235 		for (i = 0; i < 2; i++) {  in tmdc_poll()
236 			if (r & (1 << i) & tmdc->exists) {  in tmdc_poll()
238 				if (tmdc_parse_packet(tmdc->port[i], data[i]))  in tmdc_poll()
244 	tmdc->bads += bad;  in tmdc_poll()
251 	gameport_start_polling(tmdc->gameport);  in tmdc_open()
259 	gameport_stop_polling(tmdc->gameport);  in tmdc_close()
265 	struct tmdc_port *port;  in tmdc_setup_port()  local
270 	tmdc->port[idx] = port = kzalloc(sizeof (struct tmdc_port), GFP_KERNEL);  in tmdc_setup_port()
272 	if (!port || !input_dev) {  in tmdc_setup_port()
273 		err = -ENOMEM;  in tmdc_setup_port()
277 	port->mode = data[TMDC_BYTE_ID];  in tmdc_setup_port()
279 	for (model = tmdc_models; model->id && model->id != port->mode; model++)  in tmdc_setup_port()
282 	port->abs = model->axes;  in tmdc_setup_port()
283 	port->btn = model->buttons;  in tmdc_setup_port()
285 	if (!model->id) {  in tmdc_setup_port()
286 		port->absc = data[TMDC_BYTE_DEF] >> 4;  in tmdc_setup_port()
288 			port->btnc[i] = i < (data[TMDC_BYTE_DEF] & 0xf) ? 8 : 0;  in tmdc_setup_port()
290 		port->absc = model->abs;  in tmdc_setup_port()
292 			port->btnc[i] = model->btnc[i];  in tmdc_setup_port()
296 		port->btno[i] = model->btno[i];  in tmdc_setup_port()
298 	snprintf(port->name, sizeof(port->name), model->name,  in tmdc_setup_port()
299 		 port->absc, (data[TMDC_BYTE_DEF] & 0xf) << 3, port->mode);  in tmdc_setup_port()
300 	snprintf(port->phys, sizeof(port->phys), "%s/input%d", tmdc->gameport->phys, i);  in tmdc_setup_port()
302 	port->dev = input_dev;  in tmdc_setup_port()
304 	input_dev->name = port->name;  in tmdc_setup_port()
305 	input_dev->phys = port->phys;  in tmdc_setup_port()
306 	input_dev->id.bustype = BUS_GAMEPORT;  in tmdc_setup_port()
307 	input_dev->id.vendor = GAMEPORT_ID_VENDOR_THRUSTMASTER;  in tmdc_setup_port()
308 	input_dev->id.product = model->id;  in tmdc_setup_port()
309 	input_dev->id.version = 0x0100;  in tmdc_setup_port()
310 	input_dev->dev.parent = &tmdc->gameport->dev;  in tmdc_setup_port()
314 	input_dev->open = tmdc_open;  in tmdc_setup_port()
315 	input_dev->close = tmdc_close;  in tmdc_setup_port()
317 	input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);  in tmdc_setup_port()
319 	for (i = 0; i < port->absc && i < TMDC_ABS; i++)  in tmdc_setup_port()
320 		if (port->abs[i] >= 0)  in tmdc_setup_port()
321 			input_set_abs_params(input_dev, port->abs[i], 8, 248, 2, 4);  in tmdc_setup_port()
323 	for (i = 0; i < model->hats && i < TMDC_ABS_HAT; i++)  in tmdc_setup_port()
324 		input_set_abs_params(input_dev, tmdc_abs_hat[i], -1, 1, 0, 0);  in tmdc_setup_port()
327 		for (j = 0; j < port->btnc[i] && j < TMDC_BTN; j++)  in tmdc_setup_port()
328 			set_bit(port->btn[j + b], input_dev->keybit);  in tmdc_setup_port()
329 		b += port->btnc[i];  in tmdc_setup_port()
332 	err = input_register_device(port->dev);  in tmdc_setup_port()
339 	kfree(port);  in tmdc_setup_port()
349 	unsigned char data[2][TMDC_MAX_LENGTH];  in tmdc_connect()
355 		return -ENOMEM;  in tmdc_connect()
357 	tmdc->gameport = gameport;  in tmdc_connect()
365 	if (!(tmdc->exists = tmdc_read_packet(gameport, data))) {  in tmdc_connect()
366 		err = -ENODEV;  in tmdc_connect()
373 	for (i = 0; i < 2; i++) {  in tmdc_connect()
374 		if (tmdc->exists & (1 << i)) {  in tmdc_connect()
384  fail3: while (--i >= 0) {  in tmdc_connect()
385 		if (tmdc->port[i]) {  in tmdc_connect()
386 			input_unregister_device(tmdc->port[i]->dev);  in tmdc_connect()
387 			kfree(tmdc->port[i]);  in tmdc_connect()
401 	for (i = 0; i < 2; i++) {  in tmdc_disconnect()
402 		if (tmdc->port[i]) {  in tmdc_disconnect()
403 			input_unregister_device(tmdc->port[i]->dev);  in tmdc_disconnect()
404 			kfree(tmdc->port[i]);  in tmdc_disconnect()