Commit 340c64ea authored by Roger Quadros's avatar Roger Quadros
Browse files

mfd: omap-usb-host: Manage HSIC clocks for HSIC mode 



Enable the optional HSIC clocks (60MHz and 480MHz) for the ports
that are configured in HSIC mode.

Signed-off-by: default avatarRoger Quadros <rogerq@ti.com>
Reviewed-by: default avatarFelipe Balbi <balbi@ti.com>
parent 06ba7dc7

drivers/mfd/omap-usb-host.c

+83 −14
Original line number Diff line number Diff line
@@ -93,6 +93,8 @@ 
struct usbhs_hcd_omap {

	int				nports;

	struct clk			**utmi_clk;

	struct clk			**hsic60m_clk;

	struct clk			**hsic480m_clk;



	struct clk			*xclk60mhsp1_ck;

	struct clk			*xclk60mhsp2_ck;
@@ -286,13 +288,40 @@ static int usbhs_runtime_resume(struct device *dev) 
		clk_enable(omap->ehci_logic_fck);



	for (i = 0; i < omap->nports; i++) {

		if (!is_ehci_tll_mode(pdata->port_mode[i]) ||

				IS_ERR(omap->utmi_clk[i]))

			continue;

		switch (pdata->port_mode[i]) {

		case OMAP_EHCI_PORT_MODE_HSIC:

			if (!IS_ERR(omap->hsic60m_clk[i])) {

				r = clk_enable(omap->hsic60m_clk[i]);

				if (r) {

					dev_err(dev,

					 "Can't enable port %d hsic60m clk:%d\n",

					 i, r);

				}

			}



			if (!IS_ERR(omap->hsic480m_clk[i])) {

				r = clk_enable(omap->hsic480m_clk[i]);

				if (r) {

					dev_err(dev,

					 "Can't enable port %d hsic480m clk:%d\n",

					 i, r);

				}

			}

		/* Fall through as HSIC mode needs utmi_clk */



		case OMAP_EHCI_PORT_MODE_TLL:

			if (!IS_ERR(omap->utmi_clk[i])) {

				r = clk_enable(omap->utmi_clk[i]);

		if (r)

			dev_err(dev, "Can't enable port %d clk : %d\n", i, r);

				if (r) {

					dev_err(dev,

					 "Can't enable port %d clk : %d\n",

					 i, r);

				}

			}

			break;

		default:

			break;

		}

	}



	spin_unlock_irqrestore(&omap->lock, flags);
@@ -312,9 +341,22 @@ static int usbhs_runtime_suspend(struct device *dev) 
	spin_lock_irqsave(&omap->lock, flags);



	for (i = 0; i < omap->nports; i++) {

		if (is_ehci_tll_mode(pdata->port_mode[i]) &&

				!IS_ERR(omap->utmi_clk[i]))

		switch (pdata->port_mode[i]) {

		case OMAP_EHCI_PORT_MODE_HSIC:

			if (!IS_ERR(omap->hsic60m_clk[i]))

				clk_disable(omap->hsic60m_clk[i]);



			if (!IS_ERR(omap->hsic480m_clk[i]))

				clk_disable(omap->hsic480m_clk[i]);

		/* Fall through as utmi_clks were used in HSIC mode */



		case OMAP_EHCI_PORT_MODE_TLL:

			if (!IS_ERR(omap->utmi_clk[i]))

				clk_disable(omap->utmi_clk[i]);

			break;

		default:

			break;

		}

	}



	if (!IS_ERR(omap->ehci_logic_fck))
@@ -520,7 +562,10 @@ static int usbhs_omap_probe(struct platform_device *pdev) 


	i = sizeof(struct clk *) * omap->nports;

	omap->utmi_clk = devm_kzalloc(dev, i, GFP_KERNEL);

	if (!omap->utmi_clk) {

	omap->hsic480m_clk = devm_kzalloc(dev, i, GFP_KERNEL);

	omap->hsic60m_clk = devm_kzalloc(dev, i, GFP_KERNEL);



	if (!omap->utmi_clk || !omap->hsic480m_clk || !omap->hsic60m_clk) {

		dev_err(dev, "Memory allocation failed\n");

		ret = -ENOMEM;

		goto err_mem;
@@ -578,7 +623,7 @@ static int usbhs_omap_probe(struct platform_device *pdev) 
	}



	for (i = 0; i < omap->nports; i++) {

		char clkname[] = "usb_host_hs_utmi_px_clk";

		char clkname[30];



		/* clock names are indexed from 1*/

		snprintf(clkname, sizeof(clkname),
@@ -592,6 +637,20 @@ static int usbhs_omap_probe(struct platform_device *pdev) 
		if (IS_ERR(omap->utmi_clk[i]))

			dev_dbg(dev, "Failed to get clock : %s : %ld\n",

				clkname, PTR_ERR(omap->utmi_clk[i]));



		snprintf(clkname, sizeof(clkname),

				"usb_host_hs_hsic480m_p%d_clk", i + 1);

		omap->hsic480m_clk[i] = clk_get(dev, clkname);

		if (IS_ERR(omap->hsic480m_clk[i]))

			dev_dbg(dev, "Failed to get clock : %s : %ld\n",

				clkname, PTR_ERR(omap->hsic480m_clk[i]));



		snprintf(clkname, sizeof(clkname),

				"usb_host_hs_hsic60m_p%d_clk", i + 1);

		omap->hsic60m_clk[i] = clk_get(dev, clkname);

		if (IS_ERR(omap->hsic60m_clk[i]))

			dev_dbg(dev, "Failed to get clock : %s : %ld\n",

				clkname, PTR_ERR(omap->hsic60m_clk[i]));

	}



	if (is_ehci_phy_mode(pdata->port_mode[0])) {
@@ -635,9 +694,14 @@ static int usbhs_omap_probe(struct platform_device *pdev) 
err_alloc:

	omap_usbhs_deinit(&pdev->dev);



	for (i = 0; i < omap->nports; i++)

	for (i = 0; i < omap->nports; i++) {

		if (!IS_ERR(omap->utmi_clk[i]))

			clk_put(omap->utmi_clk[i]);

		if (!IS_ERR(omap->hsic60m_clk[i]))

			clk_put(omap->hsic60m_clk[i]);

		if (!IS_ERR(omap->hsic480m_clk[i]))

			clk_put(omap->hsic480m_clk[i]);

	}



	clk_put(omap->init_60m_fclk);
@@ -676,9 +740,14 @@ static int usbhs_omap_remove(struct platform_device *pdev) 


	omap_usbhs_deinit(&pdev->dev);



	for (i = 0; i < omap->nports; i++)

	for (i = 0; i < omap->nports; i++) {

		if (!IS_ERR(omap->utmi_clk[i]))

			clk_put(omap->utmi_clk[i]);

		if (!IS_ERR(omap->hsic60m_clk[i]))

			clk_put(omap->hsic60m_clk[i]);

		if (!IS_ERR(omap->hsic480m_clk[i]))

			clk_put(omap->hsic480m_clk[i]);

	}



	clk_put(omap->init_60m_fclk);

	clk_put(omap->utmi_p1_gfclk);