Commit 62448315 authored by Chunfeng Yun's avatar Chunfeng Yun Committed by Greg Kroah-Hartman
Browse files

usb: mtu3: add helper to power on/down device 



Add helper to power on/down device ports and ip, it will be
used when support device suspend/resume

Signed-off-by: default avatarChunfeng Yun <chunfeng.yun@mediatek.com>
Link: https://lore.kernel.org/r/1626340078-29111-12-git-send-email-chunfeng.yun@mediatek.com


Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent fa6f59e2

drivers/usb/mtu3/mtu3_core.c

+24 −12
Original line number Diff line number Diff line
@@ -141,6 +141,28 @@ static void mtu3_device_disable(struct mtu3 *mtu) 
	mtu3_setbits(ibase, U3D_SSUSB_IP_PW_CTRL2, SSUSB_IP_DEV_PDN);

}



static void mtu3_dev_power_on(struct mtu3 *mtu)

{

	void __iomem *ibase = mtu->ippc_base;



	mtu3_clrbits(ibase, U3D_SSUSB_IP_PW_CTRL2, SSUSB_IP_DEV_PDN);

	if (mtu->is_u3_ip)

		mtu3_clrbits(ibase, SSUSB_U3_CTRL(0), SSUSB_U3_PORT_PDN);



	mtu3_clrbits(ibase, SSUSB_U2_CTRL(0), SSUSB_U2_PORT_PDN);

}



static void mtu3_dev_power_down(struct mtu3 *mtu)

{

	void __iomem *ibase = mtu->ippc_base;



	if (mtu->is_u3_ip)

		mtu3_setbits(ibase, SSUSB_U3_CTRL(0), SSUSB_U3_PORT_PDN);



	mtu3_setbits(ibase, SSUSB_U2_CTRL(0), SSUSB_U2_PORT_PDN);

	mtu3_setbits(ibase, U3D_SSUSB_IP_PW_CTRL2, SSUSB_IP_DEV_PDN);

}



/* reset U3D's device module. */

static void mtu3_device_reset(struct mtu3 *mtu)

{
@@ -333,12 +355,7 @@ void mtu3_start(struct mtu3 *mtu) 
	dev_dbg(mtu->dev, "%s devctl 0x%x\n", __func__,

		mtu3_readl(mbase, U3D_DEVICE_CONTROL));



	mtu3_clrbits(mtu->ippc_base, U3D_SSUSB_IP_PW_CTRL2, SSUSB_IP_DEV_PDN);

	if (mtu->is_u3_ip)

		mtu3_clrbits(mtu->ippc_base, SSUSB_U3_CTRL(0), SSUSB_U3_PORT_PDN);



	mtu3_clrbits(mtu->ippc_base, SSUSB_U2_CTRL(0), SSUSB_U2_PORT_PDN);



	mtu3_dev_power_on(mtu);

	mtu3_csr_init(mtu);

	mtu3_set_speed(mtu, mtu->speed);
@@ -360,12 +377,7 @@ void mtu3_stop(struct mtu3 *mtu) 
		mtu3_dev_on_off(mtu, 0);



	mtu->is_active = 0;



	if (mtu->is_u3_ip)

		mtu3_setbits(mtu->ippc_base, SSUSB_U3_CTRL(0), SSUSB_U3_PORT_PDN);



	mtu3_setbits(mtu->ippc_base, SSUSB_U2_CTRL(0), SSUSB_U2_PORT_PDN);

	mtu3_setbits(mtu->ippc_base, U3D_SSUSB_IP_PW_CTRL2, SSUSB_IP_DEV_PDN);

	mtu3_dev_power_down(mtu);

}



/* for non-ep0 */