11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * Copyright (c) 2000-2002 Vojtech Pavlik <vojtech@ucw.cz> 3598972d4SJohann Deneux * Copyright (c) 2001-2002, 2007 Johann Deneux <johann.deneux@gmail.com> 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * USB/RS232 I-Force joysticks and wheels. 61da177e4SLinus Torvalds */ 71da177e4SLinus Torvalds 81da177e4SLinus Torvalds /* 91da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or modify 101da177e4SLinus Torvalds * it under the terms of the GNU General Public License as published by 111da177e4SLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 121da177e4SLinus Torvalds * (at your option) any later version. 131da177e4SLinus Torvalds * 141da177e4SLinus Torvalds * This program is distributed in the hope that it will be useful, 151da177e4SLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 161da177e4SLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 171da177e4SLinus Torvalds * GNU General Public License for more details. 181da177e4SLinus Torvalds * 191da177e4SLinus Torvalds * You should have received a copy of the GNU General Public License 201da177e4SLinus Torvalds * along with this program; if not, write to the Free Software 211da177e4SLinus Torvalds * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 221da177e4SLinus Torvalds */ 231da177e4SLinus Torvalds 244f99de6dSDmitry Torokhov #include <linux/usb.h> 251da177e4SLinus Torvalds #include "iforce.h" 261da177e4SLinus Torvalds 2781fd4313SDmitry Torokhov struct iforce_usb { 2881fd4313SDmitry Torokhov struct iforce iforce; 2981fd4313SDmitry Torokhov 3081fd4313SDmitry Torokhov struct usb_device *usbdev; 3181fd4313SDmitry Torokhov struct usb_interface *intf; 3248735862SDmitry Torokhov struct urb *irq, *out; 33*dfad2b17SDmitry Torokhov 34*dfad2b17SDmitry Torokhov u8 data_in[IFORCE_MAX_LENGTH] ____cacheline_aligned; 35*dfad2b17SDmitry Torokhov u8 data_out[IFORCE_MAX_LENGTH] ____cacheline_aligned; 3681fd4313SDmitry Torokhov }; 3781fd4313SDmitry Torokhov 3838d10769SDmitry Torokhov static void __iforce_usb_xmit(struct iforce *iforce) 391da177e4SLinus Torvalds { 4081fd4313SDmitry Torokhov struct iforce_usb *iforce_usb = container_of(iforce, struct iforce_usb, 4181fd4313SDmitry Torokhov iforce); 421da177e4SLinus Torvalds int n, c; 431da177e4SLinus Torvalds unsigned long flags; 441da177e4SLinus Torvalds 451da177e4SLinus Torvalds spin_lock_irqsave(&iforce->xmit_lock, flags); 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds if (iforce->xmit.head == iforce->xmit.tail) { 481da177e4SLinus Torvalds clear_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags); 491da177e4SLinus Torvalds spin_unlock_irqrestore(&iforce->xmit_lock, flags); 501da177e4SLinus Torvalds return; 511da177e4SLinus Torvalds } 521da177e4SLinus Torvalds 5381fd4313SDmitry Torokhov ((char *)iforce_usb->out->transfer_buffer)[0] = iforce->xmit.buf[iforce->xmit.tail]; 541da177e4SLinus Torvalds XMIT_INC(iforce->xmit.tail, 1); 551da177e4SLinus Torvalds n = iforce->xmit.buf[iforce->xmit.tail]; 561da177e4SLinus Torvalds XMIT_INC(iforce->xmit.tail, 1); 571da177e4SLinus Torvalds 5881fd4313SDmitry Torokhov iforce_usb->out->transfer_buffer_length = n + 1; 5981fd4313SDmitry Torokhov iforce_usb->out->dev = iforce_usb->usbdev; 601da177e4SLinus Torvalds 611da177e4SLinus Torvalds /* Copy rest of data then */ 621da177e4SLinus Torvalds c = CIRC_CNT_TO_END(iforce->xmit.head, iforce->xmit.tail, XMIT_SIZE); 631da177e4SLinus Torvalds if (n < c) c=n; 641da177e4SLinus Torvalds 6581fd4313SDmitry Torokhov memcpy(iforce_usb->out->transfer_buffer + 1, 661da177e4SLinus Torvalds &iforce->xmit.buf[iforce->xmit.tail], 671da177e4SLinus Torvalds c); 681da177e4SLinus Torvalds if (n != c) { 6981fd4313SDmitry Torokhov memcpy(iforce_usb->out->transfer_buffer + 1 + c, 701da177e4SLinus Torvalds &iforce->xmit.buf[0], 711da177e4SLinus Torvalds n-c); 721da177e4SLinus Torvalds } 731da177e4SLinus Torvalds XMIT_INC(iforce->xmit.tail, n); 741da177e4SLinus Torvalds 7581fd4313SDmitry Torokhov if ( (n=usb_submit_urb(iforce_usb->out, GFP_ATOMIC)) ) { 76b8691fd2SJohann Deneux clear_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags); 7781fd4313SDmitry Torokhov dev_warn(&iforce_usb->intf->dev, 7881fd4313SDmitry Torokhov "usb_submit_urb failed %d\n", n); 791da177e4SLinus Torvalds } 801da177e4SLinus Torvalds 811da177e4SLinus Torvalds /* The IFORCE_XMIT_RUNNING bit is not cleared here. That's intended. 821da177e4SLinus Torvalds * As long as the urb completion handler is not called, the transmiting 831da177e4SLinus Torvalds * is considered to be running */ 841da177e4SLinus Torvalds spin_unlock_irqrestore(&iforce->xmit_lock, flags); 851da177e4SLinus Torvalds } 861da177e4SLinus Torvalds 8738d10769SDmitry Torokhov static void iforce_usb_xmit(struct iforce *iforce) 8838d10769SDmitry Torokhov { 8938d10769SDmitry Torokhov if (!test_and_set_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags)) 9038d10769SDmitry Torokhov __iforce_usb_xmit(iforce); 9138d10769SDmitry Torokhov } 9238d10769SDmitry Torokhov 936ac0aec6SDmitry Torokhov static int iforce_usb_get_id(struct iforce *iforce, u8 id, 946ac0aec6SDmitry Torokhov u8 *response_data, size_t *response_len) 952a1433ffSDmitry Torokhov { 9681fd4313SDmitry Torokhov struct iforce_usb *iforce_usb = container_of(iforce, struct iforce_usb, 9781fd4313SDmitry Torokhov iforce); 9848735862SDmitry Torokhov u8 *buf; 992a1433ffSDmitry Torokhov int status; 1002a1433ffSDmitry Torokhov 10148735862SDmitry Torokhov buf = kmalloc(IFORCE_MAX_LENGTH, GFP_KERNEL); 10248735862SDmitry Torokhov if (!buf) 10348735862SDmitry Torokhov return -ENOMEM; 1042a1433ffSDmitry Torokhov 10548735862SDmitry Torokhov status = usb_control_msg(iforce_usb->usbdev, 10648735862SDmitry Torokhov usb_rcvctrlpipe(iforce_usb->usbdev, 0), 1076ac0aec6SDmitry Torokhov id, 10848735862SDmitry Torokhov USB_TYPE_VENDOR | USB_DIR_IN | 10948735862SDmitry Torokhov USB_RECIP_INTERFACE, 11048735862SDmitry Torokhov 0, 0, buf, IFORCE_MAX_LENGTH, HZ); 11148735862SDmitry Torokhov if (status < 0) { 11281fd4313SDmitry Torokhov dev_err(&iforce_usb->intf->dev, 11348735862SDmitry Torokhov "usb_submit_urb failed: %d\n", status); 1146ac0aec6SDmitry Torokhov } else if (buf[0] != id) { 11548735862SDmitry Torokhov status = -EIO; 11648735862SDmitry Torokhov } else { 1176ac0aec6SDmitry Torokhov memcpy(response_data, buf, status); 1186ac0aec6SDmitry Torokhov *response_len = status; 11948735862SDmitry Torokhov status = 0; 1202a1433ffSDmitry Torokhov } 1212a1433ffSDmitry Torokhov 12248735862SDmitry Torokhov kfree(buf); 12348735862SDmitry Torokhov return status; 1242a1433ffSDmitry Torokhov } 1252a1433ffSDmitry Torokhov 12605ca3828SDmitry Torokhov static int iforce_usb_start_io(struct iforce *iforce) 12705ca3828SDmitry Torokhov { 12881fd4313SDmitry Torokhov struct iforce_usb *iforce_usb = container_of(iforce, struct iforce_usb, 12981fd4313SDmitry Torokhov iforce); 13081fd4313SDmitry Torokhov 13181fd4313SDmitry Torokhov if (usb_submit_urb(iforce_usb->irq, GFP_KERNEL)) 13205ca3828SDmitry Torokhov return -EIO; 13305ca3828SDmitry Torokhov 13405ca3828SDmitry Torokhov return 0; 13505ca3828SDmitry Torokhov } 13605ca3828SDmitry Torokhov 13705ca3828SDmitry Torokhov static void iforce_usb_stop_io(struct iforce *iforce) 13805ca3828SDmitry Torokhov { 13981fd4313SDmitry Torokhov struct iforce_usb *iforce_usb = container_of(iforce, struct iforce_usb, 14081fd4313SDmitry Torokhov iforce); 14181fd4313SDmitry Torokhov 14281fd4313SDmitry Torokhov usb_kill_urb(iforce_usb->irq); 14381fd4313SDmitry Torokhov usb_kill_urb(iforce_usb->out); 14405ca3828SDmitry Torokhov } 14505ca3828SDmitry Torokhov 14638d10769SDmitry Torokhov static const struct iforce_xport_ops iforce_usb_xport_ops = { 14738d10769SDmitry Torokhov .xmit = iforce_usb_xmit, 1482a1433ffSDmitry Torokhov .get_id = iforce_usb_get_id, 14905ca3828SDmitry Torokhov .start_io = iforce_usb_start_io, 15005ca3828SDmitry Torokhov .stop_io = iforce_usb_stop_io, 15138d10769SDmitry Torokhov }; 15238d10769SDmitry Torokhov 1537d12e780SDavid Howells static void iforce_usb_irq(struct urb *urb) 1541da177e4SLinus Torvalds { 15581fd4313SDmitry Torokhov struct iforce_usb *iforce_usb = urb->context; 15681fd4313SDmitry Torokhov struct iforce *iforce = &iforce_usb->iforce; 15781fd4313SDmitry Torokhov struct device *dev = &iforce_usb->intf->dev; 1581da177e4SLinus Torvalds int status; 1591da177e4SLinus Torvalds 1601da177e4SLinus Torvalds switch (urb->status) { 1611da177e4SLinus Torvalds case 0: 1621da177e4SLinus Torvalds /* success */ 1631da177e4SLinus Torvalds break; 1641da177e4SLinus Torvalds case -ECONNRESET: 1651da177e4SLinus Torvalds case -ENOENT: 1661da177e4SLinus Torvalds case -ESHUTDOWN: 1671da177e4SLinus Torvalds /* this urb is terminated, clean up */ 168f576125dSGreg Kroah-Hartman dev_dbg(dev, "%s - urb shutting down with status: %d\n", 169ea3e6c59SHarvey Harrison __func__, urb->status); 1701da177e4SLinus Torvalds return; 1711da177e4SLinus Torvalds default: 172f576125dSGreg Kroah-Hartman dev_dbg(dev, "%s - urb has status of: %d\n", 173f576125dSGreg Kroah-Hartman __func__, urb->status); 1741da177e4SLinus Torvalds goto exit; 1751da177e4SLinus Torvalds } 1761da177e4SLinus Torvalds 177*dfad2b17SDmitry Torokhov iforce_process_packet(iforce, iforce_usb->data_in[0], 178*dfad2b17SDmitry Torokhov iforce_usb->data_in + 1, urb->actual_length - 1); 1791da177e4SLinus Torvalds 1801da177e4SLinus Torvalds exit: 1811da177e4SLinus Torvalds status = usb_submit_urb(urb, GFP_ATOMIC); 1821da177e4SLinus Torvalds if (status) 183f576125dSGreg Kroah-Hartman dev_err(dev, "%s - usb_submit_urb failed with result %d\n", 184ea3e6c59SHarvey Harrison __func__, status); 1851da177e4SLinus Torvalds } 1861da177e4SLinus Torvalds 1877d12e780SDavid Howells static void iforce_usb_out(struct urb *urb) 1881da177e4SLinus Torvalds { 18981fd4313SDmitry Torokhov struct iforce_usb *iforce_usb = urb->context; 19081fd4313SDmitry Torokhov struct iforce *iforce = &iforce_usb->iforce; 1911da177e4SLinus Torvalds 1921da177e4SLinus Torvalds if (urb->status) { 193c2b27ef6SDmitry Torokhov clear_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags); 19481fd4313SDmitry Torokhov dev_dbg(&iforce_usb->intf->dev, "urb->status %d, exiting\n", 195f576125dSGreg Kroah-Hartman urb->status); 1961da177e4SLinus Torvalds return; 1971da177e4SLinus Torvalds } 1981da177e4SLinus Torvalds 19938d10769SDmitry Torokhov __iforce_usb_xmit(iforce); 2001da177e4SLinus Torvalds 2011da177e4SLinus Torvalds wake_up(&iforce->wait); 2021da177e4SLinus Torvalds } 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds static int iforce_usb_probe(struct usb_interface *intf, 2051da177e4SLinus Torvalds const struct usb_device_id *id) 2061da177e4SLinus Torvalds { 2071da177e4SLinus Torvalds struct usb_device *dev = interface_to_usbdev(intf); 2081da177e4SLinus Torvalds struct usb_host_interface *interface; 2091da177e4SLinus Torvalds struct usb_endpoint_descriptor *epirq, *epout; 21081fd4313SDmitry Torokhov struct iforce_usb *iforce_usb; 2111da177e4SLinus Torvalds struct iforce *iforce; 21217dd3f0fSDmitry Torokhov int err = -ENOMEM; 2131da177e4SLinus Torvalds 2141da177e4SLinus Torvalds interface = intf->cur_altsetting; 2151da177e4SLinus Torvalds 21659cf8bedSJohan Hovold if (interface->desc.bNumEndpoints < 2) 21759cf8bedSJohan Hovold return -ENODEV; 21859cf8bedSJohan Hovold 2191da177e4SLinus Torvalds epirq = &interface->endpoint[0].desc; 2201da177e4SLinus Torvalds epout = &interface->endpoint[1].desc; 2211da177e4SLinus Torvalds 222*dfad2b17SDmitry Torokhov iforce_usb = kzalloc(sizeof(*iforce_usb), GFP_KERNEL); 223*dfad2b17SDmitry Torokhov if (!iforce_usb) 2241da177e4SLinus Torvalds goto fail; 2251da177e4SLinus Torvalds 226*dfad2b17SDmitry Torokhov iforce_usb->irq = usb_alloc_urb(0, GFP_KERNEL); 227*dfad2b17SDmitry Torokhov if (!iforce_usb->irq) 2281da177e4SLinus Torvalds goto fail; 2291da177e4SLinus Torvalds 230*dfad2b17SDmitry Torokhov iforce_usb->out = usb_alloc_urb(0, GFP_KERNEL); 231*dfad2b17SDmitry Torokhov if (!iforce_usb->out) 2321da177e4SLinus Torvalds goto fail; 2331da177e4SLinus Torvalds 23481fd4313SDmitry Torokhov iforce = &iforce_usb->iforce; 23581fd4313SDmitry Torokhov 23638d10769SDmitry Torokhov iforce->xport_ops = &iforce_usb_xport_ops; 2371da177e4SLinus Torvalds iforce->bus = IFORCE_USB; 2381da177e4SLinus Torvalds 23981fd4313SDmitry Torokhov iforce_usb->usbdev = dev; 24081fd4313SDmitry Torokhov iforce_usb->intf = intf; 2411da177e4SLinus Torvalds 242*dfad2b17SDmitry Torokhov usb_fill_int_urb(iforce_usb->irq, dev, 243*dfad2b17SDmitry Torokhov usb_rcvintpipe(dev, epirq->bEndpointAddress), 244*dfad2b17SDmitry Torokhov iforce_usb->data_in, sizeof(iforce_usb->data_in), 245*dfad2b17SDmitry Torokhov iforce_usb_irq, iforce_usb, epirq->bInterval); 2461da177e4SLinus Torvalds 247*dfad2b17SDmitry Torokhov usb_fill_int_urb(iforce_usb->out, dev, 248*dfad2b17SDmitry Torokhov usb_sndintpipe(dev, epout->bEndpointAddress), 249*dfad2b17SDmitry Torokhov iforce_usb->data_out, sizeof(iforce_usb->data_out), 250*dfad2b17SDmitry Torokhov iforce_usb_out, iforce_usb, epout->bInterval); 25181fd4313SDmitry Torokhov 252501025dfSDmitry Torokhov err = iforce_init_device(&intf->dev, BUS_USB, iforce); 25317dd3f0fSDmitry Torokhov if (err) 25417dd3f0fSDmitry Torokhov goto fail; 2551da177e4SLinus Torvalds 25681fd4313SDmitry Torokhov usb_set_intfdata(intf, iforce_usb); 2571da177e4SLinus Torvalds return 0; 2581da177e4SLinus Torvalds 2591da177e4SLinus Torvalds fail: 26081fd4313SDmitry Torokhov if (iforce_usb) { 26181fd4313SDmitry Torokhov usb_free_urb(iforce_usb->irq); 26281fd4313SDmitry Torokhov usb_free_urb(iforce_usb->out); 26381fd4313SDmitry Torokhov kfree(iforce_usb); 2641da177e4SLinus Torvalds } 2651da177e4SLinus Torvalds 26617dd3f0fSDmitry Torokhov return err; 2671da177e4SLinus Torvalds } 2681da177e4SLinus Torvalds 26998b7fb04SDmitry Torokhov static void iforce_usb_disconnect(struct usb_interface *intf) 2701da177e4SLinus Torvalds { 27181fd4313SDmitry Torokhov struct iforce_usb *iforce_usb = usb_get_intfdata(intf); 27298b7fb04SDmitry Torokhov 27398b7fb04SDmitry Torokhov usb_set_intfdata(intf, NULL); 27498b7fb04SDmitry Torokhov 27581fd4313SDmitry Torokhov input_unregister_device(iforce_usb->iforce.dev); 2761da177e4SLinus Torvalds 27781fd4313SDmitry Torokhov usb_free_urb(iforce_usb->irq); 27881fd4313SDmitry Torokhov usb_free_urb(iforce_usb->out); 2791da177e4SLinus Torvalds 28081fd4313SDmitry Torokhov kfree(iforce_usb); 2811da177e4SLinus Torvalds } 2821da177e4SLinus Torvalds 283c1295851SArvind Yadav static const struct usb_device_id iforce_usb_ids[] = { 2841da177e4SLinus Torvalds { USB_DEVICE(0x044f, 0xa01c) }, /* Thrustmaster Motor Sport GT */ 2851da177e4SLinus Torvalds { USB_DEVICE(0x046d, 0xc281) }, /* Logitech WingMan Force */ 2861da177e4SLinus Torvalds { USB_DEVICE(0x046d, 0xc291) }, /* Logitech WingMan Formula Force */ 2871da177e4SLinus Torvalds { USB_DEVICE(0x05ef, 0x020a) }, /* AVB Top Shot Pegasus */ 2881da177e4SLinus Torvalds { USB_DEVICE(0x05ef, 0x8884) }, /* AVB Mag Turbo Force */ 2891da177e4SLinus Torvalds { USB_DEVICE(0x05ef, 0x8888) }, /* AVB Top Shot FFB Racing Wheel */ 2901da177e4SLinus Torvalds { USB_DEVICE(0x061c, 0xc0a4) }, /* ACT LABS Force RS */ 29168947b8fSJiri Kosina { USB_DEVICE(0x061c, 0xc084) }, /* ACT LABS Force RS */ 2921da177e4SLinus Torvalds { USB_DEVICE(0x06f8, 0x0001) }, /* Guillemot Race Leader Force Feedback */ 293d861f7bfSMarek Vasut { USB_DEVICE(0x06f8, 0x0003) }, /* Guillemot Jet Leader Force Feedback */ 2941da177e4SLinus Torvalds { USB_DEVICE(0x06f8, 0x0004) }, /* Guillemot Force Feedback Racing Wheel */ 29518098a6cSMarian-Nicolae V. Ion { USB_DEVICE(0x06f8, 0xa302) }, /* Guillemot Jet Leader 3D */ 2961da177e4SLinus Torvalds { } /* Terminating entry */ 2971da177e4SLinus Torvalds }; 2981da177e4SLinus Torvalds 2991da177e4SLinus Torvalds MODULE_DEVICE_TABLE (usb, iforce_usb_ids); 3001da177e4SLinus Torvalds 3011da177e4SLinus Torvalds struct usb_driver iforce_usb_driver = { 3021da177e4SLinus Torvalds .name = "iforce", 3031da177e4SLinus Torvalds .probe = iforce_usb_probe, 3041da177e4SLinus Torvalds .disconnect = iforce_usb_disconnect, 3051da177e4SLinus Torvalds .id_table = iforce_usb_ids, 3061da177e4SLinus Torvalds }; 3074f99de6dSDmitry Torokhov 3084f99de6dSDmitry Torokhov module_usb_driver(iforce_usb_driver); 3094f99de6dSDmitry Torokhov 3104f99de6dSDmitry Torokhov MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>, Johann Deneux <johann.deneux@gmail.com>"); 3114f99de6dSDmitry Torokhov MODULE_DESCRIPTION("USB I-Force joysticks and wheels driver"); 3124f99de6dSDmitry Torokhov MODULE_LICENSE("GPL"); 313