mirror of
				git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
				synced 2025-10-31 08:44:41 +00:00 
			
		
		
		
	 57ae575b8a
			
		
	
	
		57ae575b8a
		
	
	
	
	
		
			
			Use the newly introduced devm_ioremap_resource() instead of devm_request_and_ioremap() which provides more consistent error handling. devm_ioremap_resource() provides its own error messages; so all explicit error messages can be removed from the failure code paths. Reviewed-by: Thierry Reding <thierry.reding@avionic-design.de> Signed-off-by: Sachin Kamat <sachin.kamat@linaro.org> Cc: Kishon Vijay Abraham I <kishon@ti.com> Signed-off-by: Felipe Balbi <balbi@ti.com>
		
			
				
	
	
		
			289 lines
		
	
	
	
		
			7.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			289 lines
		
	
	
	
		
			7.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * omap-control-usb.c - The USB part of control module.
 | |
|  *
 | |
|  * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License as published by
 | |
|  * the Free Software Foundation; either version 2 of the License, or
 | |
|  * (at your option) any later version.
 | |
|  *
 | |
|  * Author: Kishon Vijay Abraham I <kishon@ti.com>
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | |
|  * GNU General Public License for more details.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <linux/module.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/of.h>
 | |
| #include <linux/err.h>
 | |
| #include <linux/io.h>
 | |
| #include <linux/clk.h>
 | |
| #include <linux/usb/omap_control_usb.h>
 | |
| 
 | |
| static struct omap_control_usb *control_usb;
 | |
| 
 | |
| /**
 | |
|  * omap_get_control_dev - returns the device pointer for this control device
 | |
|  *
 | |
|  * This API should be called to get the device pointer for this control
 | |
|  * module device. This device pointer should be used for called other
 | |
|  * exported API's in this driver.
 | |
|  *
 | |
|  * To be used by PHY driver and glue driver.
 | |
|  */
 | |
| struct device *omap_get_control_dev(void)
 | |
| {
 | |
| 	if (!control_usb)
 | |
| 		return ERR_PTR(-ENODEV);
 | |
| 
 | |
| 	return control_usb->dev;
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(omap_get_control_dev);
 | |
| 
 | |
| /**
 | |
|  * omap_control_usb3_phy_power - power on/off the serializer using control
 | |
|  *	module
 | |
|  * @dev: the control module device
 | |
|  * @on: 0 to off and 1 to on based on powering on or off the PHY
 | |
|  *
 | |
|  * usb3 PHY driver should call this API to power on or off the PHY.
 | |
|  */
 | |
| void omap_control_usb3_phy_power(struct device *dev, bool on)
 | |
| {
 | |
| 	u32 val;
 | |
| 	unsigned long rate;
 | |
| 	struct omap_control_usb	*control_usb = dev_get_drvdata(dev);
 | |
| 
 | |
| 	if (control_usb->type != OMAP_CTRL_DEV_TYPE2)
 | |
| 		return;
 | |
| 
 | |
| 	rate = clk_get_rate(control_usb->sys_clk);
 | |
| 	rate = rate/1000000;
 | |
| 
 | |
| 	val = readl(control_usb->phy_power);
 | |
| 
 | |
| 	if (on) {
 | |
| 		val &= ~(OMAP_CTRL_USB_PWRCTL_CLK_CMD_MASK |
 | |
| 			OMAP_CTRL_USB_PWRCTL_CLK_FREQ_MASK);
 | |
| 		val |= OMAP_CTRL_USB3_PHY_TX_RX_POWERON <<
 | |
| 			OMAP_CTRL_USB_PWRCTL_CLK_CMD_SHIFT;
 | |
| 		val |= rate << OMAP_CTRL_USB_PWRCTL_CLK_FREQ_SHIFT;
 | |
| 	} else {
 | |
| 		val &= ~OMAP_CTRL_USB_PWRCTL_CLK_CMD_MASK;
 | |
| 		val |= OMAP_CTRL_USB3_PHY_TX_RX_POWEROFF <<
 | |
| 			OMAP_CTRL_USB_PWRCTL_CLK_CMD_SHIFT;
 | |
| 	}
 | |
| 
 | |
| 	writel(val, control_usb->phy_power);
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(omap_control_usb3_phy_power);
 | |
| 
 | |
| /**
 | |
|  * omap_control_usb_phy_power - power on/off the phy using control module reg
 | |
|  * @dev: the control module device
 | |
|  * @on: 0 or 1, based on powering on or off the PHY
 | |
|  */
 | |
| void omap_control_usb_phy_power(struct device *dev, int on)
 | |
| {
 | |
| 	u32 val;
 | |
| 	struct omap_control_usb	*control_usb = dev_get_drvdata(dev);
 | |
| 
 | |
| 	val = readl(control_usb->dev_conf);
 | |
| 
 | |
| 	if (on)
 | |
| 		val &= ~OMAP_CTRL_DEV_PHY_PD;
 | |
| 	else
 | |
| 		val |= OMAP_CTRL_DEV_PHY_PD;
 | |
| 
 | |
| 	writel(val, control_usb->dev_conf);
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(omap_control_usb_phy_power);
 | |
| 
 | |
| /**
 | |
|  * omap_control_usb_host_mode - set AVALID, VBUSVALID and ID pin in grounded
 | |
|  * @ctrl_usb: struct omap_control_usb *
 | |
|  *
 | |
|  * Writes to the mailbox register to notify the usb core that a usb
 | |
|  * device has been connected.
 | |
|  */
 | |
| static void omap_control_usb_host_mode(struct omap_control_usb *ctrl_usb)
 | |
| {
 | |
| 	u32 val;
 | |
| 
 | |
| 	val = readl(ctrl_usb->otghs_control);
 | |
| 	val &= ~(OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_SESSEND);
 | |
| 	val |= OMAP_CTRL_DEV_AVALID | OMAP_CTRL_DEV_VBUSVALID;
 | |
| 	writel(val, ctrl_usb->otghs_control);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * omap_control_usb_device_mode - set AVALID, VBUSVALID and ID pin in high
 | |
|  * impedance
 | |
|  * @ctrl_usb: struct omap_control_usb *
 | |
|  *
 | |
|  * Writes to the mailbox register to notify the usb core that it has been
 | |
|  * connected to a usb host.
 | |
|  */
 | |
| static void omap_control_usb_device_mode(struct omap_control_usb *ctrl_usb)
 | |
| {
 | |
| 	u32 val;
 | |
| 
 | |
| 	val = readl(ctrl_usb->otghs_control);
 | |
| 	val &= ~OMAP_CTRL_DEV_SESSEND;
 | |
| 	val |= OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_AVALID |
 | |
| 		OMAP_CTRL_DEV_VBUSVALID;
 | |
| 	writel(val, ctrl_usb->otghs_control);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * omap_control_usb_set_sessionend - Enable SESSIONEND and IDIG to high
 | |
|  * impedance
 | |
|  * @ctrl_usb: struct omap_control_usb *
 | |
|  *
 | |
|  * Writes to the mailbox register to notify the usb core it's now in
 | |
|  * disconnected state.
 | |
|  */
 | |
| static void omap_control_usb_set_sessionend(struct omap_control_usb *ctrl_usb)
 | |
| {
 | |
| 	u32 val;
 | |
| 
 | |
| 	val = readl(ctrl_usb->otghs_control);
 | |
| 	val &= ~(OMAP_CTRL_DEV_AVALID | OMAP_CTRL_DEV_VBUSVALID);
 | |
| 	val |= OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_SESSEND;
 | |
| 	writel(val, ctrl_usb->otghs_control);
 | |
| }
 | |
| 
 | |
| /**
 | |
|  * omap_control_usb_set_mode - Calls to functions to set USB in one of host mode
 | |
|  * or device mode or to denote disconnected state
 | |
|  * @dev: the control module device
 | |
|  * @mode: The mode to which usb should be configured
 | |
|  *
 | |
|  * This is an API to write to the mailbox register to notify the usb core that
 | |
|  * a usb device has been connected.
 | |
|  */
 | |
| void omap_control_usb_set_mode(struct device *dev,
 | |
| 	enum omap_control_usb_mode mode)
 | |
| {
 | |
| 	struct omap_control_usb	*ctrl_usb;
 | |
| 
 | |
| 	if (IS_ERR(dev) || control_usb->type != OMAP_CTRL_DEV_TYPE1)
 | |
| 		return;
 | |
| 
 | |
| 	ctrl_usb = dev_get_drvdata(dev);
 | |
| 
 | |
| 	switch (mode) {
 | |
| 	case USB_MODE_HOST:
 | |
| 		omap_control_usb_host_mode(ctrl_usb);
 | |
| 		break;
 | |
| 	case USB_MODE_DEVICE:
 | |
| 		omap_control_usb_device_mode(ctrl_usb);
 | |
| 		break;
 | |
| 	case USB_MODE_DISCONNECT:
 | |
| 		omap_control_usb_set_sessionend(ctrl_usb);
 | |
| 		break;
 | |
| 	default:
 | |
| 		dev_vdbg(dev, "invalid omap control usb mode\n");
 | |
| 	}
 | |
| }
 | |
| EXPORT_SYMBOL_GPL(omap_control_usb_set_mode);
 | |
| 
 | |
| static int omap_control_usb_probe(struct platform_device *pdev)
 | |
| {
 | |
| 	struct resource	*res;
 | |
| 	struct device_node *np = pdev->dev.of_node;
 | |
| 	struct omap_control_usb_platform_data *pdata = pdev->dev.platform_data;
 | |
| 
 | |
| 	control_usb = devm_kzalloc(&pdev->dev, sizeof(*control_usb),
 | |
| 		GFP_KERNEL);
 | |
| 	if (!control_usb) {
 | |
| 		dev_err(&pdev->dev, "unable to alloc memory for control usb\n");
 | |
| 		return -ENOMEM;
 | |
| 	}
 | |
| 
 | |
| 	if (np) {
 | |
| 		of_property_read_u32(np, "ti,type", &control_usb->type);
 | |
| 	} else if (pdata) {
 | |
| 		control_usb->type = pdata->type;
 | |
| 	} else {
 | |
| 		dev_err(&pdev->dev, "no pdata present\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	control_usb->dev	= &pdev->dev;
 | |
| 
 | |
| 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
 | |
| 		"control_dev_conf");
 | |
| 	control_usb->dev_conf = devm_ioremap_resource(&pdev->dev, res);
 | |
| 	if (IS_ERR(control_usb->dev_conf))
 | |
| 		return PTR_ERR(control_usb->dev_conf);
 | |
| 
 | |
| 	if (control_usb->type == OMAP_CTRL_DEV_TYPE1) {
 | |
| 		res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
 | |
| 			"otghs_control");
 | |
| 		control_usb->otghs_control = devm_ioremap_resource(
 | |
| 			&pdev->dev, res);
 | |
| 		if (IS_ERR(control_usb->otghs_control))
 | |
| 			return PTR_ERR(control_usb->otghs_control);
 | |
| 	}
 | |
| 
 | |
| 	if (control_usb->type == OMAP_CTRL_DEV_TYPE2) {
 | |
| 		res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
 | |
| 			"phy_power_usb");
 | |
| 		control_usb->phy_power = devm_ioremap_resource(
 | |
| 			&pdev->dev, res);
 | |
| 		if (IS_ERR(control_usb->phy_power))
 | |
| 			return PTR_ERR(control_usb->phy_power);
 | |
| 
 | |
| 		control_usb->sys_clk = devm_clk_get(control_usb->dev,
 | |
| 			"sys_clkin");
 | |
| 		if (IS_ERR(control_usb->sys_clk)) {
 | |
| 			pr_err("%s: unable to get sys_clkin\n", __func__);
 | |
| 			return -EINVAL;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 
 | |
| 	dev_set_drvdata(control_usb->dev, control_usb);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_OF
 | |
| static const struct of_device_id omap_control_usb_id_table[] = {
 | |
| 	{ .compatible = "ti,omap-control-usb" },
 | |
| 	{}
 | |
| };
 | |
| MODULE_DEVICE_TABLE(of, omap_control_usb_id_table);
 | |
| #endif
 | |
| 
 | |
| static struct platform_driver omap_control_usb_driver = {
 | |
| 	.probe		= omap_control_usb_probe,
 | |
| 	.driver		= {
 | |
| 		.name	= "omap-control-usb",
 | |
| 		.owner	= THIS_MODULE,
 | |
| 		.of_match_table = of_match_ptr(omap_control_usb_id_table),
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static int __init omap_control_usb_init(void)
 | |
| {
 | |
| 	return platform_driver_register(&omap_control_usb_driver);
 | |
| }
 | |
| subsys_initcall(omap_control_usb_init);
 | |
| 
 | |
| static void __exit omap_control_usb_exit(void)
 | |
| {
 | |
| 	platform_driver_unregister(&omap_control_usb_driver);
 | |
| }
 | |
| module_exit(omap_control_usb_exit);
 | |
| 
 | |
| MODULE_ALIAS("platform: omap_control_usb");
 | |
| MODULE_AUTHOR("Texas Instruments Inc.");
 | |
| MODULE_DESCRIPTION("OMAP Control Module USB Driver");
 | |
| MODULE_LICENSE("GPL v2");
 |