usb: gadget: udc: atmel: Check fifo configuration values against device tree

Check fifo configuration values against device tree values for endpoint fifo
in auto configuration mode (fifo_mode=0).

Signed-off-by: Cristian Birsan <cristian.birsan@microchip.com>
Acked-by: Nicolas Ferre <nicolas.ferre@microchip.com>
Signed-off-by: Felipe Balbi <felipe.balbi@linux.intel.com>

diff --git a/drivers/usb/gadget/udc/atmel_usba_udc.c b/drivers/usb/gadget/udc/atmel_usba_udc.c
index 750c046d016769645fb4c4cba13d7ef67b16517b..8bc0b52a36f7b5b6b0be05c6193d1480f543e62a 100644 (file)
--- a/drivers/usb/gadget/udc/atmel_usba_udc.c
+++ b/drivers/usb/gadget/udc/atmel_usba_udc.c
@@ -2115,14 +2115,34 @@ static struct usba_ep * atmel_udc_of_init(struct platform_device *pdev,
                        dev_err(&pdev->dev, "of_probe: fifo-size error(%d)\n", ret);
                        goto err;
                }
-               ep->fifo_size = fifo_mode ? udc->fifo_cfg[i].fifo_size : val;
+               if (fifo_mode) {
+                       if (val < udc->fifo_cfg[i].fifo_size) {
+                               dev_warn(&pdev->dev,
+                                        "Using max fifo-size value from DT\n");
+                               ep->fifo_size = val;
+                       } else {
+                               ep->fifo_size = udc->fifo_cfg[i].fifo_size;
+                       }
+               } else {
+                       ep->fifo_size = val;
+               }
 
                ret = of_property_read_u32(pp, "atmel,nb-banks", &val);
                if (ret) {
                        dev_err(&pdev->dev, "of_probe: nb-banks error(%d)\n", ret);
                        goto err;
                }
-               ep->nr_banks = fifo_mode ? udc->fifo_cfg[i].nr_banks : val;
+               if (fifo_mode) {
+                       if (val < udc->fifo_cfg[i].nr_banks) {
+                               dev_warn(&pdev->dev,
+                                        "Using max nb-banks value from DT\n");
+                               ep->nr_banks = val;
+                       } else {
+                               ep->nr_banks = udc->fifo_cfg[i].nr_banks;
+                       }
+               } else {
+                       ep->nr_banks = val;
+               }
 
                ep->can_dma = of_property_read_bool(pp, "atmel,can-dma");
                ep->can_isoc = of_property_read_bool(pp, "atmel,can-isoc");