On 06/13/2016 06:03 AM, Rajesh Bhagat wrote: > From: Rajesh Bhagat <rajesh.bha...@freescale.com> > > Implements the logic to calculate the optimal usb maximum trasfer blocks > instead of sending USB_MAX_XFER_BLK blocks which is 65535 and 20 in case > of EHCI and other USB protocols respectively. > > It defines USB_MIN_XFER_BLK/USB_MAX_XFER_BLK trasfer blocks that should > be checked for success starting from minimum to maximum, and rest of the > read/write are performed with that optimal value. It tries to increase/ > decrease the blocks in follwing scenarios: > > 1.decrease blocks: when read/write for a particular number of blocks > fails. > 2. increase blocks: when read/write for a particular number of blocks > pass and amount left to trasfer is greater than current number of > blocks. > > Currently changes are done for EHCI where min = 4096 and max = 65535 > is taken. And for other cases code is left unchanged by keeping min > = max = 20. > > Signed-off-by: Sriram Dash <sriram.d...@nxp.com> > Signed-off-by: Rajesh Bhagat <rajesh.bha...@nxp.com> > --- > Changes in v5: > - None > > Changes in v4: > - Adds udev paramater in dec/inc_cur_xfer_blks function and adds > sanity check on it. > - Changes type of pos varible to unsigned int in dec/inc_cur_xfer_blks > - Removes usage of pos varible from usb_stor_read/write > > Changes in v3: > - Adds cur_xfer_blks in struct usb_device to retain values > - Adds functions dec/inc_cur_xfer_blks to remove code duplication > - Moves check from macro to calling functions > > Changes in v2: > - Removes table to store blocks and use formula (1 << (12 + n)) - 1 > - Adds logic to start from minimum, go to maximum in each read/write > > common/usb_storage.c | 67 ++++++++++++++++++++++++++++++++++++++++++++++--- > include/usb.h | 1 + > 2 files changed, 63 insertions(+), 5 deletions(-) > > diff --git a/common/usb_storage.c b/common/usb_storage.c > index f060637..9b09412 100644 > --- a/common/usb_storage.c > +++ b/common/usb_storage.c > @@ -106,11 +106,16 @@ struct us_data { > * enough free heap space left, but the SCSI READ(10) and WRITE(10) commands > are > * limited to 65535 blocks. > */ > +#define USB_MIN_XFER_BLK 4095 > #define USB_MAX_XFER_BLK 65535 > #else > +#define USB_MIN_XFER_BLK 20 > #define USB_MAX_XFER_BLK 20 > #endif > > +#define GET_CUR_XFER_BLKS(blks) (LOG2((blks + 1) / (USB_MIN_XFER_BLK + > 1))) > +#define CALC_CUR_XFER_BLKS(pos) ((1 << (12 + pos)) - 1)
Parenthesis around variables are missing. > #ifndef CONFIG_BLK > static struct us_data usb_stor[USB_MAX_STOR_DEV]; > #endif > @@ -141,6 +146,44 @@ static void usb_show_progress(void) > debug("."); > } > > +static int dec_cur_xfer_blks(struct usb_device *udev) > +{ > + /* decrease the cur_xfer_blks */ > + unsigned int pos; > + unsigned short size; > + > + if (!udev) > + return -EINVAL; > + > + pos = GET_CUR_XFER_BLKS(udev->cur_xfer_blks); > + size = pos ? CALC_CUR_XFER_BLKS(pos - 1) : 0; If pos == 0 , the condition below will be true (size will be 2047), so this extra ternary is unnecessary. > + if (size < USB_MIN_XFER_BLK) > + return -EINVAL; > + > + udev->cur_xfer_blks = size; > + return 0; > +} > + > +static int inc_cur_xfer_blks(struct usb_device *udev, lbaint_t blks) > +{ > + /* try to increase the cur_xfer_blks */ > + unsigned int pos; > + unsigned short size; > + > + if (!udev) > + return -EINVAL; > + > + pos = GET_CUR_XFER_BLKS(udev->cur_xfer_blks); > + size = CALC_CUR_XFER_BLKS(pos + 1); > + > + if (size > blks || size > USB_MAX_XFER_BLK) > + return -EINVAL; Why don't you clamp the size to min(blks, USB_MAX_XFER_BLK) instead ? > + udev->cur_xfer_blks = size; > + return 0; > +} > + > > /******************************************************************************* > * show info on storage devices; 'usb start/init' must be invoked earlier > * as we only retrieve structures populated during devices initialization > @@ -1128,6 +1171,7 @@ static unsigned long usb_stor_read_write(struct > blk_desc *block_dev, > struct usb_device *udev; > struct us_data *ss; > int retry; > + bool retry_flag = false; > ccb *srb = &usb_ccb; > #ifdef CONFIG_BLK > struct blk_desc *block_dev; > @@ -1167,26 +1211,36 @@ static unsigned long usb_stor_read_write(struct > blk_desc *block_dev, > */ > retry = 2; > srb->pdata = (unsigned char *)buf_addr; > - if (blks > USB_MAX_XFER_BLK) > - smallblks = USB_MAX_XFER_BLK; > + if (blks > udev->cur_xfer_blks) > + smallblks = udev->cur_xfer_blks; > else > smallblks = (unsigned short) blks; > retry_it: > - if (smallblks == USB_MAX_XFER_BLK) > + debug("usb_%s: retry #%d, cur_xfer_blks %hu, smallblks %hu\n", > + USB_STOR_OP_TYPE, retry, udev->cur_xfer_blks, > + smallblks); > + if (smallblks == udev->cur_xfer_blks) > usb_show_progress(); > srb->datalen = block_dev->blksz * smallblks; > srb->pdata = (unsigned char *)buf_addr; > if (usb_stor_operation(srb, ss, start, smallblks, is_write)) { > debug("%s ERROR\n", USB_STOR_OP_TYPE); > usb_request_sense(srb, ss); > - if (retry--) > + if (retry--) { > + if (!dec_cur_xfer_blks(udev)) > + smallblks = udev->cur_xfer_blks; > + retry_flag = true; > goto retry_it; > + } > blkcnt -= blks; > break; > } > start += smallblks; > blks -= smallblks; > buf_addr += srb->datalen; > + > + if (!retry_flag && !inc_cur_xfer_blks(udev, blks)) > + smallblks = udev->cur_xfer_blks; > } while (blks != 0); > ss->flags &= ~USB_READY; > > @@ -1195,7 +1249,7 @@ retry_it: > USB_STOR_OP_TYPE, start, smallblks, buf_addr); > > usb_disable_asynch(0); /* asynch transfer allowed */ > - if (blkcnt >= USB_MAX_XFER_BLK) > + if (blkcnt >= udev->cur_xfer_blks) > debug("\n"); > return blkcnt; > } > @@ -1282,6 +1336,9 @@ int usb_storage_probe(struct usb_device *dev, unsigned > int ifnum, > break; > } > > + /* Initialize the current transfer blocks to minimum value */ > + dev->cur_xfer_blks = USB_MIN_XFER_BLK; > + > /* > * We are expecting a minimum of 2 endpoints - in and out (bulk). > * An optional interrupt is OK (necessary for CBI protocol). > diff --git a/include/usb.h b/include/usb.h > index 02a0ccd..b815816 100644 > --- a/include/usb.h > +++ b/include/usb.h > @@ -153,6 +153,7 @@ struct usb_device { > struct udevice *dev; /* Pointer to associated device */ > struct udevice *controller_dev; /* Pointer to associated controller */ > #endif > + unsigned short cur_xfer_blks; /* Current maximum transfer blocks */ > }; > > struct int_queue; > -- Best regards, Marek Vasut _______________________________________________ U-Boot mailing list U-Boot@lists.denx.de http://lists.denx.de/mailman/listinfo/u-boot