| 1 |
/* |
|---|
| 2 |
* zero.c -- Gadget Zero, for USB development |
|---|
| 3 |
* |
|---|
| 4 |
* Copyright (C) 2003-2004 David Brownell |
|---|
| 5 |
* All rights reserved. |
|---|
| 6 |
* |
|---|
| 7 |
* Redistribution and use in source and binary forms, with or without |
|---|
| 8 |
* modification, are permitted provided that the following conditions |
|---|
| 9 |
* are met: |
|---|
| 10 |
* 1. Redistributions of source code must retain the above copyright |
|---|
| 11 |
* notice, this list of conditions, and the following disclaimer, |
|---|
| 12 |
* without modification. |
|---|
| 13 |
* 2. Redistributions in binary form must reproduce the above copyright |
|---|
| 14 |
* notice, this list of conditions and the following disclaimer in the |
|---|
| 15 |
* documentation and/or other materials provided with the distribution. |
|---|
| 16 |
* 3. The names of the above-listed copyright holders may not be used |
|---|
| 17 |
* to endorse or promote products derived from this software without |
|---|
| 18 |
* specific prior written permission. |
|---|
| 19 |
* |
|---|
| 20 |
* ALTERNATIVELY, this software may be distributed under the terms of the |
|---|
| 21 |
* GNU General Public License ("GPL") as published by the Free Software |
|---|
| 22 |
* Foundation, either version 2 of that License or (at your option) any |
|---|
| 23 |
* later version. |
|---|
| 24 |
* |
|---|
| 25 |
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS |
|---|
| 26 |
* IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, |
|---|
| 27 |
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
|---|
| 28 |
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR |
|---|
| 29 |
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, |
|---|
| 30 |
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, |
|---|
| 31 |
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR |
|---|
| 32 |
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF |
|---|
| 33 |
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING |
|---|
| 34 |
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
|---|
| 35 |
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
|---|
| 36 |
*/ |
|---|
| 37 |
|
|---|
| 38 |
|
|---|
| 39 |
/* |
|---|
| 40 |
* Gadget Zero only needs two bulk endpoints, and is an example of how you |
|---|
| 41 |
* can write a hardware-agnostic gadget driver running inside a USB device. |
|---|
| 42 |
* |
|---|
| 43 |
* Hardware details are visible (see CONFIG_USB_ZERO_* below) but don't |
|---|
| 44 |
* affect most of the driver. |
|---|
| 45 |
* |
|---|
| 46 |
* Use it with the Linux host/master side "usbtest" driver to get a basic |
|---|
| 47 |
* functional test of your device-side usb stack, or with "usb-skeleton". |
|---|
| 48 |
* |
|---|
| 49 |
* It supports two similar configurations. One sinks whatever the usb host |
|---|
| 50 |
* writes, and in return sources zeroes. The other loops whatever the host |
|---|
| 51 |
* writes back, so the host can read it. Module options include: |
|---|
| 52 |
* |
|---|
| 53 |
* buflen=N default N=4096, buffer size used |
|---|
| 54 |
* qlen=N default N=32, how many buffers in the loopback queue |
|---|
| 55 |
* loopdefault default false, list loopback config first |
|---|
| 56 |
* |
|---|
| 57 |
* Many drivers will only have one configuration, letting them be much |
|---|
| 58 |
* simpler if they also don't support high speed operation (like this |
|---|
| 59 |
* driver does). |
|---|
| 60 |
*/ |
|---|
| 61 |
|
|---|
| 62 |
#include <linux/config.h> |
|---|
| 63 |
#include <linux/module.h> |
|---|
| 64 |
#include <linux/kernel.h> |
|---|
| 65 |
#include <linux/delay.h> |
|---|
| 66 |
#include <linux/ioport.h> |
|---|
| 67 |
#include <linux/sched.h> |
|---|
| 68 |
#include <linux/slab.h> |
|---|
| 69 |
#include <linux/smp_lock.h> |
|---|
| 70 |
#include <linux/errno.h> |
|---|
| 71 |
#include <linux/init.h> |
|---|
| 72 |
#include <linux/timer.h> |
|---|
| 73 |
#include <linux/list.h> |
|---|
| 74 |
#include <linux/interrupt.h> |
|---|
| 75 |
#include <linux/uts.h> |
|---|
| 76 |
#include <linux/version.h> |
|---|
| 77 |
#include <linux/device.h> |
|---|
| 78 |
#include <linux/moduleparam.h> |
|---|
| 79 |
#include <linux/proc_fs.h> |
|---|
| 80 |
|
|---|
| 81 |
#include <asm/byteorder.h> |
|---|
| 82 |
#include <asm/io.h> |
|---|
| 83 |
#include <asm/irq.h> |
|---|
| 84 |
#include <asm/system.h> |
|---|
| 85 |
#include <asm/unaligned.h> |
|---|
| 86 |
|
|---|
| 87 |
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,21) |
|---|
| 88 |
# include <linux/usb/ch9.h> |
|---|
| 89 |
#else |
|---|
| 90 |
# include <linux/usb_ch9.h> |
|---|
| 91 |
#endif |
|---|
| 92 |
|
|---|
| 93 |
#include <linux/usb_gadget.h> |
|---|
| 94 |
|
|---|
| 95 |
|
|---|
| 96 |
/*-------------------------------------------------------------------------*/ |
|---|
| 97 |
/*-------------------------------------------------------------------------*/ |
|---|
| 98 |
|
|---|
| 99 |
|
|---|
| 100 |
static int utf8_to_utf16le(const char *s, u16 *cp, unsigned len) |
|---|
| 101 |
{ |
|---|
| 102 |
int count = 0; |
|---|
| 103 |
u8 c; |
|---|
| 104 |
u16 uchar; |
|---|
| 105 |
|
|---|
| 106 |
/* this insists on correct encodings, though not minimal ones. |
|---|
| 107 |
* BUT it currently rejects legit 4-byte UTF-8 code points, |
|---|
| 108 |
* which need surrogate pairs. (Unicode 3.1 can use them.) |
|---|
| 109 |
*/ |
|---|
| 110 |
while (len != 0 && (c = (u8) *s++) != 0) { |
|---|
| 111 |
if (unlikely(c & 0x80)) { |
|---|
| 112 |
// 2-byte sequence: |
|---|
| 113 |
// 00000yyyyyxxxxxx = 110yyyyy 10xxxxxx |
|---|
| 114 |
if ((c & 0xe0) == 0xc0) { |
|---|
| 115 |
uchar = (c & 0x1f) << 6; |
|---|
| 116 |
|
|---|
| 117 |
c = (u8) *s++; |
|---|
| 118 |
if ((c & 0xc0) != 0xc0) |
|---|
| 119 |
goto fail; |
|---|
| 120 |
c &= 0x3f; |
|---|
| 121 |
uchar |= c; |
|---|
| 122 |
|
|---|
| 123 |
// 3-byte sequence (most CJKV characters): |
|---|
| 124 |
// zzzzyyyyyyxxxxxx = 1110zzzz 10yyyyyy 10xxxxxx |
|---|
| 125 |
} else if ((c & 0xf0) == 0xe0) { |
|---|
| 126 |
uchar = (c & 0x0f) << 12; |
|---|
| 127 |
|
|---|
| 128 |
c = (u8) *s++; |
|---|
| 129 |
if ((c & 0xc0) != 0xc0) |
|---|
| 130 |
goto fail; |
|---|
| 131 |
c &= 0x3f; |
|---|
| 132 |
uchar |= c << 6; |
|---|
| 133 |
|
|---|
| 134 |
c = (u8) *s++; |
|---|
| 135 |
if ((c & 0xc0) != 0xc0) |
|---|
| 136 |
goto fail; |
|---|
| 137 |
c &= 0x3f; |
|---|
| 138 |
uchar |= c; |
|---|
| 139 |
|
|---|
| 140 |
/* no bogus surrogates */ |
|---|
| 141 |
if (0xd800 <= uchar && uchar <= 0xdfff) |
|---|
| 142 |
goto fail; |
|---|
| 143 |
|
|---|
| 144 |
// 4-byte sequence (surrogate pairs, currently rare): |
|---|
| 145 |
// 11101110wwwwzzzzyy + 110111yyyyxxxxxx |
|---|
| 146 |
// = 11110uuu 10uuzzzz 10yyyyyy 10xxxxxx |
|---|
| 147 |
// (uuuuu = wwww + 1) |
|---|
| 148 |
// FIXME accept the surrogate code points (only) |
|---|
| 149 |
|
|---|
| 150 |
} else |
|---|
| 151 |
goto fail; |
|---|
| 152 |
} else |
|---|
| 153 |
uchar = c; |
|---|
| 154 |
put_unaligned (cpu_to_le16 (uchar), cp++); |
|---|
| 155 |
count++; |
|---|
| 156 |
len--; |
|---|
| 157 |
} |
|---|
| 158 |
return count; |
|---|
| 159 |
fail: |
|---|
| 160 |
return -1; |
|---|
| 161 |
} |
|---|
| 162 |
|
|---|
| 163 |
|
|---|
| 164 |
/** |
|---|
| 165 |
* usb_gadget_get_string - fill out a string descriptor |
|---|
| 166 |
* @table: of c strings encoded using UTF-8 |
|---|
| 167 |
* @id: string id, from low byte of wValue in get string descriptor |
|---|
| 168 |
* @buf: at least 256 bytes |
|---|
| 169 |
* |
|---|
| 170 |
* Finds the UTF-8 string matching the ID, and converts it into a |
|---|
| 171 |
* string descriptor in utf16-le. |
|---|
| 172 |
* Returns length of descriptor (always even) or negative errno |
|---|
| 173 |
* |
|---|
| 174 |
* If your driver needs stings in multiple languages, you'll probably |
|---|
| 175 |
* "switch (wIndex) { ... }" in your ep0 string descriptor logic, |
|---|
| 176 |
* using this routine after choosing which set of UTF-8 strings to use. |
|---|
| 177 |
* Note that US-ASCII is a strict subset of UTF-8; any string bytes with |
|---|
| 178 |
* the eighth bit set will be multibyte UTF-8 characters, not ISO-8859/1 |
|---|
| 179 |
* characters (which are also widely used in C strings). |
|---|
| 180 |
*/ |
|---|
| 181 |
int |
|---|
| 182 |
usb_gadget_get_string (struct usb_gadget_strings *table, int id, u8 *buf) |
|---|
| 183 |
{ |
|---|
| 184 |
struct usb_string *s; |
|---|
| 185 |
int len; |
|---|
| 186 |
|
|---|
| 187 |
/* descriptor 0 has the language id */ |
|---|
| 188 |
if (id == 0) { |
|---|
| 189 |
buf [0] = 4; |
|---|
| 190 |
buf [1] = USB_DT_STRING; |
|---|
| 191 |
buf [2] = (u8) table->language; |
|---|
| 192 |
buf [3] = (u8) (table->language >> 8); |
|---|
| 193 |
return 4; |
|---|
| 194 |
} |
|---|
| 195 |
for (s = table->strings; s && s->s; s++) |
|---|
| 196 |
if (s->id == id) |
|---|
| 197 |
break; |
|---|
| 198 |
|
|---|
| 199 |
/* unrecognized: stall. */ |
|---|
| 200 |
if (!s || !s->s) |
|---|
| 201 |
return -EINVAL; |
|---|
| 202 |
|
|---|
| 203 |
/* string descriptors have length, tag, then UTF16-LE text */ |
|---|
| 204 |
len = min ((size_t) 126, strlen (s->s)); |
|---|
| 205 |
memset (buf + 2, 0, 2 * len); /* zero all the bytes */ |
|---|
| 206 |
len = utf8_to_utf16le(s->s, (u16 *)&buf[2], len); |
|---|
| 207 |
if (len < 0) |
|---|
| 208 |
return -EINVAL; |
|---|
| 209 |
buf [0] = (len + 1) * 2; |
|---|
| 210 |
buf [1] = USB_DT_STRING; |
|---|
| 211 |
return buf [0]; |
|---|
| 212 |
} |
|---|
| 213 |
|
|---|
| 214 |
|
|---|
| 215 |
/*-------------------------------------------------------------------------*/ |
|---|
| 216 |
/*-------------------------------------------------------------------------*/ |
|---|
| 217 |
|
|---|
| 218 |
|
|---|
| 219 |
/** |
|---|
| 220 |
* usb_descriptor_fillbuf - fill buffer with descriptors |
|---|
| 221 |
* @buf: Buffer to be filled |
|---|
| 222 |
* @buflen: Size of buf |
|---|
| 223 |
* @src: Array of descriptor pointers, terminated by null pointer. |
|---|
| 224 |
* |
|---|
| 225 |
* Copies descriptors into the buffer, returning the length or a |
|---|
| 226 |
* negative error code if they can't all be copied. Useful when |
|---|
| 227 |
* assembling descriptors for an associated set of interfaces used |
|---|
| 228 |
* as part of configuring a composite device; or in other cases where |
|---|
| 229 |
* sets of descriptors need to be marshaled. |
|---|
| 230 |
*/ |
|---|
| 231 |
int |
|---|
| 232 |
usb_descriptor_fillbuf(void *buf, unsigned buflen, |
|---|
| 233 |
const struct usb_descriptor_header **src) |
|---|
| 234 |
{ |
|---|
| 235 |
u8 *dest = buf; |
|---|
| 236 |
|
|---|
| 237 |
if (!src) |
|---|
| 238 |
return -EINVAL; |
|---|
| 239 |
|
|---|
| 240 |
/* fill buffer from src[] until null descriptor ptr */ |
|---|
| 241 |
for (; 0 != *src; src++) { |
|---|
| 242 |
unsigned len = (*src)->bLength; |
|---|
| 243 |
|
|---|
| 244 |
if (len > buflen) |
|---|
| 245 |
return -EINVAL; |
|---|
| 246 |
memcpy(dest, *src, len); |
|---|
| 247 |
buflen -= len; |
|---|
| 248 |
dest += len; |
|---|
| 249 |
} |
|---|
| 250 |
return dest - (u8 *)buf; |
|---|
| 251 |
} |
|---|
| 252 |
|
|---|
| 253 |
|
|---|
| 254 |
/** |
|---|
| 255 |
* usb_gadget_config_buf - builts a complete configuration descriptor |
|---|
| 256 |
* @config: Header for the descriptor, including characteristics such |
|---|
| 257 |
* as power requirements and number of interfaces. |
|---|
| 258 |
* @desc: Null-terminated vector of pointers to the descriptors (interface, |
|---|
| 259 |
* endpoint, etc) defining all functions in this device configuration. |
|---|
| 260 |
* @buf: Buffer for the resulting configuration descriptor. |
|---|
| 261 |
* @length: Length of buffer. If this is not big enough to hold the |
|---|
| 262 |
* entire configuration descriptor, an error code will be returned. |
|---|
| 263 |
* |
|---|
| 264 |
* This copies descriptors into the response buffer, building a descriptor |
|---|
| 265 |
* for that configuration. It returns the buffer length or a negative |
|---|
| 266 |
* status code. The config.wTotalLength field is set to match the length |
|---|
| 267 |
* of the result, but other descriptor fields (including power usage and |
|---|
| 268 |
* interface count) must be set by the caller. |
|---|
| 269 |
* |
|---|
| 270 |
* Gadget drivers could use this when constructing a config descriptor |
|---|
| 271 |
* in response to USB_REQ_GET_DESCRIPTOR. They will need to patch the |
|---|
| 272 |
* resulting bDescriptorType value if USB_DT_OTHER_SPEED_CONFIG is needed. |
|---|
| 273 |
*/ |
|---|
| 274 |
int usb_gadget_config_buf( |
|---|
| 275 |
const struct usb_config_descriptor *config, |
|---|
| 276 |
void *buf, |
|---|
| 277 |
unsigned length, |
|---|
| 278 |
const struct usb_descriptor_header **desc |
|---|
| 279 |
) |
|---|
| 280 |
{ |
|---|
| 281 |
struct usb_config_descriptor *cp = buf; |
|---|
| 282 |
int len; |
|---|
| 283 |
|
|---|
| 284 |
/* config descriptor first */ |
|---|
| 285 |
if (length < USB_DT_CONFIG_SIZE || !desc) |
|---|
| 286 |
return -EINVAL; |
|---|
| 287 |
*cp = *config; |
|---|
| 288 |
|
|---|
| 289 |
/* then interface/endpoint/class/vendor/... */ |
|---|
| 290 |
len = usb_descriptor_fillbuf(USB_DT_CONFIG_SIZE + (u8*)buf, |
|---|
| 291 |
length - USB_DT_CONFIG_SIZE, desc); |
|---|
| 292 |
if (len < 0) |
|---|
| 293 |
return len; |
|---|
| 294 |
len += USB_DT_CONFIG_SIZE; |
|---|
| 295 |
if (len > 0xffff) |
|---|
| 296 |
return -EINVAL; |
|---|
| 297 |
|
|---|
| 298 |
/* patch up the config descriptor */ |
|---|
| 299 |
cp->bLength = USB_DT_CONFIG_SIZE; |
|---|
| 300 |
cp->bDescriptorType = USB_DT_CONFIG; |
|---|
| 301 |
cp->wTotalLength = cpu_to_le16(len); |
|---|
| 302 |
cp->bmAttributes |= USB_CONFIG_ATT_ONE; |
|---|
| 303 |
return len; |
|---|
| 304 |
} |
|---|
| 305 |
|
|---|
| 306 |
/*-------------------------------------------------------------------------*/ |
|---|
| 307 |
/*-------------------------------------------------------------------------*/ |
|---|
| 308 |
|
|---|
| 309 |
|
|---|
| 310 |
#define RBUF_LEN (1024*1024) |
|---|
| 311 |
static int rbuf_start; |
|---|
| 312 |
static int rbuf_len; |
|---|
| 313 |
static __u8 rbuf[RBUF_LEN]; |
|---|
| 314 |
|
|---|
| 315 |
/*-------------------------------------------------------------------------*/ |
|---|
| 316 |
|
|---|
| 317 |
#define DRIVER_VERSION "St Patrick's Day 2004" |
|---|
| 318 |
|
|---|
| 319 |
static const char shortname [] = "zero"; |
|---|
| 320 |
static const char longname [] = "YAMAHA YST-MS35D USB Speaker "; |
|---|
| 321 |
|
|---|
| 322 |
static const char source_sink [] = "source and sink data"; |
|---|
| 323 |
static const char loopback [] = "loop input to output"; |
|---|
| 324 |
|
|---|
| 325 |
/*-------------------------------------------------------------------------*/ |
|---|
| 326 |
|
|---|
| 327 |
/* |
|---|
| 328 |
* driver assumes self-powered hardware, and |
|---|
| 329 |
* has no way for users to trigger remote wakeup. |
|---|
| 330 |
* |
|---|
| 331 |
* this version autoconfigures as much as possible, |
|---|
| 332 |
* which is reasonable for most "bulk-only" drivers. |
|---|
| 333 |
*/ |
|---|
| 334 |
static const char *EP_IN_NAME; /* source */ |
|---|
| 335 |
static const char *EP_OUT_NAME; /* sink */ |
|---|
| 336 |
|
|---|
| 337 |
/*-------------------------------------------------------------------------*/ |
|---|
| 338 |
|
|---|
| 339 |
/* big enough to hold our biggest descriptor */ |
|---|
| 340 |
#define USB_BUFSIZ 512 |
|---|
| 341 |
|
|---|
| 342 |
struct zero_dev { |
|---|
| 343 |
spinlock_t lock; |
|---|
| 344 |
struct usb_gadget *gadget; |
|---|
| 345 |
struct usb_request *req; /* for control responses */ |
|---|
| 346 |
|
|---|
| 347 |
/* when configured, we have one of two configs: |
|---|
| 348 |
* - source data (in to host) and sink it (out from host) |
|---|
| 349 |
* - or loop it back (out from host back in to host) |
|---|
| 350 |
*/ |
|---|
| 351 |
u8 config; |
|---|
| 352 |
struct usb_ep *in_ep, *out_ep; |
|---|
| 353 |
|
|---|
| 354 |
/* autoresume timer */ |
|---|
| 355 |
struct timer_list resume; |
|---|
| 356 |
}; |
|---|
| 357 |
|
|---|
| 358 |
#define xprintk(d,level,fmt,args...) \ |
|---|
| 359 |
dev_printk(level , &(d)->gadget->dev , fmt , ## args) |
|---|
| 360 |
|
|---|
| 361 |
#ifdef DEBUG |
|---|
| 362 |
#define DBG(dev,fmt,args...) \ |
|---|
| 363 |
xprintk(dev , KERN_DEBUG , fmt , ## args) |
|---|
| 364 |
#else |
|---|
| 365 |
#define DBG(dev,fmt,args...) \ |
|---|
| 366 |
do { } while (0) |
|---|
| 367 |
#endif /* DEBUG */ |
|---|
| 368 |
|
|---|
| 369 |
#ifdef VERBOSE |
|---|
| 370 |
#define VDBG DBG |
|---|
| 371 |
#else |
|---|
| 372 |
#define VDBG(dev,fmt,args...) \ |
|---|
| 373 |
do { } while (0) |
|---|
| 374 |
#endif /* VERBOSE */ |
|---|
| 375 |
|
|---|
| 376 |
#define ERROR(dev,fmt,args...) \ |
|---|
| 377 |
xprintk(dev , KERN_ERR , fmt , ## args) |
|---|
| 378 |
#define WARN(dev,fmt,args...) \ |
|---|
| 379 |
xprintk(dev , KERN_WARNING , fmt , ## args) |
|---|
| 380 |
#define INFO(dev,fmt,args...) \ |
|---|
| 381 |
xprintk(dev , KERN_INFO , fmt , ## args) |
|---|
| 382 |
|
|---|
| 383 |
/*-------------------------------------------------------------------------*/ |
|---|
| 384 |
|
|---|
| 385 |
static unsigned buflen = 4096; |
|---|
| 386 |
static unsigned qlen = 32; |
|---|
| 387 |
static unsigned pattern = 0; |
|---|
| 388 |
|
|---|
| 389 |
module_param (buflen, uint, S_IRUGO|S_IWUSR); |
|---|
| 390 |
module_param (qlen, uint, S_IRUGO|S_IWUSR); |
|---|
| 391 |
module_param (pattern, uint, S_IRUGO|S_IWUSR); |
|---|
| 392 |
|
|---|
| 393 |
/* |
|---|
| 394 |
* if it's nonzero, autoresume says how many seconds to wait |
|---|
| 395 |
* before trying to wake up the host after suspend. |
|---|
| 396 |
*/ |
|---|
| 397 |
static unsigned autoresume = 0; |
|---|
| 398 |
module_param (autoresume, uint, 0); |
|---|
| 399 |
|
|---|
| 400 |
/* |
|---|
| 401 |
* Normally the "loopback" configuration is second (index 1) so |
|---|
| 402 |
* it's not the default. Here's where to change that order, to |
|---|
| 403 |
* work better with hosts where config changes are problematic. |
|---|
| 404 |
* Or controllers (like superh) that only support one config. |
|---|
| 405 |
*/ |
|---|
| 406 |
static int loopdefault = 0; |
|---|
| 407 |
|
|---|
| 408 |
module_param (loopdefault, bool, S_IRUGO|S_IWUSR); |
|---|
| 409 |
|
|---|
| 410 |
/*-------------------------------------------------------------------------*/ |
|---|
| 411 |
|
|---|
| 412 |
/* Thanks to NetChip Technologies for donating this product ID. |
|---|
| 413 |
* |
|---|
| 414 |
* DO NOT REUSE THESE IDs with a protocol-incompatible driver!! Ever!! |
|---|
| 415 |
* Instead: allocate your own, using normal USB-IF procedures. |
|---|
| 416 |
*/ |
|---|
| 417 |
#ifndef CONFIG_USB_ZERO_HNPTEST |
|---|
| 418 |
#define DRIVER_VENDOR_NUM 0x0525 /* NetChip */ |
|---|
| 419 |
#define DRIVER_PRODUCT_NUM 0xa4a0 /* Linux-USB "Gadget Zero" */ |
|---|
| 420 |
#else |
|---|
| 421 |
#define DRIVER_VENDOR_NUM 0x1a0a /* OTG test device IDs */ |
|---|
| 422 |
#define DRIVER_PRODUCT_NUM 0xbadd |
|---|
| 423 |
#endif |
|---|
| 424 |
|
|---|
| 425 |
/*-------------------------------------------------------------------------*/ |
|---|
| 426 |
|
|---|
| 427 |
/* |
|---|
| 428 |
* DESCRIPTORS ... most are static, but strings and (full) |
|---|
| 429 |
* configuration descriptors are built on demand. |
|---|
| 430 |
*/ |
|---|
| 431 |
|
|---|
| 432 |
/* |
|---|
| 433 |
#define STRING_MANUFACTURER 25 |
|---|
| 434 |
#define STRING_PRODUCT 42 |
|---|
| 435 |
#define STRING_SERIAL 101 |
|---|
| 436 |
*/ |
|---|
| 437 |
#define STRING_MANUFACTURER 1 |
|---|
| 438 |
#define STRING_PRODUCT 2 |
|---|
| 439 |
#define STRING_SERIAL 3 |
|---|
| 440 |
|
|---|
| 441 |
#define STRING_SOURCE_SINK 250 |
|---|
| 442 |
#define STRING_LOOPBACK 251 |
|---|
| 443 |
|
|---|
| 444 |
/* |
|---|
| 445 |
* This device advertises two configurations; these numbers work |
|---|
| 446 |
* on a pxa250 as well as more flexible hardware. |
|---|
| 447 |
*/ |
|---|
| 448 |
#define CONFIG_SOURCE_SINK 3 |
|---|
| 449 |
#define CONFIG_LOOPBACK 2 |
|---|
| 450 |
|
|---|
| 451 |
/* |
|---|
| 452 |
static struct usb_device_descriptor |
|---|
| 453 |
device_desc = { |
|---|
| 454 |
.bLength = sizeof device_desc, |
|---|
| 455 |
.bDescriptorType = USB_DT_DEVICE, |
|---|
| 456 |
|
|---|
| 457 |
.bcdUSB = __constant_cpu_to_le16 (0x0200), |
|---|
| 458 |
.bDeviceClass = USB_CLASS_VENDOR_SPEC, |
|---|
| 459 |
|
|---|
| 460 |
.idVendor = __constant_cpu_to_le16 (DRIVER_VENDOR_NUM), |
|---|
| 461 |
.idProduct = __constant_cpu_to_le16 (DRIVER_PRODUCT_NUM), |
|---|
| 462 |
.iManufacturer = STRING_MANUFACTURER, |
|---|
| 463 |
.iProduct = STRING_PRODUCT, |
|---|
| 464 |
.iSerialNumber = STRING_SERIAL, |
|---|
| 465 |
.bNumConfigurations = 2, |
|---|
| 466 |
}; |
|---|
| 467 |
*/ |
|---|
| 468 |
static struct usb_device_descriptor |
|---|
| 469 |
device_desc = { |
|---|
| 470 |
.bLength = sizeof device_desc, |
|---|
| 471 |
.bDescriptorType = USB_DT_DEVICE, |
|---|
| 472 |
.bcdUSB = __constant_cpu_to_le16 (0x0100), |
|---|
| 473 |
.bDeviceClass = USB_CLASS_PER_INTERFACE, |
|---|
| 474 |
.bDeviceSubClass = 0, |
|---|
| 475 |
.bDeviceProtocol = 0, |
|---|
| 476 |
.bMaxPacketSize0 = 64, |
|---|
| 477 |
.bcdDevice = __constant_cpu_to_le16 (0x0100), |
|---|
| 478 |
.idVendor = __constant_cpu_to_le16 (0x0499), |
|---|
| 479 |
.idProduct = __constant_cpu_to_le16 (0x3002), |
|---|
| 480 |
.iManufacturer = STRING_MANUFACTURER, |
|---|
| 481 |
.iProduct = STRING_PRODUCT, |
|---|
| 482 |
.iSerialNumber = STRING_SERIAL, |
|---|
| 483 |
.bNumConfigurations = 1, |
|---|
| 484 |
}; |
|---|
| 485 |
|
|---|
| 486 |
static struct usb_config_descriptor |
|---|
| 487 |
z_config = { |
|---|
| 488 |
.bLength = sizeof z_config, |
|---|
| 489 |
.bDescriptorType = USB_DT_CONFIG, |
|---|
| 490 |
|
|---|
| 491 |
/* compute wTotalLength on the fly */ |
|---|
| 492 |
.bNumInterfaces = 2, |
|---|
| 493 |
.bConfigurationValue = 1, |
|---|
| 494 |
.iConfiguration = 0, |
|---|
| 495 |
.bmAttributes = 0x40, |
|---|
| 496 |
.bMaxPower = 0, /* self-powered */ |
|---|
| 497 |
}; |
|---|
| 498 |
|
|---|
| 499 |
|
|---|
| 500 |
static struct usb_otg_descriptor |
|---|
| 501 |
otg_descriptor = { |
|---|
| 502 |
.bLength = sizeof otg_descriptor, |
|---|
| 503 |
.bDescriptorType = USB_DT_OTG, |
|---|
| 504 |
|
|---|
| 505 |
.bmAttributes = USB_OTG_SRP, |
|---|
| 506 |
}; |
|---|
| 507 |
|
|---|
| 508 |
/* one interface in each configuration */ |
|---|
| 509 |
#ifdef CONFIG_USB_GADGET_DUALSPEED |
|---|
| 510 |
|
|---|
| 511 |
/* |
|---|
| 512 |
* usb 2.0 devices need to expose both high speed and full speed |
|---|
| 513 |
* descriptors, unless they only run at full speed. |
|---|
| 514 |
* |
|---|
| 515 |
* that means alternate endpoint descriptors (bigger packets) |
|---|
| 516 |
* and a "device qualifier" ... plus more construction options |
|---|
| 517 |
* for the config descriptor. |
|---|
| 518 |
*/ |
|---|
| 519 |
|
|---|
| 520 |
static struct usb_qualifier_descriptor |
|---|
| 521 |
dev_qualifier = { |
|---|
| 522 |
.bLength = sizeof dev_qualifier, |
|---|
| 523 |
.bDescriptorType = USB_DT_DEVICE_QUALIFIER, |
|---|
| 524 |
|
|---|
| 525 |
.bcdUSB = __constant_cpu_to_le16 (0x0200), |
|---|
| 526 |
.bDeviceClass = USB_CLASS_VENDOR_SPEC, |
|---|
| 527 |
|
|---|
| 528 |
.bNumConfigurations = 2, |
|---|
| 529 |
}; |
|---|
| 530 |
|
|---|
| 531 |
|
|---|
| 532 |
struct usb_cs_as_general_descriptor { |
|---|
| 533 |
__u8 bLength; |
|---|
| 534 |
__u8 bDescriptorType; |
|---|
| 535 |
|
|---|
| 536 |
__u8 bDescriptorSubType; |
|---|
| 537 |
__u8 bTerminalLink; |
|---|
| 538 |
__u8 bDelay; |
|---|
| 539 |
__u16 wFormatTag; |
|---|
| 540 |
} __attribute__ ((packed)); |
|---|
| 541 |
|
|---|
| 542 |
struct usb_cs_as_format_descriptor { |
|---|
| 543 |
__u8 bLength; |
|---|
| 544 |
__u8 bDescriptorType; |
|---|
| 545 |
|
|---|
| 546 |
__u8 bDescriptorSubType; |
|---|
| 547 |
__u8 bFormatType; |
|---|
| 548 |
__u8 bNrChannels; |
|---|
| 549 |
__u8 bSubframeSize; |
|---|
| 550 |
__u8 bBitResolution; |
|---|
| 551 |
__u8 bSamfreqType; |
|---|
| 552 |
__u8 tLowerSamFreq[3]; |
|---|
| 553 |
__u8 tUpperSamFreq[3]; |
|---|
| 554 |
} __attribute__ ((packed)); |
|---|
| 555 |
|
|---|
| 556 |
static const struct usb_interface_descriptor |
|---|
| 557 |
z_audio_control_if_desc = { |
|---|
| 558 |
.bLength = sizeof z_audio_control_if_desc, |
|---|
| 559 |
.bDescriptorType = USB_DT_INTERFACE, |
|---|
| 560 |
.bInterfaceNumber = 0, |
|---|
| 561 |
.bAlternateSetting = 0, |
|---|
| 562 |
.bNumEndpoints = 0, |
|---|
| 563 |
.bInterfaceClass = USB_CLASS_AUDIO, |
|---|
| 564 |
.bInterfaceSubClass = 0x1, |
|---|
| 565 |
.bInterfaceProtocol = 0, |
|---|
| 566 |
.iInterface = 0, |
|---|
| 567 |
}; |
|---|
| 568 |
|
|---|
| 569 |
static const struct usb_interface_descriptor |
|---|
| 570 |
z_audio_if_desc = { |
|---|
| 571 |
.bLength = sizeof z_audio_if_desc, |
|---|
| 572 |
.bDescriptorType = USB_DT_INTERFACE, |
|---|
| 573 |
.bInterfaceNumber = 1, |
|---|
| 574 |
.bAlternateSetting = 0, |
|---|
| 575 |
.bNumEndpoints = 0, |
|---|
| 576 |
.bInterfaceClass = USB_CLASS_AUDIO, |
|---|
| 577 |
.bInterfaceSubClass = 0x2, |
|---|
| 578 |
.bInterfaceProtocol = 0, |
|---|
| 579 |
.iInterface = 0, |
|---|
| 580 |
}; |
|---|
| 581 |
|
|---|
| 582 |
static const struct usb_interface_descriptor |
|---|
| 583 |
z_audio_if_desc2 = { |
|---|
| 584 |
.bLength = sizeof z_audio_if_desc, |
|---|
| 585 |
.bDescriptorType = USB_DT_INTERFACE, |
|---|
| 586 |
.bInterfaceNumber = 1, |
|---|
| 587 |
.bAlternateSetting = 1, |
|---|
| 588 |
.bNumEndpoints = 1, |
|---|
| 589 |
.bInterfaceClass = USB_CLASS_AUDIO, |
|---|
| 590 |
.bInterfaceSubClass = 0x2, |
|---|
| 591 |
.bInterfaceProtocol = 0, |
|---|
| 592 |
.iInterface = 0, |
|---|
| 593 |
}; |
|---|
| 594 |
|
|---|
| 595 |
static const struct usb_cs_as_general_descriptor |
|---|
| 596 |
z_audio_cs_as_if_desc = { |
|---|
| 597 |
.bLength = 7, |
|---|
| 598 |
.bDescriptorType = 0x24, |
|---|
| 599 |
|
|---|
| 600 |
.bDescriptorSubType = 0x01, |
|---|
| 601 |
.bTerminalLink = 0x01, |
|---|
| 602 |
.bDelay = 0x0, |
|---|
| 603 |
.wFormatTag = __constant_cpu_to_le16 (0x0001) |
|---|
| 604 |
}; |
|---|
| 605 |
|
|---|
| 606 |
|
|---|
| 607 |
static const struct usb_cs_as_format_descriptor |
|---|
| 608 |
z_audio_cs_as_format_desc = { |
|---|
| 609 |
.bLength = 0xe, |
|---|
| 610 |
.bDescriptorType = 0x24, |
|---|
| 611 |
|
|---|
| 612 |
.bDescriptorSubType = 2, |
|---|
| 613 |
.bFormatType = 1, |
|---|
| 614 |
.bNrChannels = 1, |
|---|
| 615 |
.bSubframeSize = 1, |
|---|
| 616 |
.bBitResolution = 8, |
|---|
| 617 |
.bSamfreqType = 0, |
|---|
| 618 |
.tLowerSamFreq = {0x7e, 0x13, 0x00}, |
|---|
| 619 |
.tUpperSamFreq = {0xe2, 0xd6, 0x00}, |
|---|
| 620 |
}; |
|---|
| 621 |
|
|---|
| 622 |
static const struct usb_endpoint_descriptor |
|---|
| 623 |
z_iso_ep = { |
|---|
| 624 |
.bLength = 0x09, |
|---|
| 625 |
.bDescriptorType = 0x05, |
|---|
| 626 |
.bEndpointAddress = 0x04, |
|---|
| 627 |
.bmAttributes = 0x09, |
|---|
| 628 |
.wMaxPacketSize = 0x0038, |
|---|
| 629 |
.bInterval = 0x01, |
|---|
| 630 |
.bRefresh = 0x00, |
|---|
| 631 |
.bSynchAddress = 0x00, |
|---|
| 632 |
}; |
|---|
| 633 |
|
|---|
| 634 |
static char z_iso_ep2[] = {0x07, 0x25, 0x01, 0x00, 0x02, 0x00, 0x02}; |
|---|
| 635 |
|
|---|
| 636 |
// 9 bytes |
|---|
| 637 |
static char z_ac_interface_header_desc[] = |
|---|
| 638 |
{ 0x09, 0x24, 0x01, 0x00, 0x01, 0x2b, 0x00, 0x01, 0x01 }; |
|---|
| 639 |
|
|---|
| 640 |
// 12 bytes |
|---|
| 641 |
static char z_0[] = {0x0c, 0x24, 0x02, 0x01, 0x01, 0x01, 0x00, 0x02, |
|---|
| 642 |
0x03, 0x00, 0x00, 0x00}; |
|---|
| 643 |
// 13 bytes |
|---|
| 644 |
static char z_1[] = {0x0d, 0x24, 0x06, 0x02, 0x01, 0x02, 0x15, 0x00, |
|---|
| 645 |
0x02, 0x00, 0x02, 0x00, 0x00}; |
|---|
| 646 |
// 9 bytes |
|---|
| 647 |
static char z_2[] = {0x09, 0x24, 0x03, 0x03, 0x01, 0x03, 0x00, 0x02, |
|---|
| 648 |
0x00}; |
|---|
| 649 |
|
|---|
| 650 |
static char za_0[] = {0x09, 0x04, 0x01, 0x02, 0x01, 0x01, 0x02, 0x00, |
|---|
| 651 |
0x00}; |
|---|
| 652 |
|
|---|
| 653 |
static char za_1[] = {0x07, 0x24, 0x01, 0x01, 0x00, 0x01, 0x00}; |
|---|
| 654 |
|
|---|
| 655 |
static char za_2[] = {0x0e, 0x24, 0x02, 0x01, 0x02, 0x01, 0x08, 0x00, |
|---|
| 656 |
0x7e, 0x13, 0x00, 0xe2, 0xd6, 0x00}; |
|---|
| 657 |
|
|---|
| 658 |
static char za_3[] = {0x09, 0x05, 0x04, 0x09, 0x70, 0x00, 0x01, 0x00, |
|---|
| 659 |
0x00}; |
|---|
| 660 |
|
|---|
| 661 |
static char za_4[] = {0x07, 0x25, 0x01, 0x00, 0x02, 0x00, 0x02}; |
|---|
| 662 |
|
|---|
| 663 |
static char za_5[] = {0x09, 0x04, 0x01, 0x03, 0x01, 0x01, 0x02, 0x00, |
|---|
| 664 |
0x00}; |
|---|
| 665 |
|
|---|
| 666 |
static char za_6[] = {0x07, 0x24, 0x01, 0x01, 0x00, 0x01, 0x00}; |
|---|
| 667 |
|
|---|
| 668 |
static char za_7[] = {0x0e, 0x24, 0x02, 0x01, 0x01, 0x02, 0x10, 0x00, |
|---|
| 669 |
0x7e, 0x13, 0x00, 0xe2, 0xd6, 0x00}; |
|---|
| 670 |
|
|---|
| 671 |
static char za_8[] = {0x09, 0x05, 0x04, 0x09, 0x70, 0x00, 0x01, 0x00, |
|---|
| 672 |
0x00}; |
|---|
| 673 |
|
|---|
| 674 |
static char za_9[] = {0x07, 0x25, 0x01, 0x00, 0x02, 0x00, 0x02}; |
|---|
| 675 |
|
|---|
| 676 |
static char za_10[] = {0x09, 0x04, 0x01, 0x04, 0x01, 0x01, 0x02, 0x00, |
|---|
| 677 |
0x00}; |
|---|
| 678 |
|
|---|
| 679 |
static char za_11[] = {0x07, 0x24, 0x01, 0x01, 0x00, 0x01, 0x00}; |
|---|
| 680 |
|
|---|
| 681 |
static char za_12[] = {0x0e, 0x24, 0x02, 0x01, 0x02, 0x02, 0x10, 0x00, |
|---|
| 682 |
0x73, 0x13, 0x00, 0xe2, 0xd6, 0x00}; |
|---|
| 683 |
|
|---|
| 684 |
static char za_13[] = {0x09, 0x05, 0x04, 0x09, 0xe0, 0x00, 0x01, 0x00, |
|---|
| 685 |
0x00}; |
|---|
| 686 |
|
|---|
| 687 |
static char za_14[] = {0x07, 0x25, 0x01, 0x00, 0x02, 0x00, 0x02}; |
|---|
| 688 |
|
|---|
| 689 |
static char za_15[] = {0x09, 0x04, 0x01, 0x05, 0x01, 0x01, 0x02, 0x00, |
|---|
| 690 |
0x00}; |
|---|
| 691 |
|
|---|
| 692 |
static char za_16[] = {0x07, 0x24, 0x01, 0x01, 0x00, 0x01, 0x00}; |
|---|
| 693 |
|
|---|
| 694 |
static char za_17[] = {0x0e, 0x24, 0x02, 0x01, 0x01, 0x03, 0x14, 0x00, |
|---|
| 695 |
0x7e, 0x13, 0x00, 0xe2, 0xd6, 0x00}; |
|---|
| 696 |
|
|---|
| 697 |
static char za_18[] = {0x09, 0x05, 0x04, 0x09, 0xa8, 0x00, 0x01, 0x00, |
|---|
| 698 |
0x00}; |
|---|
| 699 |
|
|---|
| 700 |
static char za_19[] = {0x07, 0x25, 0x01, 0x00, 0x02, 0x00, 0x02}; |
|---|
| 701 |
|
|---|
| 702 |
static char za_20[] = {0x09, 0x04, 0x01, 0x06, 0x01, 0x01, 0x02, 0x00, |
|---|
| 703 |
0x00}; |
|---|
| 704 |
|
|---|
| 705 |
static char za_21[] = {0x07, 0x24, 0x01, 0x01, 0x00, 0x01, 0x00}; |
|---|
| 706 |
|
|---|
| 707 |
static char za_22[] = {0x0e, 0x24, 0x02, 0x01, 0x02, 0x03, 0x14, 0x00, |
|---|
| 708 |
0x7e, 0x13, 0x00, 0xe2, 0xd6, 0x00}; |
|---|
| 709 |
|
|---|
| 710 |
static char za_23[] = {0x09, 0x05, 0x04, 0x09, 0x50, 0x01, 0x01, 0x00, |
|---|
| 711 |
0x00}; |
|---|
| 712 |
|
|---|
| 713 |
static char za_24[] = {0x07, 0x25, 0x01, 0x00, 0x02, 0x00, 0x02}; |
|---|
| 714 |
|
|---|
| 715 |
|
|---|
| 716 |
|
|---|
| 717 |
static const struct usb_descriptor_header *z_function [] = { |
|---|
| 718 |
(struct usb_descriptor_header *) &z_audio_control_if_desc, |
|---|
| 719 |
(struct usb_descriptor_header *) &z_ac_interface_header_desc, |
|---|
| 720 |
(struct usb_descriptor_header *) &z_0, |
|---|
| 721 |
(struct usb_descriptor_header *) &z_1, |
|---|
| 722 |
(struct usb_descriptor_header *) &z_2, |
|---|
| 723 |
(struct usb_descriptor_header *) &z_audio_if_desc, |
|---|
| 724 |
(struct usb_descriptor_header *) &z_audio_if_desc2, |
|---|
| 725 |
(struct usb_descriptor_header *) &z_audio_cs_as_if_desc, |
|---|
| 726 |
(struct usb_descriptor_header *) &z_audio_cs_as_format_desc, |
|---|
| 727 |
(struct usb_descriptor_header *) &z_iso_ep, |
|---|
| 728 |
(struct usb_descriptor_header *) &z_iso_ep2, |
|---|
| 729 |
(struct usb_descriptor_header *) &za_0, |
|---|
| 730 |
(struct usb_descriptor_header *) &za_1, |
|---|
| 731 |
(struct usb_descriptor_header *) &za_2, |
|---|
| 732 |
(struct usb_descriptor_header *) &za_3, |
|---|
| 733 |
(struct usb_descriptor_header *) &za_4, |
|---|
| 734 |
(struct usb_descriptor_header *) &za_5, |
|---|
| 735 |
(struct usb_descriptor_header *) &za_6, |
|---|
| 736 |
(struct usb_descriptor_header *) &za_7, |
|---|
| 737 |
(struct usb_descriptor_header *) &za_8, |
|---|
| 738 |
(struct usb_descriptor_header *) &za_9, |
|---|
| 739 |
(struct usb_descriptor_header *) &za_10, |
|---|
| 740 |
(struct usb_descriptor_header *) &za_11, |
|---|
| 741 |
(struct usb_descriptor_header *) &za_12, |
|---|
| 742 |
(struct usb_descriptor_header *) &za_13, |
|---|
| 743 |
(struct usb_descriptor_header *) &za_14, |
|---|
| 744 |
(struct usb_descriptor_header *) &za_15, |
|---|
| 745 |
(struct usb_descriptor_header *) &za_16, |
|---|
| 746 |
(struct usb_descriptor_header *) &za_17, |
|---|
| 747 |
(struct usb_descriptor_header *) &za_18, |
|---|
| 748 |
(struct usb_descriptor_header *) &za_19, |
|---|
| 749 |
(struct usb_descriptor_header *) &za_20, |
|---|
| 750 |
(struct usb_descriptor_header *) &za_21, |
|---|
| 751 |
(struct usb_descriptor_header *) &za_22, |
|---|
| 752 |
(struct usb_descriptor_header *) &za_23, |
|---|
| 753 |
(struct usb_descriptor_header *) &za_24, |
|---|
| 754 |
NULL, |
|---|
| 755 |
}; |
|---|
| 756 |
|
|---|
| 757 |
/* maxpacket and other transfer characteristics vary by speed. */ |
|---|
| 758 |
#define ep_desc(g,hs,fs) (((g)->speed==USB_SPEED_HIGH)?(hs):(fs)) |
|---|
| 759 |
|
|---|
| 760 |
#else |
|---|
| 761 |
|
|---|
| 762 |
/* if there's no high speed support, maxpacket doesn't change. */ |
|---|
| 763 |
#define ep_desc(g,hs,fs) fs |
|---|
| 764 |
|
|---|
| 765 |
#endif /* !CONFIG_USB_GADGET_DUALSPEED */ |
|---|
| 766 |
|
|---|
| 767 |
static char manufacturer [40]; |
|---|
| 768 |
//static char serial [40]; |
|---|
| 769 |
static char serial [] = "Ser 00 em"; |
|---|
| 770 |
|
|---|
| 771 |
/* static strings, in UTF-8 */ |
|---|
| 772 |
static struct usb_string strings [] = { |
|---|
| 773 |
{ STRING_MANUFACTURER, manufacturer, }, |
|---|
| 774 |
{ STRING_PRODUCT, longname, }, |
|---|
| 775 |
{ STRING_SERIAL, serial, }, |
|---|
| 776 |
{ STRING_LOOPBACK, loopback, }, |
|---|
| 777 |
{ STRING_SOURCE_SINK, source_sink, }, |
|---|
| 778 |
{ } /* end of list */ |
|---|
| 779 |
}; |
|---|
| 780 |
|
|---|
| 781 |
static struct usb_gadget_strings stringtab = { |
|---|
| 782 |
.language = 0x0409, /* en-us */ |
|---|
| 783 |
.strings = strings, |
|---|
| 784 |
}; |
|---|
| 785 |
|
|---|
| 786 |
/* |
|---|
| 787 |
* config descriptors are also handcrafted. these must agree with code |
|---|
| 788 |
* that sets configurations, and with code managing interfaces and their |
|---|
| 789 |
* altsettings. other complexity may come from: |
|---|
| 790 |
* |
|---|
| 791 |
* - high speed support, including "other speed config" rules |
|---|
| 792 |
* - multiple configurations |
|---|
| 793 |
* - interfaces with alternate settings |
|---|
| 794 |
* - embedded class or vendor-specific descriptors |
|---|
| 795 |
* |
|---|
| 796 |
* this handles high speed, and has a second config that could as easily |
|---|
| 797 |
* have been an alternate interface setting (on most hardware). |
|---|
| 798 |
* |
|---|
| 799 |
* NOTE: to demonstrate (and test) more USB capabilities, this driver |
|---|
| 800 |
* should include an altsetting to test interrupt transfers, including |
|---|
| 801 |
* high bandwidth modes at high speed. (Maybe work like Intel's test |
|---|
| 802 |
* device?) |
|---|
| 803 |
*/ |
|---|
| 804 |
static int |
|---|
| 805 |
config_buf (struct usb_gadget *gadget, u8 *buf, u8 type, unsigned index) |
|---|
| 806 |
{ |
|---|
| 807 |
int len; |
|---|
| 808 |
const struct usb_descriptor_header **function; |
|---|
| 809 |
|
|---|
| 810 |
function = z_function; |
|---|
| 811 |
len = usb_gadget_config_buf (&z_config, buf, USB_BUFSIZ, function); |
|---|
| 812 |
if (len < 0) |
|---|
| 813 |
return len; |
|---|
| 814 |
((struct usb_config_descriptor *) buf)->bDescriptorType = type; |
|---|
| 815 |
return len; |
|---|
| 816 |
} |
|---|
| 817 |
|
|---|
| 818 |
/*-------------------------------------------------------------------------*/ |
|---|
| 819 |
|
|---|
| 820 |
static struct usb_request * |
|---|
| 821 |
alloc_ep_req (struct usb_ep *ep, unsigned length) |
|---|
| 822 |
{ |
|---|
| 823 |
struct usb_request *req; |
|---|
| 824 |
|
|---|
| 825 |
req = usb_ep_alloc_request (ep, GFP_ATOMIC); |
|---|
| 826 |
if (req) { |
|---|
| 827 |
req->length = length; |
|---|
| 828 |
req->buf = usb_ep_alloc_buffer (ep, length, |
|---|
| 829 |
&req->dma, GFP_ATOMIC); |
|---|
| 830 |
if (!req->buf) { |
|---|
| 831 |
usb_ep_free_request (ep, req); |
|---|
| 832 |
req = NULL; |
|---|
| 833 |
} |
|---|
| 834 |
} |
|---|
| 835 |
return req; |
|---|
| 836 |
} |
|---|
| 837 |
|
|---|
| 838 |
static void free_ep_req (struct usb_ep *ep, struct usb_request *req) |
|---|
| 839 |
{ |
|---|
| 840 |
if (req->buf) |
|---|
| 841 |
usb_ep_free_buffer (ep, req->buf, req->dma, req->length); |
|---|
| 842 |
usb_ep_free_request (ep, req); |
|---|
| 843 |
} |
|---|
| 844 |
|
|---|
| 845 |
/*-------------------------------------------------------------------------*/ |
|---|
| 846 |
|
|---|
| 847 |
/* optionally require specific source/sink data patterns */ |
|---|
| 848 |
|
|---|
| 849 |
static int |
|---|
| 850 |
check_read_data ( |
|---|
| 851 |
struct zero_dev *dev, |
|---|
| 852 |
struct usb_ep *ep, |
|---|
| 853 |
struct usb_request *req |
|---|
| 854 |
) |
|---|
| 855 |
{ |
|---|
| 856 |
unsigned i; |
|---|
| 857 |
u8 *buf = req->buf; |
|---|
| 858 |
|
|---|
| 859 |
for (i = 0; i < req->actual; i++, buf++) { |
|---|
| 860 |
switch (pattern) { |
|---|
| 861 |
/* all-zeroes has no synchronization issues */ |
|---|
| 862 |
case 0: |
|---|
| 863 |
if (*buf == 0) |
|---|
| 864 |
continue; |
|---|
| 865 |
break; |
|---|
| 866 |
/* mod63 stays in sync with short-terminated transfers, |
|---|
| 867 |
* or otherwise when host and gadget agree on how large |
|---|
| 868 |
* each usb transfer request should be. resync is done |
|---|
| 869 |
* with set_interface or set_config. |
|---|
| 870 |
*/ |
|---|
| 871 |
case 1: |
|---|
| 872 |
if (*buf == (u8)(i % 63)) |
|---|
| 873 |
continue; |
|---|
| 874 |
break; |
|---|
| 875 |
} |
|---|
| 876 |
ERROR (dev, "bad OUT byte, buf [%d] = %d\n", i, *buf); |
|---|
| 877 |
usb_ep_set_halt (ep); |
|---|
| 878 |
return -EINVAL; |
|---|
| 879 |
} |
|---|
| 880 |
return 0; |
|---|
| 881 |
} |
|---|
| 882 |
|
|---|
| 883 |
/*-------------------------------------------------------------------------*/ |
|---|
| 884 |
|
|---|
| 885 |
static void zero_reset_config (struct zero_dev *dev) |
|---|
| 886 |
{ |
|---|
| 887 |
if (dev->config == 0) |
|---|
| 888 |
return; |
|---|
| 889 |
|
|---|
| 890 |
DBG (dev, "reset config\n"); |
|---|
| 891 |
|
|---|
| 892 |
/* just disable endpoints, forcing completion of pending i/o. |
|---|
| 893 |
* all our completion handlers free their requests in this case. |
|---|
| 894 |
*/ |
|---|
| 895 |
if (dev->in_ep) { |
|---|
| 896 |
usb_ep_disable (dev->in_ep); |
|---|
| 897 |
dev->in_ep = NULL; |
|---|
| 898 |
} |
|---|
| 899 |
if (dev->out_ep) { |
|---|
| 900 |
usb_ep_disable (dev->out_ep); |
|---|
| 901 |
dev->out_ep = NULL; |
|---|
| 902 |
} |
|---|
| 903 |
dev->config = 0; |
|---|
| 904 |
del_timer (&dev->resume); |
|---|
| 905 |
} |
|---|
| 906 |
|
|---|
| 907 |
#define _write(f, buf, sz) (f->f_op->write(f, buf, sz, &f->f_pos)) |
|---|
| 908 |
|
|---|
| 909 |
static void |
|---|
| 910 |
zero_isoc_complete (struct usb_ep *ep, struct usb_request *req) |
|---|
| 911 |
{ |
|---|
| 912 |
struct zero_dev *dev = ep->driver_data; |
|---|
| 913 |
int status = req->status; |
|---|
| 914 |
int i, j; |
|---|
| 915 |
|
|---|
| 916 |
switch (status) { |
|---|
| 917 |
|
|---|
| 918 |
case 0: /* normal completion? */ |
|---|
| 919 |
//printk ("\nzero ---------------> isoc normal completion %d bytes\n", req->actual); |
|---|
| 920 |
for (i=0, j=rbuf_start; i<req->actual; i++) { |
|---|
| 921 |
//printk ("%02x ", ((__u8*)req->buf)[i]); |
|---|
| 922 |
rbuf[j] = ((__u8*)req->buf)[i]; |
|---|
| 923 |
j++; |
|---|
| 924 |
if (j >= RBUF_LEN) j=0; |
|---|
| 925 |
} |
|---|
| 926 |
rbuf_start = j; |
|---|
| 927 |
//printk ("\n\n"); |
|---|
| 928 |
|
|---|
| 929 |
if (rbuf_len < RBUF_LEN) { |
|---|
| 930 |
rbuf_len += req->actual; |
|---|
| 931 |
if (rbuf_len > RBUF_LEN) { |
|---|
| 932 |
rbuf_len = RBUF_LEN; |
|---|
| 933 |
} |
|---|
| 934 |
} |
|---|
| 935 |
|
|---|
| 936 |
break; |
|---|
| 937 |
|
|---|
| 938 |
/* this endpoint is normally active while we're configured */ |
|---|
| 939 |
case -ECONNABORTED: /* hardware forced ep reset */ |
|---|
| 940 |
case -ECONNRESET: /* request dequeued */ |
|---|
| 941 |
case -ESHUTDOWN: /* disconnect from host */ |
|---|
| 942 |
VDBG (dev, "%s gone (%d), %d/%d\n", ep->name, status, |
|---|
| 943 |
req->actual, req->length); |
|---|
| 944 |
if (ep == dev->out_ep) |
|---|
| 945 |
check_read_data (dev, ep, req); |
|---|
| 946 |
free_ep_req (ep, req); |
|---|
| 947 |
return; |
|---|
| 948 |
|
|---|
| 949 |
case -EOVERFLOW: /* buffer overrun on read means that |
|---|
| 950 |
* we didn't provide a big enough |
|---|
| 951 |
* buffer. |
|---|
| 952 |
*/ |
|---|
| 953 |
default: |
|---|
| 954 |
#if 1 |
|---|
| 955 |
DBG (dev, "%s complete --> %d, %d/%d\n", ep->name, |
|---|
| 956 |
status, req->actual, req->length); |
|---|
| 957 |
#endif |
|---|
| 958 |
case -EREMOTEIO: /* short read */ |
|---|
| 959 |
break; |
|---|
| 960 |
} |
|---|
| 961 |
|
|---|
| 962 |
status = usb_ep_queue (ep, req, GFP_ATOMIC); |
|---|
| 963 |
if (status) { |
|---|
| 964 |
ERROR (dev, "kill %s: resubmit %d bytes --> %d\n", |
|---|
| 965 |
ep->name, req->length, status); |
|---|
| 966 |
usb_ep_set_halt (ep); |
|---|
| 967 |
/* FIXME recover later ... somehow */ |
|---|
| 968 |
} |
|---|
| 969 |
} |
|---|
| 970 |
|
|---|
| 971 |
static struct usb_request * |
|---|
| 972 |
zero_start_isoc_ep (struct usb_ep *ep, int gfp_flags) |
|---|
| 973 |
{ |
|---|
| 974 |
struct usb_request *req; |
|---|
| 975 |
int status; |
|---|
| 976 |
|
|---|
| 977 |
req = alloc_ep_req (ep, 512); |
|---|
| 978 |
if (!req) |
|---|
| 979 |
return NULL; |
|---|
| 980 |
|
|---|
| 981 |
req->complete = zero_isoc_complete; |
|---|
| 982 |
|
|---|
| 983 |
status = usb_ep_queue (ep, req, gfp_flags); |
|---|
| 984 |
if (status) { |
|---|
| 985 |
struct zero_dev *dev = ep->driver_data; |
|---|
| 986 |
|
|---|
| 987 |
ERROR (dev, "start %s --> %d\n", ep->name, status); |
|---|
| 988 |
free_ep_req (ep, req); |
|---|
| 989 |
req = NULL; |
|---|
| 990 |
} |
|---|
| 991 |
|
|---|
| 992 |
return req; |
|---|
| 993 |
} |
|---|
| 994 |
|
|---|
| 995 |
/* change our operational config. this code must agree with the code |
|---|
| 996 |
* that returns config descriptors, and altsetting code. |
|---|
| 997 |
* |
|---|
| 998 |
* it's also responsible for power management interactions. some |
|---|
| 999 |
* configurations might not work with our current power sources. |
|---|
| 1000 |
* |
|---|
| 1001 |
* note that some device controller hardware will constrain what this |
|---|
| 1002 |
* code can do, perhaps by disallowing more than one configuration or |
|---|
| 1003 |
* by limiting configuration choices (like the pxa2xx). |
|---|
| 1004 |
*/ |
|---|
| 1005 |
static int |
|---|
| 1006 |
zero_set_config (struct zero_dev *dev, unsigned number, int gfp_flags) |
|---|
| 1007 |
{ |
|---|
| 1008 |
int result = 0; |
|---|
| 1009 |
struct usb_gadget *gadget = dev->gadget; |
|---|
| 1010 |
const struct usb_endpoint_descriptor *d; |
|---|
| 1011 |
struct usb_ep *ep; |
|---|
| 1012 |
|
|---|
| 1013 |
if (number == dev->config) |
|---|
| 1014 |
return 0; |
|---|
| 1015 |
|
|---|
| 1016 |
zero_reset_config (dev); |
|---|
| 1017 |
|
|---|
| 1018 |
gadget_for_each_ep (ep, gadget) { |
|---|
| 1019 |
|
|---|
| 1020 |
if (strcmp (ep->name, "ep4") == 0) { |
|---|
| 1021 |
|
|---|
| 1022 |
d = (struct usb_endpoint_descripter *)&za_23; // isoc ep desc for audio i/f alt setting 6 |
|---|
| 1023 |
result = usb_ep_enable (ep, d); |
|---|
| 1024 |
|
|---|
| 1025 |
if (result == 0) { |
|---|
| 1026 |
ep->driver_data = dev; |
|---|
| 1027 |
dev->in_ep = ep; |
|---|
| 1028 |
|
|---|
| 1029 |
if (zero_start_isoc_ep (ep, gfp_flags) != 0) { |
|---|
| 1030 |
|
|---|
| 1031 |
dev->in_ep = ep; |
|---|
| 1032 |
continue; |
|---|
| 1033 |
} |
|---|
| 1034 |
|
|---|
| 1035 |
usb_ep_disable (ep); |
|---|
| 1036 |
result = -EIO; |
|---|
| 1037 |
} |
|---|
| 1038 |
} |
|---|
| 1039 |
|
|---|
| 1040 |
} |
|---|
| 1041 |
|
|---|
| 1042 |
dev->config = number; |
|---|
| 1043 |
return result; |
|---|
| 1044 |
} |
|---|
| 1045 |
|
|---|
| 1046 |
/*-------------------------------------------------------------------------*/ |
|---|
| 1047 |
|
|---|
| 1048 |
static void zero_setup_complete (struct usb_ep *ep, struct usb_request *req) |
|---|
| 1049 |
{ |
|---|
| 1050 |
if (req->status || req->actual != req->length) |
|---|
| 1051 |
DBG ((struct zero_dev *) ep->driver_data, |
|---|
| 1052 |
"setup complete --> %d, %d/%d\n", |
|---|
| 1053 |
req->status, req->actual, req->length); |
|---|
| 1054 |
} |
|---|
| 1055 |
|
|---|
| 1056 |
/* |
|---|
| 1057 |
* The setup() callback implements all the ep0 functionality that's |
|---|
| 1058 |
* not handled lower down, in hardware or the hardware driver (like |
|---|
| 1059 |
* device and endpoint feature flags, and their status). It's all |
|---|
| 1060 |
* housekeeping for the gadget function we're implementing. Most of |
|---|
| 1061 |
* the work is in config-specific setup. |
|---|
| 1062 |
*/ |
|---|
| 1063 |
static int |
|---|
| 1064 |
zero_setup (struct usb_gadget *gadget, const struct usb_ctrlrequest *ctrl) |
|---|
| 1065 |
{ |
|---|
| 1066 |
struct zero_dev *dev = get_gadget_data (gadget); |
|---|
| 1067 |
struct usb_request *req = dev->req; |
|---|
| 1068 |
int value = -EOPNOTSUPP; |
|---|
| 1069 |
|
|---|
| 1070 |
/* usually this stores reply data in the pre-allocated ep0 buffer, |
|---|
| 1071 |
* but config change events will reconfigure hardware. |
|---|
| 1072 |
*/ |
|---|
| 1073 |
req->zero = 0; |
|---|
| 1074 |
switch (ctrl->bRequest) { |
|---|
| 1075 |
|
|---|
| 1076 |
case USB_REQ_GET_DESCRIPTOR: |
|---|
| 1077 |
|
|---|
| 1078 |
switch (ctrl->wValue >> 8) { |
|---|
| 1079 |
|
|---|
| 1080 |
case USB_DT_DEVICE: |
|---|
| 1081 |
value = min (ctrl->wLength, (u16) sizeof device_desc); |
|---|
| 1082 |
memcpy (req->buf, &device_desc, value); |
|---|
| 1083 |
break; |
|---|
| 1084 |
#ifdef CONFIG_USB_GADGET_DUALSPEED |
|---|
| 1085 |
case USB_DT_DEVICE_QUALIFIER: |
|---|
| 1086 |
if (!gadget->is_dualspeed) |
|---|
| 1087 |
break; |
|---|
| 1088 |
value = min (ctrl->wLength, (u16) sizeof dev_qualifier); |
|---|
| 1089 |
memcpy (req->buf, &dev_qualifier, value); |
|---|
| 1090 |
break; |
|---|
| 1091 |
|
|---|
| 1092 |
case USB_DT_OTHER_SPEED_CONFIG: |
|---|
| 1093 |
if (!gadget->is_dualspeed) |
|---|
| 1094 |
break; |
|---|
| 1095 |
// FALLTHROUGH |
|---|
| 1096 |
#endif /* CONFIG_USB_GADGET_DUALSPEED */ |
|---|
| 1097 |
case USB_DT_CONFIG: |
|---|
| 1098 |
value = config_buf (gadget, req->buf, |
|---|
| 1099 |
ctrl->wValue >> 8, |
|---|
| 1100 |
ctrl->wValue & 0xff); |
|---|
| 1101 |
if (value >= 0) |
|---|
| 1102 |
value = min (ctrl->wLength, (u16) value); |
|---|
| 1103 |
break; |
|---|
| 1104 |
|
|---|
| 1105 |
case USB_DT_STRING: |
|---|
| 1106 |
/* wIndex == language code. |
|---|
| 1107 |
* this driver only handles one language, you can |
|---|
| 1108 |
* add string tables for other languages, using |
|---|
| 1109 |
* any UTF-8 characters |
|---|
| 1110 |
*/ |
|---|
| 1111 |
value = usb_gadget_get_string (&stringtab, |
|---|
| 1112 |
ctrl->wValue & 0xff, req->buf); |
|---|
| 1113 |
if (value >= 0) { |
|---|
| 1114 |
value = min (ctrl->wLength, (u16) value); |
|---|
| 1115 |
} |
|---|
| 1116 |
break; |
|---|
| 1117 |
} |
|---|
| 1118 |
break; |
|---|
| 1119 |
|
|---|
| 1120 |
/* currently two configs, two speeds */ |
|---|
| 1121 |
case USB_REQ_SET_CONFIGURATION: |
|---|
| 1122 |
if (ctrl->bRequestType != 0) |
|---|
| 1123 |
goto unknown; |
|---|
| 1124 |
|
|---|
| 1125 |
spin_lock (&dev->lock); |
|---|
| 1126 |
value = zero_set_config (dev, ctrl->wValue, GFP_ATOMIC); |
|---|
| 1127 |
spin_unlock (&dev->lock); |
|---|
| 1128 |
break; |
|---|
| 1129 |
case USB_REQ_GET_CONFIGURATION: |
|---|
| 1130 |
if (ctrl->bRequestType != USB_DIR_IN) |
|---|
| 1131 |
goto unknown; |
|---|
| 1132 |
*(u8 *)req->buf = dev->config; |
|---|
| 1133 |
value = min (ctrl->wLength, (u16) 1); |
|---|
| 1134 |
break; |
|---|
| 1135 |
|
|---|
| 1136 |
/* until we add altsetting support, or other interfaces, |
|---|
| 1137 |
* only 0/0 are possible. pxa2xx only supports 0/0 (poorly) |
|---|
| 1138 |
* and already killed pending endpoint I/O. |
|---|
| 1139 |
*/ |
|---|
| 1140 |
case USB_REQ_SET_INTERFACE: |
|---|
| 1141 |
|
|---|
| 1142 |
if (ctrl->bRequestType != USB_RECIP_INTERFACE) |
|---|
| 1143 |
goto unknown; |
|---|
| 1144 |
spin_lock (&dev->lock); |
|---|
| 1145 |
if (dev->config) { |
|---|
| 1146 |
u8 config = dev->config; |
|---|
| 1147 |
|
|---|
| 1148 |
/* resets interface configuration, forgets about |
|---|
| 1149 |
* previous transaction state (queued bufs, etc) |
|---|
| 1150 |
* and re-inits endpoint state (toggle etc) |
|---|
| 1151 |
* no response queued, just zero status == success. |
|---|
| 1152 |
* if we had more than one interface we couldn't |
|---|
| 1153 |
* use this "reset the config" shortcut. |
|---|
| 1154 |
*/ |
|---|
| 1155 |
zero_reset_config (dev); |
|---|
| 1156 |
zero_set_config (dev, config, GFP_ATOMIC); |
|---|
| 1157 |
value = 0; |
|---|
| 1158 |
} |
|---|
| 1159 |
spin_unlock (&dev->lock); |
|---|
| 1160 |
break; |
|---|
| 1161 |
case USB_REQ_GET_INTERFACE: |
|---|
| 1162 |
if ((ctrl->bRequestType == 0x21) && (ctrl->wIndex == 0x02)) { |
|---|
| 1163 |
value = ctrl->wLength; |
|---|
| 1164 |
break; |
|---|
| 1165 |
} |
|---|
| 1166 |
else { |
|---|
| 1167 |
if (ctrl->bRequestType != (USB_DIR_IN|USB_RECIP_INTERFACE)) |
|---|
| 1168 |
goto unknown; |
|---|
| 1169 |
if (!dev->config) |
|---|
| 1170 |
break; |
|---|
| 1171 |
if (ctrl->wIndex != 0) { |
|---|
| 1172 |
value = -EDOM; |
|---|
| 1173 |
break; |
|---|
| 1174 |
} |
|---|
| 1175 |
*(u8 *)req->buf = 0; |
|---|
| 1176 |
value = min (ctrl->wLength, (u16) 1); |
|---|
| 1177 |
} |
|---|
| 1178 |
break; |
|---|
| 1179 |
|
|---|
| 1180 |
/* |
|---|
| 1181 |
* These are the same vendor-specific requests supported by |
|---|
| 1182 |
* Intel's USB 2.0 compliance test devices. We exceed that |
|---|
| 1183 |
* device spec by allowing multiple-packet requests. |
|---|
| 1184 |
*/ |
|---|
| 1185 |
case 0x5b: /* control WRITE test -- fill the buffer */ |
|---|
| 1186 |
if (ctrl->bRequestType != (USB_DIR_OUT|USB_TYPE_VENDOR)) |
|---|
| 1187 |
goto unknown; |
|---|
| 1188 |
if (ctrl->wValue || ctrl->wIndex) |
|---|
| 1189 |
break; |
|---|
| 1190 |
/* just read that many bytes into the buffer */ |
|---|
| 1191 |
if (ctrl->wLength > USB_BUFSIZ) |
|---|
| 1192 |
break; |
|---|
| 1193 |
value = ctrl->wLength; |
|---|
| 1194 |
break; |
|---|
| 1195 |
case 0x5c: /* control READ test -- return the buffer */ |
|---|
| 1196 |
if (ctrl->bRequestType != (USB_DIR_IN|USB_TYPE_VENDOR)) |
|---|
| 1197 |
goto unknown; |
|---|
| 1198 |
if (ctrl->wValue || ctrl->wIndex) |
|---|
| 1199 |
break; |
|---|
| 1200 |
/* expect those bytes are still in the buffer; send back */ |
|---|
| 1201 |
if (ctrl->wLength > USB_BUFSIZ |
|---|
| 1202 |
|| ctrl->wLength != req->length) |
|---|
| 1203 |
break; |
|---|
| 1204 |
value = ctrl->wLength; |
|---|
| 1205 |
break; |
|---|
| 1206 |
|
|---|
| 1207 |
case 0x01: // SET_CUR |
|---|
| 1208 |
case 0x02: |
|---|
| 1209 |
case 0x03: |
|---|
| 1210 |
case 0x04: |
|---|
| 1211 |
case 0x05: |
|---|
| 1212 |
value = ctrl->wLength; |
|---|
| 1213 |
break; |
|---|
| 1214 |
case 0x81: |
|---|
| 1215 |
switch (ctrl->wValue) { |
|---|
| 1216 |
case 0x0201: |
|---|
| 1217 |
case 0x0202: |
|---|
| 1218 |
((u8*)req->buf)[0] = 0x00; |
|---|
| 1219 |
((u8*)req->buf)[1] = 0xe3; |
|---|
| 1220 |
break; |
|---|
| 1221 |
case 0x0300: |
|---|
| 1222 |
case 0x0500: |
|---|
| 1223 |
((u8*)req->buf)[0] = 0x00; |
|---|
| 1224 |
break; |
|---|
| 1225 |
} |
|---|
| 1226 |
//((u8*)req->buf)[0] = 0x81; |
|---|
| 1227 |
//((u8*)req->buf)[1] = 0x81; |
|---|
| 1228 |
value = ctrl->wLength; |
|---|
| 1229 |
break; |
|---|
| 1230 |
case 0x82: |
|---|
| 1231 |
switch (ctrl->wValue) { |
|---|
| 1232 |
case 0x0201: |
|---|
| 1233 |
case 0x0202: |
|---|
| 1234 |
((u8*)req->buf)[0] = 0x00; |
|---|
| 1235 |
((u8*)req->buf)[1] = 0xc3; |
|---|
| 1236 |
break; |
|---|
| 1237 |
case 0x0300: |
|---|
| 1238 |
case 0x0500: |
|---|
| 1239 |
((u8*)req->buf)[0] = 0x00; |
|---|
| 1240 |
break; |
|---|
| 1241 |
} |
|---|
| 1242 |
//((u8*)req->buf)[0] = 0x82; |
|---|
| 1243 |
//((u8*)req->buf)[1] = 0x82; |
|---|
| 1244 |
value = ctrl->wLength; |
|---|
| 1245 |
break; |
|---|
| 1246 |
case 0x83: |
|---|
| 1247 |
switch (ctrl->wValue) { |
|---|
| 1248 |
case 0x0201: |
|---|
| 1249 |
case 0x0202: |
|---|
| 1250 |
((u8*)req->buf)[0] = 0x00; |
|---|
| 1251 |
((u8*)req->buf)[1] = 0x00; |
|---|
| 1252 |
break; |
|---|
| 1253 |
case 0x0300: |
|---|
| 1254 |
((u8*)req->buf)[0] = 0x60; |
|---|
| 1255 |
break; |
|---|
| 1256 |
case 0x0500: |
|---|
| 1257 |
((u8*)req->buf)[0] = 0x18; |
|---|
| 1258 |
break; |
|---|
| 1259 |
} |
|---|
| 1260 |
//((u8*)req->buf)[0] = 0x83; |
|---|
| 1261 |
//((u8*)req->buf)[1] = 0x83; |
|---|
| 1262 |
value = ctrl->wLength; |
|---|
| 1263 |
break; |
|---|
| 1264 |
case 0x84: |
|---|
| 1265 |
switch (ctrl->wValue) { |
|---|
| 1266 |
case 0x0201: |
|---|
| 1267 |
case 0x0202: |
|---|
| 1268 |
((u8*)req->buf)[0] = 0x00; |
|---|
| 1269 |
((u8*)req->buf)[1] = 0x01; |
|---|
| 1270 |
break; |
|---|
| 1271 |
case 0x0300: |
|---|
| 1272 |
case 0x0500: |
|---|
| 1273 |
((u8*)req->buf)[0] = 0x08; |
|---|
| 1274 |
break; |
|---|
| 1275 |
} |
|---|
| 1276 |
//((u8*)req->buf)[0] = 0x84; |
|---|
| 1277 |
//((u8*)req->buf)[1] = 0x84; |
|---|
| 1278 |
value = ctrl->wLength; |
|---|
| 1279 |
break; |
|---|
| 1280 |
case 0x85: |
|---|
| 1281 |
((u8*)req->buf)[0] = 0x85; |
|---|
| 1282 |
((u8*)req->buf)[1] = 0x85; |
|---|
| 1283 |
value = ctrl->wLength; |
|---|
| 1284 |
break; |
|---|
| 1285 |
|
|---|
| 1286 |
|
|---|
| 1287 |
default: |
|---|
| 1288 |
unknown: |
|---|
| 1289 |
printk("unknown control req%02x.%02x v%04x i%04x l%d\n", |
|---|
| 1290 |
ctrl->bRequestType, ctrl->bRequest, |
|---|
| 1291 |
ctrl->wValue, ctrl->wIndex, ctrl->wLength); |
|---|
| 1292 |
} |
|---|
| 1293 |
|
|---|
| 1294 |
/* respond with data transfer before status phase? */ |
|---|
| 1295 |
if (value >= 0) { |
|---|
| 1296 |
req->length = value; |
|---|
| 1297 |
req->zero = value < ctrl->wLength |
|---|
| 1298 |
&& (value % gadget->ep0->maxpacket) == 0; |
|---|
| 1299 |
value = usb_ep_queue (gadget->ep0, req, GFP_ATOMIC); |
|---|
| 1300 |
if (value < 0) { |
|---|
| 1301 |
DBG (dev, "ep_queue < 0 --> %d\n", value); |
|---|
| 1302 |
req->status = 0; |
|---|
| 1303 |
zero_setup_complete (gadget->ep0, req); |
|---|
| 1304 |
} |
|---|
| 1305 |
} |
|---|
| 1306 |
|
|---|
| 1307 |
/* device either stalls (value < 0) or reports success */ |
|---|
| 1308 |
return value; |
|---|
| 1309 |
} |
|---|
| 1310 |
|
|---|
| 1311 |
static void |
|---|
| 1312 |
zero_disconnect (struct usb_gadget *gadget) |
|---|
| 1313 |
{ |
|---|
| 1314 |
struct zero_dev *dev = get_gadget_data (gadget); |
|---|
| 1315 |
unsigned long flags; |
|---|
| 1316 |
|
|---|
| 1317 |
spin_lock_irqsave (&dev->lock, flags); |
|---|
| 1318 |
zero_reset_config (dev); |
|---|
| 1319 |
|
|---|
| 1320 |
/* a more significant application might have some non-usb |
|---|
| 1321 |
* activities to quiesce here, saving resources like power |
|---|
| 1322 |
* or pushing the notification up a network stack. |
|---|
| 1323 |
*/ |
|---|
| 1324 |
spin_unlock_irqrestore (&dev->lock, flags); |
|---|
| 1325 |
|
|---|
| 1326 |
/* next we may get setup() calls to enumerate new connections; |
|---|
| 1327 |
* or an unbind() during shutdown (including removing module). |
|---|
| 1328 |
*/ |
|---|
| 1329 |
} |
|---|
| 1330 |
|
|---|
| 1331 |
static void |
|---|
| 1332 |
zero_autoresume (unsigned long _dev) |
|---|
| 1333 |
{ |
|---|
| 1334 |
struct zero_dev *dev = (struct zero_dev *) _dev; |
|---|
| 1335 |
int status; |
|---|
| 1336 |
|
|---|
| 1337 |
/* normally the host would be woken up for something |
|---|
| 1338 |
* more significant than just a timer firing... |
|---|
| 1339 |
*/ |
|---|
| 1340 |
if (dev->gadget->speed != USB_SPEED_UNKNOWN) { |
|---|
| 1341 |
status = usb_gadget_wakeup (dev->gadget); |
|---|
| 1342 |
DBG (dev, "wakeup --> %d\n", status); |
|---|
| 1343 |
} |
|---|
| 1344 |
} |
|---|
| 1345 |
|
|---|
| 1346 |
/*-------------------------------------------------------------------------*/ |
|---|
| 1347 |
|
|---|
| 1348 |
static void |
|---|
| 1349 |
zero_unbind (struct usb_gadget *gadget) |
|---|
| 1350 |
{ |
|---|
| 1351 |
struct zero_dev *dev = get_gadget_data (gadget); |
|---|
| 1352 |
|
|---|
| 1353 |
DBG (dev, "unbind\n"); |
|---|
| 1354 |
|
|---|
| 1355 |
/* we've already been disconnected ... no i/o is active */ |
|---|
| 1356 |
if (dev->req) |
|---|
| 1357 |
free_ep_req (gadget->ep0, dev->req); |
|---|
| 1358 |
del_timer_sync (&dev->resume); |
|---|
| 1359 |
kfree (dev); |
|---|
| 1360 |
set_gadget_data (gadget, NULL); |
|---|
| 1361 |
} |
|---|
| 1362 |
|
|---|
| 1363 |
static int |
|---|
| 1364 |
zero_bind (struct usb_gadget *gadget) |
|---|
| 1365 |
{ |
|---|
| 1366 |
struct zero_dev *dev; |
|---|
| 1367 |
//struct usb_ep *ep; |
|---|
| 1368 |
|
|---|
| 1369 |
printk("binding\n"); |
|---|
| 1370 |
/* |
|---|
| 1371 |
* DRIVER POLICY CHOICE: you may want to do this differently. |
|---|
| 1372 |
* One thing to avoid is reusing a bcdDevice revision code |
|---|
| 1373 |
* with different host-visible configurations or behavior |
|---|
| 1374 |
* restrictions -- using ep1in/ep2out vs ep1out/ep3in, etc |
|---|
| 1375 |
*/ |
|---|
| 1376 |
//device_desc.bcdDevice = __constant_cpu_to_le16 (0x0201); |
|---|
| 1377 |
|
|---|
| 1378 |
|
|---|
| 1379 |
/* ok, we made sense of the hardware ... */ |
|---|
| 1380 |
dev = kmalloc (sizeof *dev, SLAB_KERNEL); |
|---|
| 1381 |
if (!dev) |
|---|
| 1382 |
return -ENOMEM; |
|---|
| 1383 |
memset (dev, 0, sizeof *dev); |
|---|
| 1384 |
spin_lock_init (&dev->lock); |
|---|
| 1385 |
dev->gadget = gadget; |
|---|
| 1386 |
set_gadget_data (gadget, dev); |
|---|
| 1387 |
|
|---|
| 1388 |
/* preallocate control response and buffer */ |
|---|
| 1389 |
dev->req = usb_ep_alloc_request (gadget->ep0, GFP_KERNEL); |
|---|
| 1390 |
if (!dev->req) |
|---|
| 1391 |
goto enomem; |
|---|
| 1392 |
dev->req->buf = usb_ep_alloc_buffer (gadget->ep0, USB_BUFSIZ, |
|---|
| 1393 |
&dev->req->dma, GFP_KERNEL); |
|---|
| 1394 |
if (!dev->req->buf) |
|---|
| 1395 |
goto enomem; |
|---|
| 1396 |
|
|---|
| 1397 |
dev->req->complete = zero_setup_complete; |
|---|
| 1398 |
|
|---|
| 1399 |
device_desc.bMaxPacketSize0 = gadget->ep0->maxpacket; |
|---|
| 1400 |
|
|---|
| 1401 |
#ifdef CONFIG_USB_GADGET_DUALSPEED |
|---|
| 1402 |
/* assume ep0 uses the same value for both speeds ... */ |
|---|
| 1403 |
dev_qualifier.bMaxPacketSize0 = device_desc.bMaxPacketSize0; |
|---|
| 1404 |
|
|---|
| 1405 |
/* and that all endpoints are dual-speed */ |
|---|
| 1406 |
//hs_source_desc.bEndpointAddress = fs_source_desc.bEndpointAddress; |
|---|
| 1407 |
//hs_sink_desc.bEndpointAddress = fs_sink_desc.bEndpointAddress; |
|---|
| 1408 |
#endif |
|---|
| 1409 |
|
|---|
| 1410 |
usb_gadget_set_selfpowered (gadget); |
|---|
| 1411 |
|
|---|
| 1412 |
init_timer (&dev->resume); |
|---|
| 1413 |
dev->resume.function = zero_autoresume; |
|---|
| 1414 |
dev->resume.data = (unsigned long) dev; |
|---|
| 1415 |
|
|---|
| 1416 |
gadget->ep0->driver_data = dev; |
|---|
| 1417 |
|
|---|
| 1418 |
INFO (dev, "%s, version: " DRIVER_VERSION "\n", longname); |
|---|
| 1419 |
INFO (dev, "using %s, OUT %s IN %s\n", gadget->name, |
|---|
| 1420 |
EP_OUT_NAME, EP_IN_NAME); |
|---|
| 1421 |
|
|---|
| 1422 |
snprintf (manufacturer, sizeof manufacturer, |
|---|
| 1423 |
UTS_SYSNAME " " UTS_RELEASE " with %s", |
|---|
| 1424 |
gadget->name); |
|---|
| 1425 |
|
|---|
| 1426 |
return 0; |
|---|
| 1427 |
|
|---|
| 1428 |
enomem: |
|---|
| 1429 |
zero_unbind (gadget); |
|---|
| 1430 |
return -ENOMEM; |
|---|
| 1431 |
} |
|---|
| 1432 |
|
|---|
| 1433 |
/*-------------------------------------------------------------------------*/ |
|---|
| 1434 |
|
|---|
| 1435 |
static void |
|---|
| 1436 |
zero_suspend (struct usb_gadget *gadget) |
|---|
| 1437 |
{ |
|---|
| 1438 |
struct zero_dev *dev = get_gadget_data (gadget); |
|---|
| 1439 |
|
|---|
| 1440 |
if (gadget->speed == USB_SPEED_UNKNOWN) |
|---|
| 1441 |
return; |
|---|
| 1442 |
|
|---|
| 1443 |
if (autoresume) { |
|---|
| 1444 |
mod_timer (&dev->resume, jiffies + (HZ * autoresume)); |
|---|
| 1445 |
DBG (dev, "suspend, wakeup in %d seconds\n", autoresume); |
|---|
| 1446 |
} else |
|---|
| 1447 |
DBG (dev, "suspend\n"); |
|---|
| 1448 |
} |
|---|
| 1449 |
|
|---|
| 1450 |
static void |
|---|
| 1451 |
zero_resume (struct usb_gadget *gadget) |
|---|
| 1452 |
{ |
|---|
| 1453 |
struct zero_dev *dev = get_gadget_data (gadget); |
|---|
| 1454 |
|
|---|
| 1455 |
DBG (dev, "resume\n"); |
|---|
| 1456 |
del_timer (&dev->resume); |
|---|
| 1457 |
} |
|---|
| 1458 |
|
|---|
| 1459 |
|
|---|
| 1460 |
/*-------------------------------------------------------------------------*/ |
|---|
| 1461 |
|
|---|
| 1462 |
static struct usb_gadget_driver zero_driver = { |
|---|
| 1463 |
#ifdef CONFIG_USB_GADGET_DUALSPEED |
|---|
| 1464 |
.speed = USB_SPEED_HIGH, |
|---|
| 1465 |
#else |
|---|
| 1466 |
.speed = USB_SPEED_FULL, |
|---|
| 1467 |
#endif |
|---|
| 1468 |
.function = (char *) longname, |
|---|
| 1469 |
.bind = zero_bind, |
|---|
| 1470 |
.unbind = zero_unbind, |
|---|
| 1471 |
|
|---|
| 1472 |
.setup = zero_setup, |
|---|
| 1473 |
.disconnect = zero_disconnect, |
|---|
| 1474 |
|
|---|
| 1475 |
.suspend = zero_suspend, |
|---|
| 1476 |
.resume = zero_resume, |
|---|
| 1477 |
|
|---|
| 1478 |
.driver = { |
|---|
| 1479 |
.name = (char *) shortname, |
|---|
| 1480 |
// .shutdown = ... |
|---|
| 1481 |
// .suspend = ... |
|---|
| 1482 |
// .resume = ... |
|---|
| 1483 |
}, |
|---|
| 1484 |
}; |
|---|
| 1485 |
|
|---|
| 1486 |
MODULE_AUTHOR ("David Brownell"); |
|---|
| 1487 |
MODULE_LICENSE ("Dual BSD/GPL"); |
|---|
| 1488 |
|
|---|
| 1489 |
static struct proc_dir_entry *pdir, *pfile; |
|---|
| 1490 |
|
|---|
| 1491 |
static int isoc_read_data (char *page, char **start, |
|---|
| 1492 |
off_t off, int count, |
|---|
| 1493 |
int *eof, void *data) |
|---|
| 1494 |
{ |
|---|
| 1495 |
int i; |
|---|
| 1496 |
static int c = 0; |
|---|
| 1497 |
static int done = 0; |
|---|
| 1498 |
static int s = 0; |
|---|
| 1499 |
|
|---|
| 1500 |
/* |
|---|
| 1501 |
printk ("\ncount: %d\n", count); |
|---|
| 1502 |
printk ("rbuf_start: %d\n", rbuf_start); |
|---|
| 1503 |
printk ("rbuf_len: %d\n", rbuf_len); |
|---|
| 1504 |
printk ("off: %d\n", off); |
|---|
| 1505 |
printk ("start: %p\n\n", *start); |
|---|
| 1506 |
*/ |
|---|
| 1507 |
if (done) { |
|---|
| 1508 |
c = 0; |
|---|
| 1509 |
done = 0; |
|---|
| 1510 |
*eof = 1; |
|---|
| 1511 |
return 0; |
|---|
| 1512 |
} |
|---|
| 1513 |
|
|---|
| 1514 |
if (c == 0) { |
|---|
| 1515 |
if (rbuf_len == RBUF_LEN) |
|---|
| 1516 |
s = rbuf_start; |
|---|
| 1517 |
else s = 0; |
|---|
| 1518 |
} |
|---|
| 1519 |
|
|---|
| 1520 |
for (i=0; i<count && c<rbuf_len; i++, c++) { |
|---|
| 1521 |
page[i] = rbuf[(c+s) % RBUF_LEN]; |
|---|
| 1522 |
} |
|---|
| 1523 |
*start = page; |
|---|
| 1524 |
|
|---|
| 1525 |
if (c >= rbuf_len) { |
|---|
| 1526 |
*eof = 1; |
|---|
| 1527 |
done = 1; |
|---|
| 1528 |
} |
|---|
| 1529 |
|
|---|
| 1530 |
|
|---|
| 1531 |
return i; |
|---|
| 1532 |
} |
|---|
| 1533 |
|
|---|
| 1534 |
static int __init init (void) |
|---|
| 1535 |
{ |
|---|
| 1536 |
|
|---|
| 1537 |
int retval = 0; |
|---|
| 1538 |
|
|---|
| 1539 |
pdir = proc_mkdir("isoc_test", NULL); |
|---|
| 1540 |
if(pdir == NULL) { |
|---|
| 1541 |
retval = -ENOMEM; |
|---|
| 1542 |
printk("Error creating dir\n"); |
|---|
| 1543 |
goto done; |
|---|
| 1544 |
} |
|---|
| 1545 |
pdir->owner = THIS_MODULE; |
|---|
| 1546 |
|
|---|
| 1547 |
pfile = create_proc_read_entry("isoc_data", |
|---|
| 1548 |
0444, pdir, |
|---|
| 1549 |
isoc_read_data, |
|---|
| 1550 |
NULL); |
|---|
| 1551 |
if (pfile == NULL) { |
|---|
| 1552 |
retval = -ENOMEM; |
|---|
| 1553 |
printk("Error creating file\n"); |
|---|
| 1554 |
goto no_file; |
|---|
| 1555 |
} |
|---|
| 1556 |
pfile->owner = THIS_MODULE; |
|---|
| 1557 |
|
|---|
| 1558 |
return usb_gadget_register_driver (&zero_driver); |
|---|
| 1559 |
|
|---|
| 1560 |
no_file: |
|---|
| 1561 |
remove_proc_entry("isoc_data", NULL); |
|---|
| 1562 |
done: |
|---|
| 1563 |
return retval; |
|---|
| 1564 |
} |
|---|
| 1565 |
module_init (init); |
|---|
| 1566 |
|
|---|
| 1567 |
static void __exit cleanup (void) |
|---|
| 1568 |
{ |
|---|
| 1569 |
|
|---|
| 1570 |
usb_gadget_unregister_driver (&zero_driver); |
|---|
| 1571 |
|
|---|
| 1572 |
remove_proc_entry("isoc_data", pdir); |
|---|
| 1573 |
remove_proc_entry("isoc_test", NULL); |
|---|
| 1574 |
} |
|---|
| 1575 |
module_exit (cleanup); |
|---|