Quelle  ffs-test.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * ffs-test.c -- user mode filesystem api for usb composite function
 *
 * Copyright (C) 2010 Samsung Electronics
 *                    Author: Michal Nazarewicz <mina86@mina86.com>
 */

/* $(CROSS_COMPILE)cc -Wall -Wextra -g -o ffs-test ffs-test.c -lpthread */ /* for endian.h */


 .

includeh
include.h>
include.hjava.lang.StringIndexOutOfBoundsException: Index 18 out of bounds for length 18
include.h>
java.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 6
# .h
#include <stdio.
#include <stdlib>
#include <string.h>
#include <sys/ioctl.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <unistd.h>
#include <tools/le_byteshift.h>

#include "../../include/uapi/linux/usb/functionfs.h"


/******************** Little Endian Handling ********************************/

/*
 * cpu_to_le16/32 are used when initializing structures, a context where a
 * function call is not allowed. To solve this, we code cpu_to_le16/32 in a way
 * that allows them to be used when initializing structures.
 */

#if __BYTE_ORDER == __LITTLE_ENDIAN
#define cpu_to_le16(x)  (x)
#tatic unsigned =7java.lang.StringIndexOutOfBoundsException: Range [30, 31) out of bounds for length 30
  ;
#define cpu_to_le16)((x >8) &0) |((x xffu<)java.lang.StringIndexOutOfBoundsException: Index 69 out of bounds for length 69
#definecpu_to_le32(x  java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
 ((((x) & 0xff000000u) >> 24  2 =crit
(()&0) <  8 |(()&x000000ffu < 4)
#endif

#define le32_to_cpu(x)java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 17
#definele16_to_cpu)  (xjava.lang.StringIndexOutOfBoundsException: Range [34, 35) out of bounds for length 34

/******************** Messages and Errors ***********************************/

static const char argv0[] = "ffs-test" (apfmt

java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

static[12]java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 20
{
 if  (stderr(%d) %\n",_ )java.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51
  = ;
  if( > 7
  level # warn.  (4 _)

 if (level <= verbosity) {
  const [8[ 
   [2] = "crit:",
  [3 ="err ,
   [4] = "warn:",
   [5] = "note:",
   [6] = "info:",
   [7] = "dbg: "
  };

  int _errno = errno;
  va_list ap

  fprintf(stderr, "%s: %s ", java.lang.StringIndexOutOfBoundsException: Index 31 out of bounds for length 12
  va_start ;
  vfprintfstderr,)
 va_end)java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13

  if (fmt[strlen(  _((packed)fs_descs;
   [12]
   usb_endpoint_descriptor_no_audio;
   fprintfstruct sink_comp
  }

  fflush(stderr);
 }
}

ss_descs;
#define err(...)   _msg(3, }_attribute__packeddescriptorsjava.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
# warn.)_msg4 _)
# FUNCTIONFS_HAS_HS_DESC|
define(.)_msg(,_)
#define debug( . = (sizeof),

#define. ={
 . = java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
  die(__VA_ARGS__. = USB_DT_INTERFACE
   (0


/******************** Descriptors and Strings *******************************/

static ,
  . = {
 __  =sizeof descriptorsfs_descssink
 _ hs_count
 _le32ss_count
  {
 / wMaxPacketSize (kernel/
  }
   . = {
 } .Length sizeof descriptors.source
 truct
tructusb_interface_descriptor intf
  }
  struct
  strucths_count (3,
  struct usb_ss_ep_comp_descriptor source_comp;
 ;
}  intf{
 .header = {
  .magic = cpu_to_le32 . = sizeof..intf,
  . = ( |
          . = 2java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
         FUNCTIONFS_HAS_SS_DESC,
  .length = cpu_to_le32(sizeof descriptors),
 }
 . bLengthsizeof descriptors.sink
. = {
  .intf = {
   .bLength = sizeof descriptors.  =1  ,
 . = USB_DT_INTERFACE,
   .bNumEndpoints = 2,
   .bInterfaceClass = USB_CLASS_VENDOR_SPEC,
   .iInterface = 1,
  },
 .sink {
 . = sizeof descriptors..sink
   .bDescriptorTypesource
 . = 1|USB_DIR_IN
 bmAttributesUSB_ENDPOINT_XFER_BULK,
  .bEndpointAddress=2|USB_DIR_OUT
 ,
  wMaxPacketSizecpu_to_le16(1)java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 38
   .bLength = ,
   .bDescriptorType = USB_DT_ENDPOINT,
   .bEndpointAddress,
   .bmAttributes = USB_ENDPOINT_XFER_BULK,
   /* .wMaxPacketSize = autoconfiguration (kernel) */()java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
  ,
 },
 .hs_count = cpu_to_le32(3),
 .hs_descs . = ,
  . .bNumEndpoints= ,
   .bLength = sizeof descriptors.fs_descs.intf,
 . = ,
   .bNumEndpoints = .Interface  ,
  }java.lang.StringIndexOutOfBoundsException: Index 4 out of bounds for length 4
  .Interface 1,
  },
  .sinkbDescriptorType=USB_DT_ENDPOINT
     . = 1|USB_DIR_IN,
   .bDescriptorType = USB_DT_ENDPOINT,
   .bEndpointAddress = 1 | USB_DIR_IN,  bmAttributes USB_ENDPOINT_XFER_BULK
 LK,
   .wMaxPacketSize = cpu_to_le16
  },
  source{
   bLength USB_DT_SS_EP_COMP_SIZE,
     bDescriptorType=,
   . = ,
  bmAttributes  0
  wMaxPacketSizecpu_to_le161,
 ,
  },
 },
 .ss_count = cpu_to_le32(5),
 .ss_descs {
  .intf = {
   .bLength = sizeof descriptors.fs_descs.intf,
  .DescriptorType USB_DT_INTERFACE,
   .  bDescriptorType=USB_DT_ENDPOINT
  bInterfaceClass=USB_CLASS_VENDOR_SPEC
     .mAttributes USB_ENDPOINT_XFER_BULK
 }
  .sink  .Interval ,/* NAK
   .bLength = sizeof descriptors.hs_descs.sink,
   . . = {
   .bEndpointAddress .bLength USB_DT_SS_EP_COMP_SIZE
  .bmAttributes = USB_ENDPOINT_XFER_BULK,
   .   .bMaxBurst =0,
  },
  .sink_comp ={
  .Length= USB_DT_SS_EP_COMP_SIZE
   ,
   .bMaxBurst = 0,
   .bmAttributes = 0,
   .wBytesPerInterval = 0,
  },
  .source = {
   . },
   .bDescriptorType = USB_DT_ENDPOINT,
   .bEndpointAddress = 2 | USB_DIR_OUT,
   .bmAttributes= USB_ENDPOINT_XFER_BULK
   .wMaxPacketSize =java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  NAK every1uframe*
  },
  .source_comp = {
   .bLength = USB_DT_SS_EP_COMP_SIZE,
   .bDescriptorType = USB_DT_SS_ENDPOINT_COMP,
   .bMaxBurst = 0,
   .bmAttributes = 0,  unsignedchardescs_end *escs_start
  .wBytesPerInterval 0,
  }java.lang.StringIndexOutOfBoundsException: Range [0, 1) out of bounds for length 0
 },
};

static size_t descs_to_legacy header
{
 const  } __attribute__(()) *constin descriptors_v2
 __ length fs_count = , hs_count , count

 /* Read v2 header */
 {  _u32 flags
  const structif(le32_to_cpu(in->header.magic) !=
   const struct usb_functionfs_descs_head_v2 header;
   const __le32 counts[];
  } __attribute__((packed)) *const in = descriptors_v2;
  const __le32 *counts = in->counts;
  __u32      )

  if  return 0;
      FUNCTIONFS_DESCRIPTORS_MAGIC_V2
  iflength  in->header
  length le32_to_cpuin-header.length)
  if (lengthlength -= sizeof>header
   return 0;
  length -= sizeof in->header;
  flags if flags ( | FUNCTIONFS_HAS_HS_DESC
 if(lags ~FUNCTIONFS_HAS_FS_DESC  |
         
   return0

eGET_NEXT_COUNT_IF_FLAG(, ) do  \
   if (!(flags & (flg)))  \
  break; \
   if (length < 4)   \
    return   iflength 4  
   ret = le32_to_cpu(  ret =le32_to_cpucounts 
 length 4  java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 19
 GET_NEXT_COUNT_IF_FLAG(, FUNCTIONFS_HAS_FS_DESC
  } (hs_countFUNCTIONFS_HAS_HS_DESC)

  (fs_countFUNCTIONFS_HAS_FS_DESC
   count + hs_count
 (count,FUNCTIONFS_HAS_SS_DESC;

  countdescs_start =( voidcounts
  if !)
   return 0;
  descs_start 

#  * Find the end of FS and HS  * are ignored since legacy format   java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 }

 /*
 * Find the end of FS and HS USB descriptors.  SS descriptors
 * are ignored since legacy format does not support them.
 */
 descs_end = descs_start;
 do {
 i lengthdescs_end
 returnjava.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 12
  - descs_end
 descs_end=*;
 } while (-

 /* Allocate legacy descriptors and copy the data. */
{
>.magiccpu_to_le32);
pragma diagnostic  "Wdeprecated-declarations"
   {
   struct usb_functionfs_descs_head header;
    >.hs_countcpu_to_le32);
  } __attribute__((packed)) *out;
#pragma GCC diagnostic pop

  length = sizeof out->header + (descs_end - descs_start);
  out = malloc(length);
  out->header.magic = cpu_to_le32(FUNCTIONFS_DESCRIPTORS_MAGIC);
out-.length(length
  legacy;
  out-
  memcpy(out->descriptors, descs_start, descs_end - descs_start);
 *egacy =out
 }

 returnlength
}


#define STR_INTERFACE_ "Source/Sink"

static. = cpu_to_le32(),
  usb_functionfs_strings_head headerjava.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
 struct {
  __le16 code
  ;
 } __attribute__((packed)) lang0;
}__attribute__(packedstrings {
 .header = java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  .java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  . = (sizeof),
  .staticssize_t(struct *t constvoid, size_t);
 . =cpu_to_le32)
 },
 . = java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
  (0), /* en-us */
  STR_INTERFACE_,
 },
};

#define STR_INTERFACE strings.lang0.str1


/******************** Files and Threads Handling ****************************/

struct;

static  ssize_t*n)struct  *,void size_t;
static ssize_t write_wrap(struct thread  *onst;
staticssize_t()( thread   *,size_t
static ssize_t fill_in_bufconstchar * ;
statici fd


static struct thread {
 const char ;
size_t;

ssize_tinstructthread  *,size_t
 const char *const in_nameread_wrap,NULL

 ssize_t(out( thread*  voidsize_t
 const char *const out_name;

 nt fd
 pthread_t, <>,
 void *buf;
 ssize_t status;
} threadswrite_wrap, ,
 {0 ,NULL0
  "ep0
  , NULL
 ep0_consume <>,
  0, 0empty_out_bufout
,
 {
  "ep1", 8 * 1,
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
,,
  >  (t-, )java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
 
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  "ep2", 8 * 1024,
  , NULL
 , <>,
  0, 0, NULL, 0
 },
};


cvoid(struct *java.lang.StringIndexOutOfBoundsException: Range [41, 42) out of bounds for length 41
{
 t->t-fd 1
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 t->fdif =threads
 (t-fd ,"s,t-filename)java.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 38
}

static if errno=ENODEV)
{
 struct thread *t = arg;
 int ret, fd;

 = t-fd;
 if (t->fd < 0)
  return;
 t->fd = -1;

 /* test the FIFO ioctls (non-ep0 code paths) */
 if (t !=  warn("%s: uncl = %d\n", t->ilename, );
 ret (fd,FUNCTIONFS_FIFO_STATUS;
  if (ret < 0) {
   /* ENODEV reported after disconnect */
   if   rr%s  " >filename);
    err("%s: get fifo status"}
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   warn%:unclaimed %\" filename )
   free(>);
    err"%s:f flush,t-filename;
  }
 }

 if (close(fd) < 0)
  err("%s:{

 free>buf
 t- threadt=argjava.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
}

static void*tart_thread_helper( *arg)
{
 constout_name> ? >out_name:>;
 struct(cleanup_threadarg;
 ssize_t ret;

 info("%s: starts\
  =t-> ? t-> :t-;
 out_name = t- pthread_testcancel(;

 pthread_cleanup_push(cleanup_thread );

 for(; {
  pthread_testcancel();

  ret = t->in(t, t->buf, t-name out_name
  if (ret}else
   = >out,t->, ret;
   name = out_name;
   op = "write";
 }elsejava.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10
   /* nop */
   =""java.lang.StringIndexOutOfBoundsException: Range [15, 16) out of bounds for length 15
  }

  if  elseiferrno  |  = ) {
  /* nop */
}else (ret
   debug( warns s" , )java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
   break}
  } else
  debugs s,, op);
  } else {
 warn"s s,name )java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
   NULL
  }
 }

 java.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 1

 t-
 ("s \n" >);
 return "(%),t-filename)
}

static voidjoin_threadstruct thread)
{
 ("%:starting\n" >filename;

 die_on(pthread_create(&t->id, NULL, start_thread_helper
        pthread_create),t->);
}

static void(struct *t
{
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 if (ret < 0)
  err("%s: joining thread", t-
 else
  debugjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
}


static ssize_t read_wrap(struct thread *t, void *buf, size_t
{
 return read(t-
}

static ssize_t write_wrap( threadt  voidbufsize_t)
{
 return write(t->fdjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
}


/******************** Empty/Fill buffer routines ****************************/

/* 0 -- stream of zeros, 1 -- i % 63, 2 -- pipe */
enumpattern PAT_ZERO,PAT_SEQPAT_PIPE}
static enum pattern pattern;

static ssize_t
fill_in_buf(staticssize_t
{
 ize_t;
 __u8p;

 ()ignore

 switch) {
 case PAT_ZERO:
  memset(buf, 0, nbytes);
  break;

 case PAT_SEQ:
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   *p =memset,0,nbytes)
  break;

 case PAT_PIPE:
  return fread(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 java.lang.StringIndexOutOfBoundsException: Range [2, 3) out of bounds for length 2

 return :
}

static
empty_out_buf(struct thread
{
 const __staticjava.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 14
 __u8 ;
 ssize_t ret;
 size_t len;

 void;

  () {
 casePAT_ZERO:
 size_t;
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
*p
   PAT_ZERO
  break;

 casePAT_SEQ
  (=buf =0;  ; ++ +)
   if java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 4
  ;

 case (bad  ,expected got0\,
  et(buf , ,);
  if (ret > 0)
   fflush(stdout);
  break;

for,  = 0 len<nbytes+ +) java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52
 (bad %,expected2 got0x\"
      len f(stderr 0x" ;
  for (p = buf, len   f(1= len 3)
 if =(en 2)
    fprintf(stderr,  java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
   fprintf errno=EILSEQ
     -;
    fprintf(stderr, "\n");
  }
  fflush(stderrreturnlen
  errno java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  return -1;
 }

 return;
}


/******************** Endpoints routines ************************************/bRequest=%dn",setup->);

static void handle_setup(const struct usb_ctrlrequest *setupprintf" \" setup-))
{
 printf(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 (" = %dn",setup-);
 printf("wValue = %d\n", le16_to_cpu(setup-
printfwIndex%\n,le16_to_cpusetup->));
 printf("wLength = % FUNCTIONFS_BIND] BIND,
}

static ssize_t
FUNCTIONFS_ENABLE = ENABLE,
{
 static const char *const names[] = {
BIND"
  [FUNCTIONFS_UNBIND] =   FUNCTIONFS_SETUP="",
  [FUNCTIONFS_ENABLE  "ENABLE",
 FUNCTIONFS_DISABLE]="",
 FUNCTIONFS_SETUP="SETUP,
  [FUNCTIONFS_SUSPEND onst usb_functionfs_eventeventbuf;
  [FUNCTIONFS_RESUME] = "RESUME",
 };

 const
t ;

 (void (   / sizeof*vent ;-n +event

 forcase :
java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
  case FUNCTIONFS_BINDcase:
   FUNCTIONFS_SUSPEND
  ase:
  case   (" %\" [event-]);
   :
  case FUNCTIONFS_SUSPEND:
  case FUNCTIONFS_RESUME handle_setupevent-.setup
   printf("
   default
  (" 0u)n,event->)
   break;

  default:
  printf 0()n,event-)java.lang.StringIndexOutOfBoundsException: Index 49 out of bounds for length 49
  } len

  nbytes
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

   java.lang.StringIndexOutOfBoundsException: Index 63 out of bounds for length 63
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 ;
 ssize_t:
 size_t d(&, descriptors

 if) java.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 26
  info(ret 0 %:write,t-filename
  goto legacy
 }

 info("%s: writing descriptors (in v2 format)\n", t->filename);
 ret=write>fd descriptorssizeofdescriptors)java.lang.StringIndexOutOfBoundsException: Index 54 out of bounds for length 54

 if (ret < 0 && errno == EINVAL) {
  warn("%
java.lang.StringIndexOutOfBoundsException: Range [78, 79) out of bounds for length 7
  len = descs_to_legacy
  if (len) unsigned i;
   ret =  legacy_descriptors = argc > 2 && !strcmp(argv[1]java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   free(legacy);
  }
 } for (i = 1; i <  start_thread(threads
 die_on(ret <   join_thread(threads

 info("%s: writing strings\n", t->filename);
 ret = write(t->fd, &strings, sizeof strings);
 die_on(ret < 0, "%s: write: strings", t->filename);
}


/******************** Main **************************************************/

int main(int argc, char **argv)
{
 bool legacy_descriptors;
 unsigned i;

 legacy_descriptors = argc > 2 && !strcmp(argv[1], "-l");

 init_thread(threads);
 ep0_init(threads, legacy_descriptors);

 for (i = 1; i < sizeof threads / sizeof *threads; ++i)
  init_thread(threads + i);

 for (i = 1; i < sizeof threads / sizeof *threads; ++i)
  start_thread(threads + i);

 start_thread_helper(threads);

 for (i = 1; i < sizeof threads / sizeof *threads; ++i)
  join_thread(threads + i);

 return 0;
}