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