mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-21 11:44:01 +08:00
usb: dwc2: gadget: Add dwc2_gadget_read_ep_interrupts function
Reads and returns interrupts for given endpoint, by masking epint_reg with corresponding mask. Tested-by: John Keeping <john@metanate.com> Signed-off-by: Vardan Mikayelyan <mvardan@synopsys.com> Signed-off-by: John Youn <johnyoun@synopsys.com> Signed-off-by: Felipe Balbi <felipe.balbi@linux.intel.com>
This commit is contained in:
parent
142bd33fcd
commit
326015887b
@ -1946,6 +1946,34 @@ static void dwc2_hsotg_complete_in(struct dwc2_hsotg *hsotg,
|
||||
dwc2_hsotg_complete_request(hsotg, hs_ep, hs_req, 0);
|
||||
}
|
||||
|
||||
/**
|
||||
* dwc2_gadget_read_ep_interrupts - reads interrupts for given ep
|
||||
* @hsotg: The device state.
|
||||
* @idx: Index of ep.
|
||||
* @dir_in: Endpoint direction 1-in 0-out.
|
||||
*
|
||||
* Reads for endpoint with given index and direction, by masking
|
||||
* epint_reg with coresponding mask.
|
||||
*/
|
||||
static u32 dwc2_gadget_read_ep_interrupts(struct dwc2_hsotg *hsotg,
|
||||
unsigned int idx, int dir_in)
|
||||
{
|
||||
u32 epmsk_reg = dir_in ? DIEPMSK : DOEPMSK;
|
||||
u32 epint_reg = dir_in ? DIEPINT(idx) : DOEPINT(idx);
|
||||
u32 ints;
|
||||
u32 mask;
|
||||
u32 diepempmsk;
|
||||
|
||||
mask = dwc2_readl(hsotg->regs + epmsk_reg);
|
||||
diepempmsk = dwc2_readl(hsotg->regs + DIEPEMPMSK);
|
||||
mask |= ((diepempmsk >> idx) & 0x1) ? DIEPMSK_TXFIFOEMPTY : 0;
|
||||
mask |= DXEPINT_SETUP_RCVD;
|
||||
|
||||
ints = dwc2_readl(hsotg->regs + epint_reg);
|
||||
ints &= mask;
|
||||
return ints;
|
||||
}
|
||||
|
||||
/**
|
||||
* dwc2_hsotg_epint - handle an in/out endpoint interrupt
|
||||
* @hsotg: The driver state
|
||||
@ -1964,7 +1992,7 @@ static void dwc2_hsotg_epint(struct dwc2_hsotg *hsotg, unsigned int idx,
|
||||
u32 ints;
|
||||
u32 ctrl;
|
||||
|
||||
ints = dwc2_readl(hsotg->regs + epint_reg);
|
||||
ints = dwc2_gadget_read_ep_interrupts(hsotg, idx, dir_in);
|
||||
ctrl = dwc2_readl(hsotg->regs + epctl_reg);
|
||||
|
||||
/* Clear endpoint interrupts */
|
||||
|
Loading…
Reference in New Issue
Block a user