Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 32601588 authored by Vardan Mikayelyan's avatar Vardan Mikayelyan Committed by Felipe Balbi
Browse files

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: default avatarJohn Keeping <john@metanate.com>
Signed-off-by: default avatarVardan Mikayelyan <mvardan@synopsys.com>
Signed-off-by: default avatarJohn Youn <johnyoun@synopsys.com>
Signed-off-by: default avatarFelipe Balbi <felipe.balbi@linux.intel.com>
parent 142bd33f

drivers/usb/dwc2/gadget.c

+29 −1
Original line number Diff line number Diff line
@@ -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 */