15fd54aceSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
259e931c4SFrans Klaver /*
359e931c4SFrans Klaver * Xsens MT USB driver
459e931c4SFrans Klaver *
559e931c4SFrans Klaver * Copyright (C) 2013 Xsens <info@xsens.com>
659e931c4SFrans Klaver */
759e931c4SFrans Klaver
859e931c4SFrans Klaver #include <linux/kernel.h>
959e931c4SFrans Klaver #include <linux/tty.h>
1059e931c4SFrans Klaver #include <linux/module.h>
1159e931c4SFrans Klaver #include <linux/usb.h>
1259e931c4SFrans Klaver #include <linux/usb/serial.h>
1359e931c4SFrans Klaver #include <linux/uaccess.h>
1459e931c4SFrans Klaver
1559e931c4SFrans Klaver #define XSENS_VID 0x2639
1659e931c4SFrans Klaver
1759e931c4SFrans Klaver #define MTi_10_IMU_PID 0x0001
1859e931c4SFrans Klaver #define MTi_20_VRU_PID 0x0002
1959e931c4SFrans Klaver #define MTi_30_AHRS_PID 0x0003
2059e931c4SFrans Klaver
2159e931c4SFrans Klaver #define MTi_100_IMU_PID 0x0011
2259e931c4SFrans Klaver #define MTi_200_VRU_PID 0x0012
2359e931c4SFrans Klaver #define MTi_300_AHRS_PID 0x0013
2459e931c4SFrans Klaver
2559e931c4SFrans Klaver #define MTi_G_700_GPS_INS_PID 0x0017
2659e931c4SFrans Klaver
2759e931c4SFrans Klaver static const struct usb_device_id id_table[] = {
2859e931c4SFrans Klaver { USB_DEVICE(XSENS_VID, MTi_10_IMU_PID) },
2959e931c4SFrans Klaver { USB_DEVICE(XSENS_VID, MTi_20_VRU_PID) },
3059e931c4SFrans Klaver { USB_DEVICE(XSENS_VID, MTi_30_AHRS_PID) },
3159e931c4SFrans Klaver
3259e931c4SFrans Klaver { USB_DEVICE(XSENS_VID, MTi_100_IMU_PID) },
3359e931c4SFrans Klaver { USB_DEVICE(XSENS_VID, MTi_200_VRU_PID) },
3459e931c4SFrans Klaver { USB_DEVICE(XSENS_VID, MTi_300_AHRS_PID) },
3559e931c4SFrans Klaver
3659e931c4SFrans Klaver { USB_DEVICE(XSENS_VID, MTi_G_700_GPS_INS_PID) },
3759e931c4SFrans Klaver { },
3859e931c4SFrans Klaver };
3959e931c4SFrans Klaver MODULE_DEVICE_TABLE(usb, id_table);
4059e931c4SFrans Klaver
xsens_mt_probe(struct usb_serial * serial,const struct usb_device_id * id)4159e931c4SFrans Klaver static int xsens_mt_probe(struct usb_serial *serial,
4259e931c4SFrans Klaver const struct usb_device_id *id)
4359e931c4SFrans Klaver {
44adceac14SFrans Klaver if (serial->interface->cur_altsetting->desc.bInterfaceNumber == 1)
4559e931c4SFrans Klaver return 0;
46adceac14SFrans Klaver
47adceac14SFrans Klaver return -ENODEV;
4859e931c4SFrans Klaver }
4959e931c4SFrans Klaver
5059e931c4SFrans Klaver static struct usb_serial_driver xsens_mt_device = {
5159e931c4SFrans Klaver .driver = {
5259e931c4SFrans Klaver .owner = THIS_MODULE,
5359e931c4SFrans Klaver .name = "xsens_mt",
5459e931c4SFrans Klaver },
5559e931c4SFrans Klaver .id_table = id_table,
5659e931c4SFrans Klaver .num_ports = 1,
5759e931c4SFrans Klaver
5859e931c4SFrans Klaver .probe = xsens_mt_probe,
5959e931c4SFrans Klaver };
6059e931c4SFrans Klaver
6159e931c4SFrans Klaver static struct usb_serial_driver * const serial_drivers[] = {
6259e931c4SFrans Klaver &xsens_mt_device, NULL
6359e931c4SFrans Klaver };
6459e931c4SFrans Klaver
6559e931c4SFrans Klaver module_usb_serial_driver(serial_drivers, id_table);
6659e931c4SFrans Klaver
677c133253SFrans Klaver MODULE_AUTHOR("Frans Klaver <frans.klaver@xsens.com>");
687c133253SFrans Klaver MODULE_DESCRIPTION("USB-serial driver for Xsens motion trackers");
69*627cfa89SJohan Hovold MODULE_LICENSE("GPL v2");
70