Re: [PATCH 5/5 v5] usb:gadget: Add SuperSpeed support to the Gadget Framework

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



* Tatyana Brokhman | 2011-03-23 10:04:57 [+0200]:

>This patch adds the SuperSpeed functionality to the gadget framework.
>In order not to force all the gadget drivers to supply SuperSpeed
>descriptors when operating in SuperSpeed mode the following approach was
>taken:
>If we're operating in SuperSpeed mode and the gadget driver didn't supply
>SuperSpeed descriptors, the composite layer will automatically create
>SuperSpeed descriptors with default values.
>Support for new SuperSpeed BOS descriptor was added.
>Support for SET_FEATURE and GET_STATUS requests in SuperSpeed mode was
>added.
>
>Signed-off-by: Tatyana Brokhman <tlinder@xxxxxxxxxxxxxx>
>
>diff --git a/drivers/usb/gadget/Kconfig b/drivers/usb/gadget/Kconfig
>index bc5123c..b4130bc 100644
>--- a/drivers/usb/gadget/Kconfig
>+++ b/drivers/usb/gadget/Kconfig
>@@ -605,6 +605,18 @@ config USB_GADGET_DUALSPEED
> 	  Means that gadget drivers should include extra descriptors
> 	  and code to handle dual-speed controllers.
> 
>+config USB_GADGET_SUPERSPEED
>+	boolean "Gadget operating in Super Speed"
>+	depends on USB_GADGET
>+	depends on USB_GADGET_DUALSPEED
>+	default n
n is default. No need to set this.

>+	help
>+	  Enabling this feature enables Super Speed support in the Gadget
>+	  driver. It means that gadget drivers should provide extra (SuperSpeed)
>+	  descriptors to the host.
>+	  For composite devices: if SuperSpeed descriptors weren't supplied by
>+	  the FD, they will be automatically generated with default values.
>+
> #
> # USB Gadget Drivers
> #
>diff --git a/drivers/usb/gadget/composite.c b/drivers/usb/gadget/composite.c
>index fb7e488..d5fe1c2 100644
>--- a/drivers/usb/gadget/composite.c
>+++ b/drivers/usb/gadget/composite.c
>@@ -73,6 +73,123 @@ MODULE_PARM_DESC(iSerialNumber, "SerialNumber string");
> 
> static char composite_manufacturer[50];
> 
>+/* Default endpoint companion descriptor */
>+static struct usb_ss_ep_comp_descriptor default_ep_comp_desc = {
>+		.bDescriptorType = USB_DT_SS_ENDPOINT_COMP,
>+		.bLength = 0x06,
sizeof() ?

>+		.bMaxBurst = 0, /* the default is we don't support bursting */
>+		.bmAttributes = 0, /* 2^0 streams supported */
>+		.wBytesPerInterval = 0,
It is already 0 :) It makes sense to set to 0 if you want to point out
something specific.

>+};
>+
>+/**
>+ * create_ss_descriptors() - Generate SuperSpeed descriptors
>+ * with default values
>+ * @f: pointer to usb_function to generate the descriptors for
>+ *
>+ * This function receives a pointer to usb_function and adds
>+ * missing super speed descriptors in the ss_descriptor field
>+ * according to its hs_descriptors field.
>+ *
>+ * This function copies f->hs_descriptors while updating the
>+ * endpoint descriptor and adding endpoint companion descriptor.
>+ */
>+static void create_ss_descriptors(struct usb_function *f)
>+{
>+	unsigned bytes;		/* number of bytes to allocate */
>+	unsigned n_desc;	/* number of descriptors */
>+	void *mem;		/* allocated memory to copy to */
We don't put comments at the end. Here I think you should remove them
since the variable name should be enough.

>+	struct usb_descriptor_header **tmp;
>+	struct usb_endpoint_descriptor	*ep_desc ;
>+	struct usb_ss_ep_comp_descriptor *ep_comp_desc;
>+	struct usb_descriptor_header **src = f->hs_descriptors;

It is better to read if you but the long types on top.

>+
>+	if (!f->hs_descriptors)
>+		return;
>+
>+	/*
>+	 * Count number of EPs (in order to know how many SS_EP_COMPANION
>+	 * descriptors to add), the total number of descriptors and the sum of
>+	 * each descriptor bLength field in order to know how much memory to
>+	 * allocate.
>+	 */
>+	for (bytes = 0, n_desc = 0, tmp = src; *tmp; tmp++, n_desc++) {
>+		if ((*tmp)->bDescriptorType == USB_DT_ENDPOINT) {
>+			bytes += default_ep_comp_desc.bLength;
>+			n_desc++;
>+		}
>+		bytes += (*tmp)->bLength;
>+	}
>+
>+	bytes += (n_desc + 1) * sizeof(*tmp);
>+	mem = kmalloc(bytes, GFP_KERNEL);
>+	if (!mem)
>+		return;
>+
>+	/*
>+	 * Fill in pointers starting at "tmp", to descriptors copied starting
>+	 * at "mem" and return "ret"
>+	 */
>+	tmp = mem;
>+	f->ss_descriptors  = mem;
>+	mem += (n_desc + 1) * sizeof(*tmp);
>+	while (*src) {
>+		/* Copy the original descriptor */
>+		memcpy(mem, *src, (*src)->bLength);
>+		switch ((*src)->bDescriptorType) {
>+		case USB_DT_ENDPOINT:
>+			/* update ep descriptor */
>+			ep_desc = (struct usb_endpoint_descriptor *)mem;
>+			switch (ep_desc->bmAttributes &
>+				USB_ENDPOINT_XFERTYPE_MASK) {
>+			case USB_ENDPOINT_XFER_CONTROL:
>+				ep_desc->wMaxPacketSize = cpu_to_le16(512);
>+				ep_desc->bInterval = 0;
>+				break;
>+			case USB_ENDPOINT_XFER_BULK:
>+				ep_desc->wMaxPacketSize = cpu_to_le16(1024);
>+				ep_desc->bInterval = 0;
>+				break;
>+			case USB_ENDPOINT_XFER_INT:
>+			case USB_ENDPOINT_XFER_ISOC:
>+				break;
>+			}
>+			*tmp = mem;
>+			tmp++;
>+			mem += (*src)->bLength;
>+			/* add ep companion descriptor */
>+			memcpy(mem, &default_ep_comp_desc,
>+			       default_ep_comp_desc.bLength);
>+			*tmp = mem;
>+			tmp++;
>+			/* Update wBytesPerInterval for periodic endpoints */
>+			ep_comp_desc = (struct usb_ss_ep_comp_descriptor *)mem;

mem is void so that cast is not required.

>+			switch (ep_desc->bmAttributes &
>+				USB_ENDPOINT_XFERTYPE_MASK) {
>+			case USB_ENDPOINT_XFER_INT:
>+			case USB_ENDPOINT_XFER_ISOC:
>+				ep_comp_desc->wBytesPerInterval =
>+					ep_desc->wMaxPacketSize;
>+				break;
>+			}
>+			mem += default_ep_comp_desc.bLength;
>+			break;
>+		default:
>+			*tmp = mem;
>+			tmp++;
>+			mem += (*src)->bLength;
>+			break;
>+		}
>+		src++;
>+	}
>+	/*
>+	 * The last (struct usb_descriptor_header *) in the descriptors
>+	 * vector is NULL
>+	 */
>+	*tmp = NULL;
>+	f->ss_desc_allocated = true;
>+}
>+
> /*-------------------------------------------------------------------------*/
> /**
>  * next_ep_desc() - advance to the next EP descriptor
>@@ -118,6 +235,9 @@ int config_ep_by_speed(struct usb_gadget *g,
> 	struct usb_endpoint_descriptor *chosen_desc = NULL;
> 	struct usb_descriptor_header **speed_desc = NULL;
> 
>+	struct usb_ss_ep_comp_descriptor *comp_desc = NULL;
>+	int want_comp_desc = 0;
>+
> 	struct usb_descriptor_header **d_spd; /* cursor for speed desc */
> 
> 	if (!g || !f || !_ep)
>@@ -125,6 +245,13 @@ int config_ep_by_speed(struct usb_gadget *g,
> 
> 	/* select desired speed */
> 	switch (g->speed) {
>+	case USB_SPEED_SUPER:
>+		if (gadget_is_superspeed(g)) {
>+			speed_desc = f->ss_descriptors;
>+			want_comp_desc = 1;
>+			break;
>+		}
>+		/* else: Fall trough */
> 	case USB_SPEED_HIGH:
> 		if (gadget_is_dualspeed(g)) {
> 			speed_desc = f->hs_descriptors;
>@@ -147,7 +274,31 @@ ep_found:
> 	/* commit results */
> 	_ep->maxpacket = le16_to_cpu(chosen_desc->wMaxPacketSize);
> 	_ep->desc = chosen_desc;
>-
>+	_ep->comp_desc = NULL;
>+	_ep->maxburst = 0;
>+	_ep->mult = 0;
>+	if (want_comp_desc) {
>+		/*
>+		 * Companion descriptor should follow EP descriptor
>+		 * USB 3.0 spec, #9.6.7
>+		 */
>+		comp_desc = (struct usb_ss_ep_comp_descriptor *)*(++d_spd);
>+		if (!comp_desc ||
>+		    (comp_desc->bDescriptorType != USB_DT_SS_ENDPOINT_COMP))
>+			return -EIO;
>+		_ep->comp_desc = comp_desc;
>+		if (g->speed == USB_SPEED_SUPER) {
>+			int xfer_type = _ep->bEndpointAddress &
>+				USB_ENDPOINT_XFERTYPE_MASK ;
>+			if (xfer_type == USB_ENDPOINT_XFER_BULK)
>+				_ep->maxburst = comp_desc->bMaxBurst;
>+			else if (xfer_type == USB_ENDPOINT_XFER_INT)
>+				_ep->maxburst = comp_desc->bMaxBurst;
>+			else if (xfer_type == USB_ENDPOINT_XFER_ISOC)
>+				/* mult: bits 1:0 of bmAttributes */
>+				_ep->mult = comp_desc->bmAttributes & 0x3;
>+		}
>+	}
> 	return 0;
> }
> 
>@@ -187,6 +338,14 @@ int usb_add_function(struct usb_configuration *config,
> 			list_del(&function->list);
> 			function->config = NULL;
> 		}
>+		/*
>+		 * Add SS descriptors if there are any. This has to be done
>+		 * after the bind since we need the hs_descriptors to be set in
>+		 * usb_function and some of the FDs does it in the bind.
>+		 */
>+		if ((gadget_is_superspeed(config->cdev->gadget)) &&
>+		    (!function->ss_not_capable) && (!function->ss_descriptors))
>+			create_ss_descriptors(function);
> 	} else
> 		value = 0;
> 
>@@ -199,6 +358,8 @@ int usb_add_function(struct usb_configuration *config,
> 		config->fullspeed = true;
> 	if (!config->highspeed && function->hs_descriptors)
> 		config->highspeed = true;
>+	if (!config->superspeed && function->ss_descriptors)
>+		config->superspeed = true;
> 
> done:
> 	if (value)
>@@ -342,7 +503,9 @@ static int config_buf(struct usb_configuration *config,
> 	list_for_each_entry(f, &config->functions, list) {
> 		struct usb_descriptor_header **descriptors;
> 
>-		if (speed == USB_SPEED_HIGH)
>+		if (speed == USB_SPEED_SUPER)
>+			descriptors = f->ss_descriptors;
>+		else if (speed == USB_SPEED_HIGH)
> 			descriptors = f->hs_descriptors;
> 		else
> 			descriptors = f->descriptors;
>@@ -368,9 +531,10 @@ static int config_desc(struct usb_composite_dev *cdev, unsigned w_value)
> 	u8				type = w_value >> 8;
> 	enum usb_device_speed		speed = USB_SPEED_UNKNOWN;
> 
>-	if (gadget_is_dualspeed(gadget)) {
>-		int			hs = 0;
>-
>+	if (gadget->speed == USB_SPEED_SUPER)
>+		speed = gadget->speed;
>+	else if (gadget_is_dualspeed(gadget)) {
>+		int	hs = 0;
> 		if (gadget->speed == USB_SPEED_HIGH)
> 			hs = 1;
> 		if (type == USB_DT_OTHER_SPEED_CONFIG)
>@@ -384,7 +548,10 @@ static int config_desc(struct usb_composite_dev *cdev, unsigned w_value)
> 	w_value &= 0xff;
> 	list_for_each_entry(c, &cdev->configs, list) {
> 		/* ignore configs that won't work at this speed */
>-		if (speed == USB_SPEED_HIGH) {
>+		if (speed == USB_SPEED_SUPER) {
>+			if (!c->superspeed)
>+				continue;
>+		} else if (speed == USB_SPEED_HIGH) {
> 			if (!c->highspeed)
> 				continue;
> 		} else {
>@@ -404,16 +571,22 @@ static int count_configs(struct usb_composite_dev *cdev, unsigned type)
> 	struct usb_configuration	*c;
> 	unsigned			count = 0;
> 	int				hs = 0;
>+	int				ss = 0;
> 
> 	if (gadget_is_dualspeed(gadget)) {
> 		if (gadget->speed == USB_SPEED_HIGH)
> 			hs = 1;
>+		if (gadget->speed == USB_SPEED_SUPER)
>+			ss = 1;
> 		if (type == USB_DT_DEVICE_QUALIFIER)
> 			hs = !hs;
> 	}
> 	list_for_each_entry(c, &cdev->configs, list) {
> 		/* ignore configs that won't work at this speed */
>-		if (hs) {
>+		if (ss) {
>+			if (!c->superspeed)
>+				continue;
>+		} else if (hs) {
> 			if (!c->highspeed)
> 				continue;
> 		} else {
>@@ -425,6 +598,73 @@ static int count_configs(struct usb_composite_dev *cdev, unsigned type)
> 	return count;
> }
> 
>+/**
>+ * bos() - prepares the BOS descriptor.
>+ * @cdev: pointer to usb_composite device to generate the bos
>+ *	descriptor for
>+ *
>+ * This function generates the BOS (Binary Device Object)
>+ * descriptor and its device capabilities descriptors. The BOS
>+ * descriptor should be supported by a SuperSpeed device.
>+ */
>+static int bos(struct usb_composite_dev *cdev)
>+{
>+	struct usb_bos_descriptor	*bos = cdev->req->buf;
>+	struct usb_ext_cap_descriptor	*usb_ext = NULL;
>+	struct usb_ss_cap_descriptor	*ss_cap = NULL;
no need to NULL init. Please put the longer types before the short ones.

>+
>+	struct usb_dcd_config_params	dcd_config_params;
>+
>+	bos->bLength = USB_DT_BOS_SIZE;
>+	bos->bDescriptorType = USB_DT_BOS;
>+
>+	bos->wTotalLength = USB_DT_BOS_SIZE;
cpu_to_le16(USB_DT_BOS_SIZE);

>+	bos->bNumDeviceCaps = 0;
>+
>+	/*
>+	 * A SuperSpeed device shall include the USB2.0 extension descriptor
>+	 * and shall support LPM when operating in USB2.0 HS mode.
>+	 */
>+	usb_ext = (struct usb_ext_cap_descriptor *)
>+			(cdev->req->buf+bos->wTotalLength);

please run checkpatch.

>+	bos->bNumDeviceCaps++;
>+	bos->wTotalLength += USB_DT_USB_EXT_CAP_SIZE;
wTotalLength is __le16. Take a look at le16_add_cpu().

>+	usb_ext->bLength = USB_DT_USB_EXT_CAP_SIZE;
>+	usb_ext->bDescriptorType = USB_DT_DEVICE_CAPABILITY;
>+	usb_ext->bDevCapabilityType = USB_CAP_TYPE_EXT;
>+	usb_ext->bmAttributes = USB_LPM_SUPPORT;
__le32

>+
>+	/*
>+	 * The Superspeed USB Capability descriptor shall be implemented by all
>+	 * SuperSpeed devices.
>+	 */
>+	ss_cap = (struct usb_ss_cap_descriptor *)
>+		(cdev->req->buf+bos->wTotalLength);
>+	bos->bNumDeviceCaps++;
>+	bos->wTotalLength += USB_DT_USB_SS_CAP_SIZE;

le16_add_cpu()

>+	ss_cap->bLength = USB_DT_USB_SS_CAP_SIZE;
>+	ss_cap->bDescriptorType = USB_DT_DEVICE_CAPABILITY;
>+	ss_cap->bDevCapabilityType = USB_SS_CAP_TYPE;
>+	ss_cap->bmAttributes = 0; /* LTM is not supported yet */

Who's fault is it? Isn't this always supported by the SS-udc?

>+	ss_cap->wSpeedSupported = USB_LOW_SPEED_OPERATION |
>+				USB_FULL_SPEED_OPERATION |
>+				USB_HIGH_SPEED_OPERATION |
>+				USB_5GBPS_OPERATION;
__le16

>+	ss_cap->bFunctionalitySupport = USB_LOW_SPEED_OPERATION;
>+
>+	/* Get Controller configuration */
>+	if (cdev->gadget->ops->get_config_params)
>+		cdev->gadget->ops->get_config_params(&dcd_config_params);
>+	else {
>+		dcd_config_params.bU1devExitLat = USB_DEFULT_U1_DEV_EXIT_LAT;
>+		dcd_config_params.bU2DevExitLat = USB_DEFULT_U2_DEV_EXIT_LAT;

I guess this is __le16

>+	}
>+	ss_cap->bU1devExitLat = dcd_config_params.bU1devExitLat;
>+	ss_cap->bU2DevExitLat = dcd_config_params.bU2DevExitLat;
and I am sure that one is.

>+
>+	return bos->wTotalLength;
>+}
>+
> static void device_qual(struct usb_composite_dev *cdev)
> {
> 	struct usb_qualifier_descriptor	*qual = cdev->req->buf;
>@@ -468,27 +708,42 @@ static int set_config(struct usb_composite_dev *cdev,
> 	unsigned		power = gadget_is_otg(gadget) ? 8 : 100;
> 	int			tmp;
> 
>-	if (cdev->config)
>-		reset_config(cdev);
>-
> 	if (number) {
> 		list_for_each_entry(c, &cdev->configs, list) {
> 			if (c->bConfigurationValue == number) {
>+				/*
>+				 * Need to disable the FDs of the previous
>+				 * configuration
>+				 */
>+				if (cdev->config)
>+					reset_config(cdev);
> 				result = 0;
> 				break;
> 			}
> 		}
> 		if (result < 0)
> 			goto done;
>-	} else
>+	} else { /* Zero configuration value - need to reset the config */
>+		if (cdev->config)
>+			reset_config(cdev);
> 		result = 0;
>+	}
> 
> 	INFO(cdev, "%s speed config #%d: %s\n",
> 		({ char *speed;
> 		switch (gadget->speed) {
>-		case USB_SPEED_LOW:	speed = "low"; break;
>-		case USB_SPEED_FULL:	speed = "full"; break;
>-		case USB_SPEED_HIGH:	speed = "high"; break;
>+		case USB_SPEED_LOW:
>+			speed = "low";
>+			break;
>+		case USB_SPEED_FULL:
>+			speed = "full";
>+			break;
>+		case USB_SPEED_HIGH:
>+			speed = "high";
>+			break;
>+		case USB_SPEED_SUPER:
>+			speed = "super";
>+			break;
> 		default:		speed = "?"; break;
> 		} ; speed; }), number, c ? c->label : "unconfigured");
> 
>@@ -511,7 +766,9 @@ static int set_config(struct usb_composite_dev *cdev,
> 		 * function's setup callback instead of the current
> 		 * configuration's setup callback.
> 		 */
>-		if (gadget->speed == USB_SPEED_HIGH)
>+		if (gadget->speed == USB_SPEED_SUPER)
>+			descriptors = f->ss_descriptors;
>+		else if (gadget->speed == USB_SPEED_HIGH)
> 			descriptors = f->hs_descriptors;
> 		else
> 			descriptors = f->descriptors;
>@@ -596,14 +853,14 @@ int usb_add_config(struct usb_composite_dev *cdev,
> 	} else {
> 		unsigned	i;
> 
>-		DBG(cdev, "cfg %d/%p speeds:%s%s\n",
>+		DBG(cdev, "cfg %d/%p speeds:%s%s%s\n",
> 			config->bConfigurationValue, config,
>+			config->superspeed ? " super" : "",
> 			config->highspeed ? " high" : "",
> 			config->fullspeed
> 				? (gadget_is_dualspeed(cdev->gadget)
> 					? " full"
>-					: " full/low")
>-				: "");
>+					: " full/low") : "");
> 
> 		for (i = 0; i < MAX_CONFIG_INTERFACES; i++) {
> 			struct usb_function	*f = config->interface[i];
>@@ -721,7 +978,8 @@ static int get_string(struct usb_composite_dev *cdev,
> 		return s->bLength;
> 	}
> 
>-	/* Otherwise, look up and return a specified string.  First
>+	/*
>+	 * Otherwise, look up and return a specified string.  First
> 	 * check if the string has not been overridden.
> 	 */
> 	if (cdev->manufacturer_override == id)
>@@ -876,6 +1134,7 @@ composite_setup(struct usb_gadget *gadget, const struct usb_ctrlrequest *ctrl)
> 	struct usb_composite_dev	*cdev = get_gadget_data(gadget);
> 	struct usb_request		*req = cdev->req;
> 	int				value = -EOPNOTSUPP;
>+	int				status = 0;
> 	u16				w_index = le16_to_cpu(ctrl->wIndex);
> 	u8				intf = w_index & 0xFF;
> 	u16				w_value = le16_to_cpu(ctrl->wValue);
>@@ -903,18 +1162,28 @@ composite_setup(struct usb_gadget *gadget, const struct usb_ctrlrequest *ctrl)
> 		case USB_DT_DEVICE:
> 			cdev->desc.bNumConfigurations =
> 				count_configs(cdev, USB_DT_DEVICE);
>+			cdev->desc.bMaxPacketSize0 =
>+				cdev->gadget->ep0->maxpacket;
>+			if (gadget->speed >= USB_SPEED_SUPER)
there is something after super speed?
>+				cdev->desc.bcdUSB = cpu_to_le16(0x0300);
>+			else if ((gadget_is_superspeed(gadget)) &&
>+				 (gadget->speed <= USB_SPEED_HIGH))

what about USB_SPEED_WIRELESS?

>+				cdev->desc.bcdUSB = cpu_to_le16(0x0210);
>+
> 			value = min(w_length, (u16) sizeof cdev->desc);
> 			memcpy(req->buf, &cdev->desc, value);
> 			break;
> 		case USB_DT_DEVICE_QUALIFIER:
>-			if (!gadget_is_dualspeed(gadget))
>+			if (!gadget_is_dualspeed(gadget) ||
>+			    gadget->speed >= USB_SPEED_SUPER)
> 				break;
> 			device_qual(cdev);
> 			value = min_t(int, w_length,
> 				sizeof(struct usb_qualifier_descriptor));
> 			break;
> 		case USB_DT_OTHER_SPEED_CONFIG:
>-			if (!gadget_is_dualspeed(gadget))
>+			if (!gadget_is_dualspeed(gadget) ||
>+			    gadget->speed >= USB_SPEED_SUPER)
> 				break;
> 			/* FALLTHROUGH */
> 		case USB_DT_CONFIG:
>@@ -928,6 +1197,12 @@ composite_setup(struct usb_gadget *gadget, const struct usb_ctrlrequest *ctrl)
> 			if (value >= 0)
> 				value = min(w_length, (u16) value);
> 			break;
>+		case USB_DT_BOS:
>+			if (gadget_is_superspeed(gadget)) {
You return for <= USB_SPEED_HIGH bcdUSB with a value of 0x0210.
According to ch 9.2.6.6 you should handle GetDescriptor (BOS
Descriptor).

>+				value = bos(cdev);
>+				value = min(w_length, (u16) value);
>+			}
>+			break;
> 		}
> 		break;
> 
>@@ -987,6 +1262,65 @@ composite_setup(struct usb_gadget *gadget, const struct usb_ctrlrequest *ctrl)
> 		*((u8 *)req->buf) = value;
> 		value = min(w_length, (u16) 1);
> 		break;
>+
>+	/*
>+	 * USB 3.0 additions:
>+	 * Function driver should handle get_status request. If such cb
>+	 * wasn't supplied we respond with default value = 0
>+	 * Note: function driver should supply such cb only for the first
>+	 * interface of the function
>+	 */
>+	case USB_REQ_GET_STATUS:
>+		if (!gadget_is_superspeed(gadget))
>+			goto unknown;
>+		if (ctrl->bRequestType != (USB_DIR_IN | USB_RECIP_INTERFACE))
>+			goto unknown;
>+		value = 2;	/* This is the length of the get_status reply */
>+		*((u16 *)req->buf) = 0;
>+		if (!cdev->config || intf >= MAX_CONFIG_INTERFACES)
>+			break;
>+		f = cdev->config->interface[intf];
>+		if (!f)
>+			break;
>+		status = f->get_status ? f->get_status(f) : 0;
>+		if (status < 0)
>+			break;
>+		*((u16 *)req->buf) = status & 0x0000ffff;

My feeling is __le16 :)

>+		break;
>+	/*
>+	 * Function drivers should handle SetFeature/ClearFeature
>+	 * (FUNCTION_SUSPEND) request. function_suspend cb should be supplied
>+	 * only for the first interface of the function
>+	 */
>+	case USB_REQ_CLEAR_FEATURE:
>+	case USB_REQ_SET_FEATURE:
>+		if (!gadget_is_superspeed(gadget))
>+			goto unknown;
>+		if (ctrl->bRequestType != (USB_DIR_OUT | USB_RECIP_INTERFACE))
>+			goto unknown;
>+		switch (w_value) {
>+		case USB_INTRF_FUNC_SUSPEND:
>+			if (!cdev->config || intf >= MAX_CONFIG_INTERFACES)
>+				break;
>+			f = cdev->config->interface[intf];
>+			if (!f)
>+				break;
>+			value = f->func_suspend ?
>+				f->func_suspend(f,
>+					(u8)((w_index &
>+						USB_INTR_FUNC_SUSPEND_OPT_MASK)
>+							>> 8)) :
>+				0;

What about something smaller like

                value = 0;
                if (f->func_suspend)
                    value = f->func_suspend(f, w_index >> 8);

>+			if (value < 0) {
>+				ERROR(cdev, "func_suspend() returned "
>+					    "error %d\n", value);
>+				value = 0;
>+			}
>+			break;
>+		default:
>+			break;
>+		}
>+		break;
> 	default:
> unknown:
> 		VDBG(cdev,
>@@ -1107,8 +1441,11 @@ composite_unbind(struct usb_gadget *gadget)
> 				DBG(cdev, "unbind function '%s'/%p\n",
> 						f->name, f);
> 				f->unbind(c, f);
>-				/* may free memory for "f" */
> 			}
>+			/* Free memory allocated for ss descriptors */
>+			if (f->ss_desc_allocated && f->ss_descriptors)

check for  f->ss_descriptors is not required since kfree(null) is fine.
However this does no fly. f->unbind() will free the memmory of f. So
moving the comment does not delay the de-allocation :)
The comment is should probably use "will" instead of "may" since all
gadgets I checked do this.
The conditional allocation/free of the ss descriptor is kind of nasty.
Wouldn't it be better to add create_ss_descriptors() for every gadget
driver that needs it? This isn't that much. And in unbind you could
always free all three of them using one function like
free_all_descritpors().

>+				usb_free_descriptors(f->ss_descriptors);
>+			/* may free memory for "f" */
> 		}
> 		list_del(&c->list);
> 		if (c->unbind) {
>@@ -1346,6 +1683,9 @@ int usb_composite_probe(struct usb_composite_driver *driver,
> 		driver->iProduct = driver->name;
> 	composite_driver.function =  (char *) driver->name;
> 	composite_driver.driver.name = driver->name;
>+#ifdef CONFIG_USB_GADGET_SUPERSPEED
>+	composite_driver.speed = USB_SPEED_SUPER;
>+#endif /* CONFIG_USB_GADGET_SUPERSPEED */
> 	composite = driver;
> 	composite_gadget_bind = bind;
> 
>diff --git a/drivers/usb/gadget/epautoconf.c b/drivers/usb/gadget/epautoconf.c
>index de3461a..35c5818 100644
>--- a/drivers/usb/gadget/epautoconf.c
>+++ b/drivers/usb/gadget/epautoconf.c
>@@ -142,13 +142,13 @@ ep_matches (
> 	max = 0x7ff & le16_to_cpu(desc->wMaxPacketSize);
> 	switch (type) {
> 	case USB_ENDPOINT_XFER_INT:
>-		/* INT:  limit 64 bytes full speed, 1024 high speed */
>+		/* INT:  limit 64 bytes full speed, 1024 high/super speed */
> 		if (!gadget->is_dualspeed && max > 64)
> 			return 0;
> 		/* FALLTHROUGH */
> 
> 	case USB_ENDPOINT_XFER_ISOC:
>-		/* ISO:  limit 1023 bytes full speed, 1024 high speed */
>+		/* ISO:  limit 1023 bytes full speed, 1024 high/super speed */
> 		if (ep->maxpacket < max)
> 			return 0;
> 		if (!gadget->is_dualspeed && max > 1023)
>@@ -183,7 +183,7 @@ ep_matches (
> 	}
> 
> 	/* report (variable) full speed bulk maxpacket */
>-	if (USB_ENDPOINT_XFER_BULK == type) {
>+	if ((USB_ENDPOINT_XFER_BULK == type) & !gadget->is_dualspeed) {
> 		int size = ep->maxpacket;
> 
> 		/* min() doesn't work on bitfields with gcc-3.5 */
>diff --git a/include/linux/usb/composite.h b/include/linux/usb/composite.h
>index 4f56e44..e9fa7d8 100644
>--- a/include/linux/usb/composite.h
>+++ b/include/linux/usb/composite.h
>@@ -51,6 +51,18 @@ struct usb_configuration;
>  * @hs_descriptors: Table of high speed descriptors, using interface and
>  *	string identifiers assigned during @bind().  If this pointer is null,
>  *	the function will not be available at high speed.
>+ * @ss_descriptors: Table of super speed descriptors. If
>+ *	wasnt supplied by the FD during @bind() and
>+ *	!ss_not_capble, will be generated automaticly with
>+ *	default values while working in superspeed mode. If this
>+ *	pointer is null after initiation, the function will not
>+ *	be available at super speed.
>+ * @ss_not_capable: This flag is used by the FD to indicate if
>+ *	this function is SS capble. Meaning: if SS descriptors
>+ *	weren't supplied by the FD, and the flag is set ss
>+ *	descriptors will NOT be automatically generated
>+ * @ss_desc_allocated: This flag indicates whether the ss descriptors were
>+ *	dynamically allocated (and needs to be released).
>  * @config: assigned when @usb_add_function() is called; this is the
>  *	configuration with which this function is associated.
>  * @bind: Before the gadget can register, all of its functions bind() to the
>@@ -69,6 +81,10 @@ struct usb_configuration;
>  * @setup: Used for interface-specific control requests.
>  * @suspend: Notifies functions when the host stops sending USB traffic.
>  * @resume: Notifies functions when the host restarts USB traffic.
>+ * @get_status: Returns function status as a reply to
>+ *	GetStatus() request when the recepient is Interface.
>+ * @func_suspend: callback to be called when
>+ *	SetFeature(FUNCTION_SUSPEND) is reseived
>  *
>  * A single USB function uses one or more interfaces, and should in most
>  * cases support operation at both full and high speeds.  Each function is
>@@ -98,6 +114,10 @@ struct usb_function {
> 	struct usb_gadget_strings	**strings;
> 	struct usb_descriptor_header	**descriptors;
> 	struct usb_descriptor_header	**hs_descriptors;
>+	struct usb_descriptor_header	**ss_descriptors;
>+
>+	unsigned			ss_desc_allocated:1;
>+	unsigned			ss_not_capable:1;
> 
> 	struct usb_configuration	*config;
> 
>@@ -124,6 +144,10 @@ struct usb_function {
> 	void			(*suspend)(struct usb_function *);
> 	void			(*resume)(struct usb_function *);
> 
>+	/* USB 3.0 additions */
>+	int			(*get_status)(struct usb_function *);
>+	int			(*func_suspend)(struct usb_function *,
>+						u8 suspend_opt);
> 	/* private: */
> 	/* internals */
> 	struct list_head		list;
>@@ -229,6 +253,7 @@ struct usb_configuration {
> 	struct list_head	list;
> 	struct list_head	functions;
> 	u8			next_interface_id;
>+	unsigned		superspeed:1;
> 	unsigned		highspeed:1;
> 	unsigned		fullspeed:1;
> 	struct usb_function	*interface[MAX_CONFIG_INTERFACES];
>diff --git a/include/linux/usb/gadget.h b/include/linux/usb/gadget.h
>index 1bb7b3e..92c2d62 100644
>--- a/include/linux/usb/gadget.h
>+++ b/include/linux/usb/gadget.h
>@@ -131,11 +131,15 @@ struct usb_ep_ops {
>  * @maxpacket:The maximum packet size used on this endpoint.  The initial
>  *	value can sometimes be reduced (hardware allowing), according to
>  *      the endpoint descriptor used to configure the endpoint.
>+ * @mult: multiplier, 'mult' value for SS Isoc EPs
>+ * @maxburst: the maximum number of bursts supported by this EP (for usb3)
>  * @driver_data:for use by the gadget driver.
>  * @bEndpointAddress: used to identify the endpoint when finding
>  *	descriptor that matches connection speed
>  * @desc: endpoint descriptor.  This pointer is set before the endpoint is
>  *	enabled and remains valid until the endpoint is disabled.
>+ * @comp_desc: In case of SuperSpeed support, this is the endpoint companion
>+ *	descriptor that is used to configure the endpoint
>  *
>  * the bus controller driver lists all the general purpose endpoints in
>  * gadget->ep_list.  the control endpoint (gadget->ep0) is not in that list,
>@@ -148,8 +152,12 @@ struct usb_ep {
> 	const struct usb_ep_ops	*ops;
> 	struct list_head	ep_list;
> 	unsigned		maxpacket:16;
>+	unsigned				mult:2;
>+	unsigned				pad:1;
>+	unsigned				maxburst:4;
> 	u8				bEndpointAddress;
> 	const struct usb_endpoint_descriptor	*desc;
>+	const struct usb_ss_ep_comp_descriptor	*comp_desc;
> };
> 
> /*-------------------------------------------------------------------------*/
>@@ -417,6 +425,14 @@ static inline void usb_ep_fifo_flush(struct usb_ep *ep)
> 
> /*-------------------------------------------------------------------------*/
> 
>+struct usb_dcd_config_params {
>+	__u8  bU1devExitLat;	/* U1 Device exit Latency */
>+#define USB_DEFULT_U1_DEV_EXIT_LAT	0x01	/* Less then 1 microsec */
>+	__u16 bU2DevExitLat;	/* U2 Device exit Latency */
isn't that __le16?

>+#define USB_DEFULT_U2_DEV_EXIT_LAT	0x1F4	/* Less then 500 microsec */
>+};
>+
>+
> struct usb_gadget;
> 
> /* the rest of the api to the controller hardware: device operations,
>@@ -431,6 +447,7 @@ struct usb_gadget_ops {
> 	int	(*pullup) (struct usb_gadget *, int is_on);
> 	int	(*ioctl)(struct usb_gadget *,
> 				unsigned code, unsigned long param);
>+	void	(*get_config_params)(struct usb_dcd_config_params *);
> };
> 
> /**
>@@ -522,6 +539,23 @@ static inline int gadget_is_dualspeed(struct usb_gadget *g)
> }
> 
> /**
>+ * gadget_is_superspeed() - return true if the hardware handles
>+ * supperspeed
>+ * @g: controller that might support supper speed
>+ */
>+static inline int gadget_is_superspeed(struct usb_gadget *g)
>+{
>+#ifdef CONFIG_USB_GADGET_SUPERSPEED
>+	/* runtime test would check "g->is_superspeed" ... that might be
>+	 * useful to work around hardware bugs, but is mostly pointless
>+	 */
>+	return 1;
>+#else
>+	return 0;
>+#endif
>+}
>+
>+/**
>  * gadget_is_otg - return true iff the hardware is OTG-ready
>  * @g: controller that might have a Mini-AB connector
>  *

Sebastian
--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html


[Index of Archives]     [Linux Media]     [Linux Input]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [Old Linux USB Devel Archive]

  Powered by Linux