brintos

brintos / linux-shallow public Read only

0
0
Text · 16.9 KiB · ad2eec0 Raw
684 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * phy-brcm-usb.c - Broadcom USB Phy Driver4 *5 * Copyright (C) 2015-2017 Broadcom6 */7 8#include <linux/clk.h>9#include <linux/delay.h>10#include <linux/err.h>11#include <linux/io.h>12#include <linux/module.h>13#include <linux/of.h>14#include <linux/phy/phy.h>15#include <linux/platform_device.h>16#include <linux/interrupt.h>17#include <linux/soc/brcmstb/brcmstb.h>18#include <dt-bindings/phy/phy.h>19#include <linux/mfd/syscon.h>20#include <linux/suspend.h>21 22#include "phy-brcm-usb-init.h"23 24static DEFINE_MUTEX(sysfs_lock);25 26enum brcm_usb_phy_id {27	BRCM_USB_PHY_2_0 = 0,28	BRCM_USB_PHY_3_0,29	BRCM_USB_PHY_ID_MAX30};31 32struct value_to_name_map {33	int value;34	const char *name;35};36 37struct match_chip_info {38	void (*init_func)(struct brcm_usb_init_params *params);39	u8 required_regs[BRCM_REGS_MAX + 1];40	u8 optional_reg;41};42 43static const struct value_to_name_map brcm_dr_mode_to_name[] = {44	{ USB_CTLR_MODE_HOST, "host" },45	{ USB_CTLR_MODE_DEVICE, "peripheral" },46	{ USB_CTLR_MODE_DRD, "drd" },47	{ USB_CTLR_MODE_TYPEC_PD, "typec-pd" }48};49 50static const struct value_to_name_map brcm_dual_mode_to_name[] = {51	{ 0, "host" },52	{ 1, "device" },53	{ 2, "auto" },54};55 56struct brcm_usb_phy {57	struct phy *phy;58	unsigned int id;59	bool inited;60};61 62struct brcm_usb_phy_data {63	struct  brcm_usb_init_params ini;64	bool			has_eohci;65	bool			has_xhci;66	struct clk		*usb_20_clk;67	struct clk		*usb_30_clk;68	struct clk		*suspend_clk;69	struct mutex		mutex;	/* serialize phy init */70	int			init_count;71	int			wake_irq;72	struct brcm_usb_phy	phys[BRCM_USB_PHY_ID_MAX];73	struct notifier_block	pm_notifier;74	bool			pm_active;75};76 77static s8 *node_reg_names[BRCM_REGS_MAX] = {78	"crtl", "xhci_ec", "xhci_gbl", "usb_phy", "usb_mdio", "bdc_ec"79};80 81static int brcm_pm_notifier(struct notifier_block *notifier,82			    unsigned long pm_event,83			    void *unused)84{85	struct brcm_usb_phy_data *priv =86		container_of(notifier, struct brcm_usb_phy_data, pm_notifier);87 88	switch (pm_event) {89	case PM_HIBERNATION_PREPARE:90	case PM_SUSPEND_PREPARE:91		priv->pm_active = true;92		break;93	case PM_POST_RESTORE:94	case PM_POST_HIBERNATION:95	case PM_POST_SUSPEND:96		priv->pm_active = false;97		break;98	}99	return NOTIFY_DONE;100}101 102static irqreturn_t brcm_usb_phy_wake_isr(int irq, void *dev_id)103{104	struct device *dev = dev_id;105 106	pm_wakeup_event(dev, 0);107 108	return IRQ_HANDLED;109}110 111static int brcm_usb_phy_init(struct phy *gphy)112{113	struct brcm_usb_phy *phy = phy_get_drvdata(gphy);114	struct brcm_usb_phy_data *priv =115		container_of(phy, struct brcm_usb_phy_data, phys[phy->id]);116 117	if (priv->pm_active)118		return 0;119 120	/*121	 * Use a lock to make sure a second caller waits until122	 * the base phy is inited before using it.123	 */124	mutex_lock(&priv->mutex);125	if (priv->init_count++ == 0) {126		clk_prepare_enable(priv->usb_20_clk);127		clk_prepare_enable(priv->usb_30_clk);128		clk_prepare_enable(priv->suspend_clk);129		brcm_usb_init_common(&priv->ini);130	}131	mutex_unlock(&priv->mutex);132	if (phy->id == BRCM_USB_PHY_2_0)133		brcm_usb_init_eohci(&priv->ini);134	else if (phy->id == BRCM_USB_PHY_3_0)135		brcm_usb_init_xhci(&priv->ini);136	phy->inited = true;137	dev_dbg(&gphy->dev, "INIT, id: %d, total: %d\n", phy->id,138		priv->init_count);139 140	return 0;141}142 143static int brcm_usb_phy_exit(struct phy *gphy)144{145	struct brcm_usb_phy *phy = phy_get_drvdata(gphy);146	struct brcm_usb_phy_data *priv =147		container_of(phy, struct brcm_usb_phy_data, phys[phy->id]);148 149	if (priv->pm_active)150		return 0;151 152	dev_dbg(&gphy->dev, "EXIT\n");153	if (phy->id == BRCM_USB_PHY_2_0)154		brcm_usb_uninit_eohci(&priv->ini);155	if (phy->id == BRCM_USB_PHY_3_0)156		brcm_usb_uninit_xhci(&priv->ini);157 158	/* If both xhci and eohci are gone, reset everything else */159	mutex_lock(&priv->mutex);160	if (--priv->init_count == 0) {161		brcm_usb_uninit_common(&priv->ini);162		clk_disable_unprepare(priv->usb_20_clk);163		clk_disable_unprepare(priv->usb_30_clk);164		clk_disable_unprepare(priv->suspend_clk);165	}166	mutex_unlock(&priv->mutex);167	phy->inited = false;168	return 0;169}170 171static const struct phy_ops brcm_usb_phy_ops = {172	.init		= brcm_usb_phy_init,173	.exit		= brcm_usb_phy_exit,174	.owner		= THIS_MODULE,175};176 177static struct phy *brcm_usb_phy_xlate(struct device *dev,178				      const struct of_phandle_args *args)179{180	struct brcm_usb_phy_data *data = dev_get_drvdata(dev);181 182	/*183	 * values 0 and 1 are for backward compatibility with184	 * device tree nodes from older bootloaders.185	 */186	switch (args->args[0]) {187	case 0:188	case PHY_TYPE_USB2:189		if (data->phys[BRCM_USB_PHY_2_0].phy)190			return data->phys[BRCM_USB_PHY_2_0].phy;191		dev_warn(dev, "Error, 2.0 Phy not found\n");192		break;193	case 1:194	case PHY_TYPE_USB3:195		if (data->phys[BRCM_USB_PHY_3_0].phy)196			return data->phys[BRCM_USB_PHY_3_0].phy;197		dev_warn(dev, "Error, 3.0 Phy not found\n");198		break;199	}200	return ERR_PTR(-ENODEV);201}202 203static int name_to_value(const struct value_to_name_map *table, int count,204			 const char *name, int *value)205{206	int x;207 208	*value = 0;209	for (x = 0; x < count; x++) {210		if (sysfs_streq(name, table[x].name)) {211			*value = x;212			return 0;213		}214	}215	return -EINVAL;216}217 218static const char *value_to_name(const struct value_to_name_map *table, int count,219				 int value)220{221	if (value >= count)222		return "unknown";223	return table[value].name;224}225 226static ssize_t dr_mode_show(struct device *dev,227			    struct device_attribute *attr,228			    char *buf)229{230	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);231 232	return sprintf(buf, "%s\n",233		value_to_name(&brcm_dr_mode_to_name[0],234			      ARRAY_SIZE(brcm_dr_mode_to_name),235			      priv->ini.supported_port_modes));236}237static DEVICE_ATTR_RO(dr_mode);238 239static ssize_t dual_select_store(struct device *dev,240				 struct device_attribute *attr,241				 const char *buf, size_t len)242{243	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);244	int value;245	int res;246 247	mutex_lock(&sysfs_lock);248	res = name_to_value(&brcm_dual_mode_to_name[0],249			    ARRAY_SIZE(brcm_dual_mode_to_name), buf, &value);250	if (!res) {251		priv->ini.port_mode = value;252		brcm_usb_set_dual_select(&priv->ini);253		res = len;254	}255	mutex_unlock(&sysfs_lock);256	return res;257}258 259static ssize_t dual_select_show(struct device *dev,260				struct device_attribute *attr,261				char *buf)262{263	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);264	int value;265 266	mutex_lock(&sysfs_lock);267	value = brcm_usb_get_dual_select(&priv->ini);268	mutex_unlock(&sysfs_lock);269	return sprintf(buf, "%s\n",270		value_to_name(&brcm_dual_mode_to_name[0],271			      ARRAY_SIZE(brcm_dual_mode_to_name),272			      value));273}274static DEVICE_ATTR_RW(dual_select);275 276static struct attribute *brcm_usb_phy_attrs[] = {277	&dev_attr_dr_mode.attr,278	&dev_attr_dual_select.attr,279	NULL280};281 282static const struct attribute_group brcm_usb_phy_group = {283	.attrs = brcm_usb_phy_attrs,284};285 286static const struct match_chip_info chip_info_4908 = {287	.init_func = &brcm_usb_dvr_init_4908,288	.required_regs = {289		BRCM_REGS_CTRL,290		BRCM_REGS_XHCI_EC,291		-1,292	},293};294 295static const struct match_chip_info chip_info_7216 = {296	.init_func = &brcm_usb_dvr_init_7216,297	.required_regs = {298		BRCM_REGS_CTRL,299		BRCM_REGS_XHCI_EC,300		BRCM_REGS_XHCI_GBL,301		-1,302	},303};304 305static const struct match_chip_info chip_info_7211b0 = {306	.init_func = &brcm_usb_dvr_init_7211b0,307	.required_regs = {308		BRCM_REGS_CTRL,309		BRCM_REGS_XHCI_EC,310		BRCM_REGS_XHCI_GBL,311		BRCM_REGS_USB_PHY,312		BRCM_REGS_USB_MDIO,313		-1,314	},315	.optional_reg = BRCM_REGS_BDC_EC,316};317 318static const struct match_chip_info chip_info_7445 = {319	.init_func = &brcm_usb_dvr_init_7445,320	.required_regs = {321		BRCM_REGS_CTRL,322		BRCM_REGS_XHCI_EC,323		-1,324	},325};326 327static const struct of_device_id brcm_usb_dt_ids[] = {328	{329		.compatible = "brcm,bcm4908-usb-phy",330		.data = &chip_info_4908,331	},332	{333		.compatible = "brcm,bcm7216-usb-phy",334		.data = &chip_info_7216,335	},336	{337		.compatible = "brcm,bcm7211-usb-phy",338		.data = &chip_info_7211b0,339	},340	{341		.compatible = "brcm,brcmstb-usb-phy",342		.data = &chip_info_7445,343	},344	{ /* sentinel */ }345};346 347static int brcm_usb_get_regs(struct platform_device *pdev,348			     enum brcmusb_reg_sel regs,349			     struct  brcm_usb_init_params *ini,350			     bool optional)351{352	struct resource *res;353 354	/* Older DT nodes have ctrl and optional xhci_ec by index only */355	res = platform_get_resource_byname(pdev, IORESOURCE_MEM,356						node_reg_names[regs]);357	if (res == NULL) {358		if (regs == BRCM_REGS_CTRL) {359			res = platform_get_resource(pdev, IORESOURCE_MEM, 0);360		} else if (regs == BRCM_REGS_XHCI_EC) {361			res = platform_get_resource(pdev, IORESOURCE_MEM, 1);362			/* XHCI_EC registers are optional */363			if (res == NULL)364				return 0;365		}366		if (res == NULL) {367			if (optional) {368				dev_dbg(&pdev->dev,369					"Optional reg %s not found\n",370					node_reg_names[regs]);371				return 0;372			}373			dev_err(&pdev->dev, "can't get %s base addr\n",374				node_reg_names[regs]);375			return 1;376		}377	}378	ini->regs[regs] = devm_ioremap_resource(&pdev->dev, res);379	if (IS_ERR(ini->regs[regs])) {380		dev_err(&pdev->dev, "can't map %s register space\n",381			node_reg_names[regs]);382		return 1;383	}384	return 0;385}386 387static int brcm_usb_phy_dvr_init(struct platform_device *pdev,388				 struct brcm_usb_phy_data *priv,389				 struct device_node *dn)390{391	struct device *dev = &pdev->dev;392	struct phy *gphy = NULL;393	int err;394 395	priv->usb_20_clk = of_clk_get_by_name(dn, "sw_usb");396	if (IS_ERR(priv->usb_20_clk)) {397		if (PTR_ERR(priv->usb_20_clk) == -EPROBE_DEFER)398			return -EPROBE_DEFER;399		dev_info(dev, "Clock not found in Device Tree\n");400		priv->usb_20_clk = NULL;401	}402	err = clk_prepare_enable(priv->usb_20_clk);403	if (err)404		return err;405 406	if (priv->has_eohci) {407		gphy = devm_phy_create(dev, NULL, &brcm_usb_phy_ops);408		if (IS_ERR(gphy)) {409			dev_err(dev, "failed to create EHCI/OHCI PHY\n");410			return PTR_ERR(gphy);411		}412		priv->phys[BRCM_USB_PHY_2_0].phy = gphy;413		priv->phys[BRCM_USB_PHY_2_0].id = BRCM_USB_PHY_2_0;414		phy_set_drvdata(gphy, &priv->phys[BRCM_USB_PHY_2_0]);415	}416 417	if (priv->has_xhci) {418		gphy = devm_phy_create(dev, NULL, &brcm_usb_phy_ops);419		if (IS_ERR(gphy)) {420			dev_err(dev, "failed to create XHCI PHY\n");421			return PTR_ERR(gphy);422		}423		priv->phys[BRCM_USB_PHY_3_0].phy = gphy;424		priv->phys[BRCM_USB_PHY_3_0].id = BRCM_USB_PHY_3_0;425		phy_set_drvdata(gphy, &priv->phys[BRCM_USB_PHY_3_0]);426 427		priv->usb_30_clk = of_clk_get_by_name(dn, "sw_usb3");428		if (IS_ERR(priv->usb_30_clk)) {429			if (PTR_ERR(priv->usb_30_clk) == -EPROBE_DEFER)430				return -EPROBE_DEFER;431			dev_info(dev,432				 "USB3.0 clock not found in Device Tree\n");433			priv->usb_30_clk = NULL;434		}435		err = clk_prepare_enable(priv->usb_30_clk);436		if (err)437			return err;438	}439 440	priv->suspend_clk = clk_get(dev, "usb0_freerun");441	if (IS_ERR(priv->suspend_clk)) {442		if (PTR_ERR(priv->suspend_clk) == -EPROBE_DEFER)443			return -EPROBE_DEFER;444		dev_err(dev, "Suspend Clock not found in Device Tree\n");445		priv->suspend_clk = NULL;446	}447 448	priv->wake_irq = platform_get_irq_byname_optional(pdev, "wake");449	if (priv->wake_irq < 0)450		priv->wake_irq = platform_get_irq_byname_optional(pdev, "wakeup");451	if (priv->wake_irq >= 0) {452		err = devm_request_irq(dev, priv->wake_irq,453				       brcm_usb_phy_wake_isr, 0,454				       dev_name(dev), dev);455		if (err < 0)456			return err;457		device_set_wakeup_capable(dev, 1);458	} else {459		dev_info(dev,460			 "Wake interrupt missing, system wake not supported\n");461	}462 463	return 0;464}465 466static int brcm_usb_phy_probe(struct platform_device *pdev)467{468	struct device *dev = &pdev->dev;469	struct brcm_usb_phy_data *priv;470	struct phy_provider *phy_provider;471	struct device_node *dn = pdev->dev.of_node;472	int err;473	const char *mode;474	const struct match_chip_info *info;475	struct regmap *rmap;476	int x;477 478	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);479	if (!priv)480		return -ENOMEM;481	platform_set_drvdata(pdev, priv);482 483	priv->ini.family_id = brcmstb_get_family_id();484	priv->ini.product_id = brcmstb_get_product_id();485 486	info = of_device_get_match_data(&pdev->dev);487	if (!info)488		return -ENOENT;489 490	info->init_func(&priv->ini);491 492	dev_dbg(dev, "Best mapping table is for %s\n",493		priv->ini.family_name);494 495	of_property_read_u32(dn, "brcm,ipp", &priv->ini.ipp);496	of_property_read_u32(dn, "brcm,ioc", &priv->ini.ioc);497 498	priv->ini.supported_port_modes = USB_CTLR_MODE_HOST;499	err = of_property_read_string(dn, "dr_mode", &mode);500	if (err == 0) {501		name_to_value(&brcm_dr_mode_to_name[0],502			      ARRAY_SIZE(brcm_dr_mode_to_name),503			mode, &priv->ini.supported_port_modes);504	}505	/* Default port_mode to supported port_modes */506	priv->ini.port_mode = priv->ini.supported_port_modes;507 508	if (of_property_read_bool(dn, "brcm,has-xhci"))509		priv->has_xhci = true;510	if (of_property_read_bool(dn, "brcm,has-eohci"))511		priv->has_eohci = true;512 513	for (x = 0; x < BRCM_REGS_MAX; x++) {514		if (info->required_regs[x] >= BRCM_REGS_MAX)515			break;516 517		err = brcm_usb_get_regs(pdev, info->required_regs[x],518					&priv->ini, false);519		if (err)520			return -EINVAL;521	}522	if (info->optional_reg) {523		err = brcm_usb_get_regs(pdev, info->optional_reg,524					&priv->ini, true);525		if (err)526			return -EINVAL;527	}528 529	err = brcm_usb_phy_dvr_init(pdev, priv, dn);530	if (err)531		return err;532 533	priv->pm_notifier.notifier_call = brcm_pm_notifier;534	register_pm_notifier(&priv->pm_notifier);535 536	mutex_init(&priv->mutex);537 538	/* make sure invert settings are correct */539	brcm_usb_init_ipp(&priv->ini);540 541	/*542	 * Create sysfs entries for mode.543	 * Remove "dual_select" attribute if not in dual mode544	 */545	if (priv->ini.supported_port_modes != USB_CTLR_MODE_DRD)546		brcm_usb_phy_attrs[1] = NULL;547	err = sysfs_create_group(&dev->kobj, &brcm_usb_phy_group);548	if (err)549		dev_warn(dev, "Error creating sysfs attributes\n");550 551	/* Get piarbctl syscon if it exists */552	rmap = syscon_regmap_lookup_by_phandle(dev->of_node,553						 "syscon-piarbctl");554	if (IS_ERR(rmap))555		rmap = syscon_regmap_lookup_by_phandle(dev->of_node,556						       "brcm,syscon-piarbctl");557	if (!IS_ERR(rmap))558		priv->ini.syscon_piarbctl = rmap;559 560	/* start with everything off */561	if (priv->has_xhci)562		brcm_usb_uninit_xhci(&priv->ini);563	if (priv->has_eohci)564		brcm_usb_uninit_eohci(&priv->ini);565	brcm_usb_uninit_common(&priv->ini);566	clk_disable_unprepare(priv->usb_20_clk);567	clk_disable_unprepare(priv->usb_30_clk);568 569	phy_provider = devm_of_phy_provider_register(dev, brcm_usb_phy_xlate);570 571	return PTR_ERR_OR_ZERO(phy_provider);572}573 574static void brcm_usb_phy_remove(struct platform_device *pdev)575{576	struct brcm_usb_phy_data *priv = dev_get_drvdata(&pdev->dev);577 578	sysfs_remove_group(&pdev->dev.kobj, &brcm_usb_phy_group);579	unregister_pm_notifier(&priv->pm_notifier);580}581 582#ifdef CONFIG_PM_SLEEP583static int brcm_usb_phy_suspend(struct device *dev)584{585	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);586 587	if (priv->init_count) {588		dev_dbg(dev, "SUSPEND\n");589		priv->ini.wake_enabled = device_may_wakeup(dev);590		if (priv->phys[BRCM_USB_PHY_3_0].inited)591			brcm_usb_uninit_xhci(&priv->ini);592		if (priv->phys[BRCM_USB_PHY_2_0].inited)593			brcm_usb_uninit_eohci(&priv->ini);594		brcm_usb_uninit_common(&priv->ini);595 596		/*597		 * Handle the clocks unless needed for wake. This has598		 * to work for both older XHCI->3.0-clks, EOHCI->2.0-clks599		 * and newer XHCI->2.0-clks/3.0-clks.600		 */601 602		if (!priv->ini.wake_enabled) {603			if (priv->phys[BRCM_USB_PHY_3_0].inited)604				clk_disable_unprepare(priv->usb_30_clk);605			if (priv->phys[BRCM_USB_PHY_2_0].inited ||606			    !priv->has_eohci)607				clk_disable_unprepare(priv->usb_20_clk);608		}609		if (priv->wake_irq >= 0)610			enable_irq_wake(priv->wake_irq);611	}612	return 0;613}614 615static int brcm_usb_phy_resume(struct device *dev)616{617	struct brcm_usb_phy_data *priv = dev_get_drvdata(dev);618 619	if (!priv->ini.wake_enabled) {620		clk_prepare_enable(priv->usb_20_clk);621		clk_prepare_enable(priv->usb_30_clk);622	}623	brcm_usb_init_ipp(&priv->ini);624 625	/*626	 * Initialize anything that was previously initialized.627	 * Uninitialize anything that wasn't previously initialized.628	 */629	if (priv->init_count) {630		dev_dbg(dev, "RESUME\n");631		if (priv->wake_irq >= 0)632			disable_irq_wake(priv->wake_irq);633		brcm_usb_init_common(&priv->ini);634		if (priv->phys[BRCM_USB_PHY_2_0].inited) {635			brcm_usb_init_eohci(&priv->ini);636		} else if (priv->has_eohci) {637			brcm_usb_uninit_eohci(&priv->ini);638			clk_disable_unprepare(priv->usb_20_clk);639		}640		if (priv->phys[BRCM_USB_PHY_3_0].inited) {641			brcm_usb_init_xhci(&priv->ini);642		} else if (priv->has_xhci) {643			brcm_usb_uninit_xhci(&priv->ini);644			clk_disable_unprepare(priv->usb_30_clk);645			if (!priv->has_eohci)646				clk_disable_unprepare(priv->usb_20_clk);647		}648	} else {649		if (priv->has_xhci)650			brcm_usb_uninit_xhci(&priv->ini);651		if (priv->has_eohci)652			brcm_usb_uninit_eohci(&priv->ini);653		brcm_usb_uninit_common(&priv->ini);654		clk_disable_unprepare(priv->usb_20_clk);655		clk_disable_unprepare(priv->usb_30_clk);656	}657	priv->ini.wake_enabled = false;658	return 0;659}660#endif /* CONFIG_PM_SLEEP */661 662static const struct dev_pm_ops brcm_usb_phy_pm_ops = {663	SET_LATE_SYSTEM_SLEEP_PM_OPS(brcm_usb_phy_suspend, brcm_usb_phy_resume)664};665 666MODULE_DEVICE_TABLE(of, brcm_usb_dt_ids);667 668static struct platform_driver brcm_usb_driver = {669	.probe		= brcm_usb_phy_probe,670	.remove_new	= brcm_usb_phy_remove,671	.driver		= {672		.name	= "brcmstb-usb-phy",673		.pm = &brcm_usb_phy_pm_ops,674		.of_match_table = brcm_usb_dt_ids,675	},676};677 678module_platform_driver(brcm_usb_driver);679 680MODULE_ALIAS("platform:brcmstb-usb-phy");681MODULE_AUTHOR("Al Cooper <acooper@broadcom.com>");682MODULE_DESCRIPTION("BRCM USB PHY driver");683MODULE_LICENSE("GPL v2");684