xsens_mt.c (1614B)
1// SPDX-License-Identifier: GPL-2.0 2/* 3 * Xsens MT USB driver 4 * 5 * Copyright (C) 2013 Xsens <info@xsens.com> 6 */ 7 8#include <linux/kernel.h> 9#include <linux/tty.h> 10#include <linux/module.h> 11#include <linux/usb.h> 12#include <linux/usb/serial.h> 13#include <linux/uaccess.h> 14 15#define XSENS_VID 0x2639 16 17#define MTi_10_IMU_PID 0x0001 18#define MTi_20_VRU_PID 0x0002 19#define MTi_30_AHRS_PID 0x0003 20 21#define MTi_100_IMU_PID 0x0011 22#define MTi_200_VRU_PID 0x0012 23#define MTi_300_AHRS_PID 0x0013 24 25#define MTi_G_700_GPS_INS_PID 0x0017 26 27static const struct usb_device_id id_table[] = { 28 { USB_DEVICE(XSENS_VID, MTi_10_IMU_PID) }, 29 { USB_DEVICE(XSENS_VID, MTi_20_VRU_PID) }, 30 { USB_DEVICE(XSENS_VID, MTi_30_AHRS_PID) }, 31 32 { USB_DEVICE(XSENS_VID, MTi_100_IMU_PID) }, 33 { USB_DEVICE(XSENS_VID, MTi_200_VRU_PID) }, 34 { USB_DEVICE(XSENS_VID, MTi_300_AHRS_PID) }, 35 36 { USB_DEVICE(XSENS_VID, MTi_G_700_GPS_INS_PID) }, 37 { }, 38}; 39MODULE_DEVICE_TABLE(usb, id_table); 40 41static int xsens_mt_probe(struct usb_serial *serial, 42 const struct usb_device_id *id) 43{ 44 if (serial->interface->cur_altsetting->desc.bInterfaceNumber == 1) 45 return 0; 46 47 return -ENODEV; 48} 49 50static struct usb_serial_driver xsens_mt_device = { 51 .driver = { 52 .owner = THIS_MODULE, 53 .name = "xsens_mt", 54 }, 55 .id_table = id_table, 56 .num_ports = 1, 57 58 .probe = xsens_mt_probe, 59}; 60 61static struct usb_serial_driver * const serial_drivers[] = { 62 &xsens_mt_device, NULL 63}; 64 65module_usb_serial_driver(serial_drivers, id_table); 66 67MODULE_AUTHOR("Frans Klaver <frans.klaver@xsens.com>"); 68MODULE_DESCRIPTION("USB-serial driver for Xsens motion trackers"); 69MODULE_LICENSE("GPL v2");