Blame view

kernel/linux-imx6_3.14.28/drivers/usb/serial/wishbone-serial.c 2.56 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
  /*
   * USB Wishbone-Serial adapter driver
   *
   * Copyright (C) 2013 Wesley W. Terpstra <w.terpstra@gsi.de>
   * Copyright (C) 2013 GSI Helmholtz Centre for Heavy Ion Research GmbH
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License
   * as published by the Free Software Foundation; either version 2
   * of the License, or (at your option) any later version.
   */
  
  #include <linux/kernel.h>
  #include <linux/tty.h>
  #include <linux/module.h>
  #include <linux/usb.h>
  #include <linux/usb/serial.h>
  #include <linux/uaccess.h>
  
  #define GSI_VENDOR_OPENCLOSE 0xB0
  
  static const struct usb_device_id id_table[] = {
  	{ USB_DEVICE_AND_INTERFACE_INFO(0x1D50, 0x6062, 0xFF, 0xFF, 0xFF) },
  	{ },
  };
  MODULE_DEVICE_TABLE(usb, id_table);
  
  /*
   * Etherbone must be told that a new stream has begun before data arrives.
   * This is necessary to restart the negotiation of Wishbone bus parameters.
   * Similarly, when the stream ends, Etherbone must be told so that the cycle
   * line can be driven low in the case that userspace failed to do so.
   */
  static int usb_gsi_openclose(struct usb_serial_port *port, int value)
  {
  	struct usb_device *dev = port->serial->dev;
  
  	return usb_control_msg(
  		dev,
  		usb_sndctrlpipe(dev, 0), /* Send to EP0OUT */
  		GSI_VENDOR_OPENCLOSE,
  		USB_DIR_OUT|USB_TYPE_VENDOR|USB_RECIP_INTERFACE,
  		value, /* wValue = device is open(1) or closed(0) */
  		port->serial->interface->cur_altsetting->desc.bInterfaceNumber,
  		NULL, 0,  /* There is no data stage */
  		5000); /* Timeout till operation fails */
  }
  
  static int wishbone_serial_open(struct tty_struct *tty,
  				struct usb_serial_port *port)
  {
  	int retval;
  
  	retval = usb_gsi_openclose(port, 1);
  	if (retval) {
  		dev_err(&port->serial->dev->dev,
  		       "Could not mark device as open (%d)
  ",
  		       retval);
  		return retval;
  	}
  
  	retval = usb_serial_generic_open(tty, port);
  	if (retval)
  		usb_gsi_openclose(port, 0);
  
  	return retval;
  }
  
  static void wishbone_serial_close(struct usb_serial_port *port)
  {
  	usb_serial_generic_close(port);
  	usb_gsi_openclose(port, 0);
  }
  
  static struct usb_serial_driver wishbone_serial_device = {
  	.driver = {
  		.owner =	THIS_MODULE,
  		.name =		"wishbone_serial",
  	},
  	.id_table =		id_table,
  	.num_ports =		1,
  	.open =			&wishbone_serial_open,
  	.close =		&wishbone_serial_close,
  };
  
  static struct usb_serial_driver * const serial_drivers[] = {
  	&wishbone_serial_device, NULL
  };
  
  module_usb_serial_driver(serial_drivers, id_table);
  
  MODULE_AUTHOR("Wesley W. Terpstra <w.terpstra@gsi.de>");
  MODULE_DESCRIPTION("USB Wishbone-Serial adapter");
  MODULE_LICENSE("GPL");