diff options
author | Andrey Smirnov <andrew.smirnov@gmail.com> | 2019-05-22 00:34:02 -0700 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2019-05-23 09:45:50 +0200 |
commit | 91c69e0975e788164674ee4cf20fe2e537be20bb (patch) | |
tree | 6d290176c69e9b6be594ea5c263cf0df19fa45ed /drivers/usb | |
parent | 7d185d8deae7e472e79dce39a27a2381afcae234 (diff) | |
download | barebox-91c69e0975e788164674ee4cf20fe2e537be20bb.tar.gz barebox-91c69e0975e788164674ee4cf20fe2e537be20bb.tar.xz |
usb: host: ehci: Introduce ehci_prepare_qtd()
Move shared struct qTD initialization code into a subroutine and
convert the rest of the code to use it. No functional change intended.
Signed-off-by: Andrey Smirnov <andrew.smirnov@gmail.com>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Diffstat (limited to 'drivers/usb')
-rw-r--r-- | drivers/usb/host/ehci-hcd.c | 66 |
1 files changed, 35 insertions, 31 deletions
diff --git a/drivers/usb/host/ehci-hcd.c b/drivers/usb/host/ehci-hcd.c index be875d4026..ad244637e6 100644 --- a/drivers/usb/host/ehci-hcd.c +++ b/drivers/usb/host/ehci-hcd.c @@ -213,6 +213,27 @@ static int ehci_td_buffer(struct qTD *td, void *buf, size_t sz) return 0; } +static int ehci_prepare_qtd(struct qTD *td, uint32_t token, + void *buffer, size_t length) +{ + int ret; + + td->qt_next = cpu_to_hc32(QT_NEXT_TERMINATE); + td->qt_altnext = cpu_to_hc32(QT_NEXT_TERMINATE); + token |= QT_TOKEN_TOTALBYTES(length) | + QT_TOKEN_CPAGE(0) | QT_TOKEN_CERR(3) | + QT_TOKEN_STATUS(QT_TOKEN_STATUS_ACTIVE); + td->qt_token = cpu_to_hc32(token); + + if (length) { + ret = ehci_td_buffer(td, buffer, length); + if (ret) + return ret; + } + + return 0; +} + static int ehci_enable_async_schedule(struct ehci_host *ehci, bool enable) { uint32_t cmd, done; @@ -299,16 +320,9 @@ ehci_submit_async(struct usb_device *dev, unsigned long pipe, void *buffer, if (req != NULL) { td = &ehci->td[0]; - td->qt_next = cpu_to_hc32(QT_NEXT_TERMINATE); - td->qt_altnext = cpu_to_hc32(QT_NEXT_TERMINATE); - token = QT_TOKEN_DT(0) | - QT_TOKEN_TOTALBYTES(sizeof(*req)) | - QT_TOKEN_IOC(0) | - QT_TOKEN_CPAGE(0) | QT_TOKEN_CERR(3) | - QT_TOKEN_PID(QT_TOKEN_PID_SETUP) | - QT_TOKEN_STATUS(QT_TOKEN_STATUS_ACTIVE); - td->qt_token = cpu_to_hc32(token); - ret = ehci_td_buffer(td, req, sizeof(*req)); + ret = ehci_prepare_qtd(td, QT_TOKEN_DT(0) | QT_TOKEN_IOC(0) | + QT_TOKEN_PID(QT_TOKEN_PID_SETUP), + req, sizeof(*req)); if (ret) { dev_dbg(ehci->dev, "unable construct SETUP td\n"); return ret; @@ -322,17 +336,12 @@ ehci_submit_async(struct usb_device *dev, unsigned long pipe, void *buffer, if (length > 0 || req == NULL) { td = &ehci->td[1]; - td->qt_next = cpu_to_hc32(QT_NEXT_TERMINATE); - td->qt_altnext = cpu_to_hc32(QT_NEXT_TERMINATE); - token = QT_TOKEN_DT(toggle) | - QT_TOKEN_TOTALBYTES(length) | - QT_TOKEN_IOC(req == NULL) | - QT_TOKEN_CPAGE(0) | QT_TOKEN_CERR(3) | - QT_TOKEN_PID(usb_pipein(pipe) ? - QT_TOKEN_PID_IN : QT_TOKEN_PID_OUT) | - QT_TOKEN_STATUS(QT_TOKEN_STATUS_ACTIVE); - td->qt_token = cpu_to_hc32(token); - ret = ehci_td_buffer(td, buffer, length); + ret = ehci_prepare_qtd(td, QT_TOKEN_DT(toggle) | + QT_TOKEN_IOC(req == NULL) | + QT_TOKEN_PID(usb_pipein(pipe) ? + QT_TOKEN_PID_IN : + QT_TOKEN_PID_OUT), + buffer, length); if (ret) { dev_err(ehci->dev, "unable construct DATA td\n"); return ret; @@ -344,16 +353,11 @@ ehci_submit_async(struct usb_device *dev, unsigned long pipe, void *buffer, if (req) { td = &ehci->td[2]; - td->qt_next = cpu_to_hc32(QT_NEXT_TERMINATE); - td->qt_altnext = cpu_to_hc32(QT_NEXT_TERMINATE); - token = QT_TOKEN_DT(1) | - QT_TOKEN_TOTALBYTES(0) | - QT_TOKEN_IOC(1) | - QT_TOKEN_CPAGE(0) | QT_TOKEN_CERR(3) | - QT_TOKEN_PID(usb_pipein(pipe) ? - QT_TOKEN_PID_OUT : QT_TOKEN_PID_IN) | - QT_TOKEN_STATUS(QT_TOKEN_STATUS_ACTIVE); - td->qt_token = cpu_to_hc32(token); + ehci_prepare_qtd(td, QT_TOKEN_DT(1) | QT_TOKEN_IOC(1) | + QT_TOKEN_PID(usb_pipein(pipe) ? + QT_TOKEN_PID_OUT : + QT_TOKEN_PID_IN), + NULL, 0); *tdp = cpu_to_hc32((uint32_t)td); tdp = &td->qt_next; } |