1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/module.h>
24#include <linux/netdevice.h>
25#include <linux/etherdevice.h>
26#include <linux/ethtool.h>
27#include <linux/workqueue.h>
28#include <linux/mii.h>
29#include <linux/usb.h>
30#include <linux/usb/usbnet.h>
31#include <linux/gfp.h>
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54#define GENELINK_CONNECT_WRITE 0xF0
55
56#define GENELINK_INTERRUPT_PIPE 0x03
57
58#define INTERRUPT_BUFSIZE 0x08
59
60#define GENELINK_INTERRUPT_INTERVAL 0x10
61
62#define GL_MAX_TRANSMIT_PACKETS 32
63
64#define GL_MAX_PACKET_LEN 1514
65
66#define GL_RCV_BUF_SIZE \
67 (((GL_MAX_PACKET_LEN + 4) * GL_MAX_TRANSMIT_PACKETS) + 4)
68
69struct gl_packet {
70 __le32 packet_length;
71 char packet_data [1];
72};
73
74struct gl_header {
75 __le32 packet_count;
76 struct gl_packet packets;
77};
78
79static int genelink_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
80{
81 struct gl_header *header;
82 struct gl_packet *packet;
83 struct sk_buff *gl_skb;
84 u32 size;
85 u32 count;
86
87
88 if (skb->len < dev->net->hard_header_len)
89 return 0;
90
91 header = (struct gl_header *) skb->data;
92
93
94 count = le32_to_cpu(header->packet_count);
95 if (count > GL_MAX_TRANSMIT_PACKETS) {
96 netdev_dbg(dev->net,
97 "genelink: invalid received packet count %u\n",
98 count);
99 return 0;
100 }
101
102
103 packet = &header->packets;
104
105
106 skb_pull(skb, 4);
107
108 while (count > 1) {
109
110 size = le32_to_cpu(packet->packet_length);
111
112
113 if (size > GL_MAX_PACKET_LEN) {
114 netdev_dbg(dev->net, "genelink: invalid rx length %d\n",
115 size);
116 return 0;
117 }
118
119
120 gl_skb = alloc_skb(size, GFP_ATOMIC);
121 if (gl_skb) {
122
123
124 memcpy(skb_put(gl_skb, size),
125 packet->packet_data, size);
126 usbnet_skb_return(dev, gl_skb);
127 }
128
129
130 packet = (struct gl_packet *)&packet->packet_data[size];
131 count--;
132
133
134 skb_pull(skb, size + 4);
135 }
136
137
138 skb_pull(skb, 4);
139
140 if (skb->len > GL_MAX_PACKET_LEN) {
141 netdev_dbg(dev->net, "genelink: invalid rx length %d\n",
142 skb->len);
143 return 0;
144 }
145 return 1;
146}
147
148static struct sk_buff *
149genelink_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags)
150{
151 int padlen;
152 int length = skb->len;
153 int headroom = skb_headroom(skb);
154 int tailroom = skb_tailroom(skb);
155 __le32 *packet_count;
156 __le32 *packet_len;
157
158
159 padlen = ((skb->len + (4 + 4*1)) % 64) ? 0 : 1;
160
161 if ((!skb_cloned(skb))
162 && ((headroom + tailroom) >= (padlen + (4 + 4*1)))) {
163 if ((headroom < (4 + 4*1)) || (tailroom < padlen)) {
164 skb->data = memmove(skb->head + (4 + 4*1),
165 skb->data, skb->len);
166 skb_set_tail_pointer(skb, skb->len);
167 }
168 } else {
169 struct sk_buff *skb2;
170 skb2 = skb_copy_expand(skb, (4 + 4*1) , padlen, flags);
171 dev_kfree_skb_any(skb);
172 skb = skb2;
173 if (!skb)
174 return NULL;
175 }
176
177
178 packet_count = (__le32 *) skb_push(skb, (4 + 4*1));
179 packet_len = packet_count + 1;
180
181 *packet_count = cpu_to_le32(1);
182 *packet_len = cpu_to_le32(length);
183
184
185 if ((skb->len % dev->maxpacket) == 0)
186 skb_put(skb, 1);
187
188 return skb;
189}
190
191static int genelink_bind(struct usbnet *dev, struct usb_interface *intf)
192{
193 dev->hard_mtu = GL_RCV_BUF_SIZE;
194 dev->net->hard_header_len += 4;
195 dev->in = usb_rcvbulkpipe(dev->udev, dev->driver_info->in);
196 dev->out = usb_sndbulkpipe(dev->udev, dev->driver_info->out);
197 return 0;
198}
199
200static const struct driver_info genelink_info = {
201 .description = "Genesys GeneLink",
202 .flags = FLAG_POINTTOPOINT | FLAG_FRAMING_GL | FLAG_NO_SETINT,
203 .bind = genelink_bind,
204 .rx_fixup = genelink_rx_fixup,
205 .tx_fixup = genelink_tx_fixup,
206
207 .in = 1, .out = 2,
208
209#ifdef GENELINK_ACK
210 .check_connect =genelink_check_connect,
211#endif
212};
213
214static const struct usb_device_id products [] = {
215
216{
217 USB_DEVICE(0x05e3, 0x0502),
218 .driver_info = (unsigned long) &genelink_info,
219},
220
221
222
223 { },
224};
225MODULE_DEVICE_TABLE(usb, products);
226
227static struct usb_driver gl620a_driver = {
228 .name = "gl620a",
229 .id_table = products,
230 .probe = usbnet_probe,
231 .disconnect = usbnet_disconnect,
232 .suspend = usbnet_suspend,
233 .resume = usbnet_resume,
234 .disable_hub_initiated_lpm = 1,
235};
236
237module_usb_driver(gl620a_driver);
238
239MODULE_AUTHOR("Jiun-Jie Huang");
240MODULE_DESCRIPTION("GL620-USB-A Host-to-Host Link cables");
241MODULE_LICENSE("GPL");
242
243