Re: [PATCHv12 3/3] usb: typec: add driver for Intel Whiskey Cove PMIC USB Type-C PHY

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On Tue, Nov 22, 2016 at 04:11:47PM +0200, Heikki Krogerus wrote:
> This adds driver for the USB Type-C PHY on Intel WhiskeyCove
> PMIC which is available on some of the Intel Broxton SoC
> based platforms.
> 
> Signed-off-by: Heikki Krogerus <heikki.krogerus@xxxxxxxxxxxxxxx>

LGTM, though I don't really know anything about the chip.
Couple of questions below, otherwise

Reviewed-by: Guenter Roeck <linux@xxxxxxxxxxxx>

> ---
>  drivers/usb/typec/Kconfig       |  14 ++
>  drivers/usb/typec/Makefile      |   1 +
>  drivers/usb/typec/typec_wcove.c | 372 ++++++++++++++++++++++++++++++++++++++++
>  3 files changed, 387 insertions(+)
>  create mode 100644 drivers/usb/typec/typec_wcove.c
> 
> diff --git a/drivers/usb/typec/Kconfig b/drivers/usb/typec/Kconfig
> index 17792f9..2abbcb0 100644
> --- a/drivers/usb/typec/Kconfig
> +++ b/drivers/usb/typec/Kconfig
> @@ -4,4 +4,18 @@ menu "USB Power Delivery and Type-C drivers"
>  config TYPEC
>  	tristate
>  
> +config TYPEC_WCOVE
> +	tristate "Intel WhiskeyCove PMIC USB Type-C PHY driver"
> +	depends on ACPI
> +	depends on INTEL_SOC_PMIC
> +	depends on INTEL_PMC_IPC
> +	select TYPEC
> +	help
> +	  This driver adds support for USB Type-C detection on Intel Broxton
> +	  platforms that have Intel Whiskey Cove PMIC. The driver can detect the
> +	  role and cable orientation.
> +
> +	  To compile this driver as module, choose M here: the module will be
> +	  called typec_wcove
> +
>  endmenu
> diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile
> index 1012a8b..b9cb862 100644
> --- a/drivers/usb/typec/Makefile
> +++ b/drivers/usb/typec/Makefile
> @@ -1 +1,2 @@
>  obj-$(CONFIG_TYPEC)		+= typec.o
> +obj-$(CONFIG_TYPEC_WCOVE)	+= typec_wcove.o
> diff --git a/drivers/usb/typec/typec_wcove.c b/drivers/usb/typec/typec_wcove.c
> new file mode 100644
> index 0000000..953d59b
> --- /dev/null
> +++ b/drivers/usb/typec/typec_wcove.c
> @@ -0,0 +1,372 @@
> +/**
> + * typec_wcove.c - WhiskeyCove PMIC USB Type-C PHY driver
> + *
> + * Copyright (C) 2016 Intel Corporation
> + * Author: Heikki Krogerus <heikki.krogerus@xxxxxxxxxxxxxxx>
> + *
> + * This program is free software; you can redistribute it and/or modify
> + * it under the terms of the GNU General Public License version 2 as
> + * published by the Free Software Foundation.
> + */
> +
> +#include <linux/acpi.h>
> +#include <linux/module.h>
> +#include <linux/interrupt.h>
> +#include <linux/usb/typec.h>
> +#include <linux/platform_device.h>
> +#include <linux/mfd/intel_soc_pmic.h>
> +
> +/* Register offsets */
> +#define WCOVE_CHGRIRQ0		0x4e09
> +#define WCOVE_PHYCTRL		0x5e07
> +
> +#define USBC_CONTROL1		0x7001
> +#define USBC_CONTROL2		0x7002
> +#define USBC_CONTROL3		0x7003
> +#define USBC_CC1_CTRL		0x7004
> +#define USBC_CC2_CTRL		0x7005
> +#define USBC_STATUS1		0x7007
> +#define USBC_STATUS2		0x7008
> +#define USBC_STATUS3		0x7009
> +#define USBC_IRQ1		0x7015
> +#define USBC_IRQ2		0x7016
> +#define USBC_IRQMASK1		0x7017
> +#define USBC_IRQMASK2		0x7018
> +
> +/* Register bits */
> +
> +#define USBC_CONTROL1_MODE_DRP(r)	(((r) & ~0x7) | 4)
> +
> +#define USBC_CONTROL2_UNATT_SNK		BIT(0)
> +#define USBC_CONTROL2_UNATT_SRC		BIT(1)
> +#define USBC_CONTROL2_DIS_ST		BIT(2)
> +
> +#define USBC_CONTROL3_PD_DIS		BIT(1)
> +
> +#define USBC_CC_CTRL_VCONN_EN		BIT(1)
> +
> +#define USBC_STATUS1_DET_ONGOING	BIT(6)
> +#define USBC_STATUS1_RSLT(r)		((r) & 0xf)
> +#define USBC_RSLT_NOTHING		0
> +#define USBC_RSLT_SRC_DEFAULT		1
> +#define USBC_RSLT_SRC_1_5A		2
> +#define USBC_RSLT_SRC_3_0A		3
> +#define USBC_RSLT_SNK			4
> +#define USBC_RSLT_DEBUG_ACC		5
> +#define USBC_RSLT_AUDIO_ACC		6
> +#define USBC_RSLT_UNDEF			15
> +#define USBC_STATUS1_ORIENT(r)		(((r) >> 4) & 0x3)
> +#define USBC_ORIENT_NORMAL		1
> +#define USBC_ORIENT_REVERSE		2
> +
> +#define USBC_STATUS2_VBUS_REQ		BIT(5)
> +
> +#define USBC_IRQ1_ADCDONE1		BIT(2)
> +#define USBC_IRQ1_OVERTEMP		BIT(1)
> +#define USBC_IRQ1_SHORT			BIT(0)
> +
> +#define USBC_IRQ2_CC_CHANGE		BIT(7)
> +#define USBC_IRQ2_RX_PD			BIT(6)
> +#define USBC_IRQ2_RX_HR			BIT(5)
> +#define USBC_IRQ2_RX_CR			BIT(4)
> +#define USBC_IRQ2_TX_SUCCESS		BIT(3)
> +#define USBC_IRQ2_TX_FAIL		BIT(2)
> +
> +#define USBC_IRQMASK1_ALL	(USBC_IRQ1_ADCDONE1 | USBC_IRQ1_OVERTEMP | \
> +				 USBC_IRQ1_SHORT)
> +
> +#define USBC_IRQMASK2_ALL	(USBC_IRQ2_CC_CHANGE | USBC_IRQ2_RX_PD | \
> +				 USBC_IRQ2_RX_HR | USBC_IRQ2_RX_CR | \
> +				 USBC_IRQ2_TX_SUCCESS | USBC_IRQ2_TX_FAIL)
> +
> +struct wcove_typec {
> +	struct mutex lock; /* device lock */
> +	struct device *dev;
> +	struct regmap *regmap;
> +	struct typec_port *port;
> +	struct typec_capability cap;
> +	struct typec_connection con;
> +	struct typec_partner partner;
> +};
> +
> +enum wcove_typec_func {
> +	WCOVE_FUNC_DRIVE_VBUS = 1,
> +	WCOVE_FUNC_ORIENTATION,
> +	WCOVE_FUNC_ROLE,
> +	WCOVE_FUNC_DRIVE_VCONN,
> +};
> +
> +enum wcove_typec_orientation {
> +	WCOVE_ORIENTATION_NORMAL,
> +	WCOVE_ORIENTATION_REVERSE,
> +};
> +
> +enum wcove_typec_role {
> +	WCOVE_ROLE_HOST,
> +	WCOVE_ROLE_DEVICE,
> +};
> +
> +static uuid_le uuid = UUID_LE(0x482383f0, 0x2876, 0x4e49,
> +			      0x86, 0x85, 0xdb, 0x66, 0x21, 0x1a, 0xf0, 0x37);
> +
> +static int wcove_typec_func(struct wcove_typec *wcove,
> +			    enum wcove_typec_func func, int param)
> +{
> +	union acpi_object *obj;
> +	union acpi_object tmp;
> +	union acpi_object argv4 = ACPI_INIT_DSM_ARGV4(1, &tmp);
> +
> +	tmp.type = ACPI_TYPE_INTEGER;
> +	tmp.integer.value = param;
> +
> +	obj = acpi_evaluate_dsm(ACPI_HANDLE(wcove->dev), uuid.b, 1, func,
> +				&argv4);
> +	if (!obj) {
> +		dev_err(wcove->dev, "%s: failed to evaluate _DSM\n", __func__);
> +		return -EIO;
> +	}
> +
> +	ACPI_FREE(obj);
> +	return 0;
> +}
> +
> +static void wcove_typec_device_mode(struct wcove_typec *wcove)
> +{
> +	wcove->con.partner = &wcove->partner;
> +	wcove->con.pwr_role = TYPEC_SINK;
> +	wcove->con.vconn_role = TYPEC_SINK;
> +	wcove_typec_func(wcove, WCOVE_FUNC_ROLE, WCOVE_ROLE_DEVICE);
> +	typec_connect(wcove->port, &wcove->con);
> +}
> +
> +static irqreturn_t wcove_typec_irq(int irq, void *data)
> +{
> +	struct wcove_typec *wcove = data;
> +	unsigned int cc1_ctrl;
> +	unsigned int cc2_ctrl;
> +	unsigned int cc_irq1;
> +	unsigned int cc_irq2;
> +	unsigned int status1;
> +	unsigned int status2;
> +	int ret;
> +
> +	mutex_lock(&wcove->lock);
> +
> +	ret = regmap_read(wcove->regmap, USBC_IRQ1, &cc_irq1);
> +	if (ret)
> +		goto err;
> +
> +	ret = regmap_read(wcove->regmap, USBC_IRQ2, &cc_irq2);
> +	if (ret)
> +		goto err;
> +
> +	ret = regmap_read(wcove->regmap, USBC_STATUS1, &status1);
> +	if (ret)
> +		goto err;
> +
> +	ret = regmap_read(wcove->regmap, USBC_STATUS2, &status2);
> +	if (ret)
> +		goto err;
> +
> +	ret = regmap_read(wcove->regmap, USBC_CC1_CTRL, &cc1_ctrl);
> +	if (ret)
> +		goto err;
> +
> +	ret = regmap_read(wcove->regmap, USBC_CC2_CTRL, &cc2_ctrl);
> +	if (ret)
> +		goto err;
> +
> +	if (cc_irq1) {
> +		if (cc_irq1 & USBC_IRQ1_OVERTEMP)
> +			dev_err(wcove->dev, "VCONN Switch Over Temperature!\n");
> +		if (cc_irq1 & USBC_IRQ1_SHORT)
> +			dev_err(wcove->dev, "VCONN Switch Short Circuit!\n");
> +		ret = regmap_write(wcove->regmap, USBC_IRQ1, cc_irq1);
> +		if (ret)
> +			goto err;
> +	}
> +
> +	if (cc_irq2) {
> +		ret = regmap_write(wcove->regmap, USBC_IRQ2, cc_irq2);
> +		if (ret)
> +			goto err;
> +		/*
> +		 * Ingoring any PD communication interrupts until the PD stack
> +		 * is in place
> +		 */
> +		if (cc_irq2 & ~USBC_IRQ2_CC_CHANGE) {
> +			dev_WARN(wcove->dev, "USB PD handling missing\n");

sure you want this as dev_WARN ?

> +			goto err;
> +		}
> +	}
> +
> +	if (status1 & USBC_STATUS1_DET_ONGOING)
> +		goto out;
> +
> +	if (USBC_STATUS1_RSLT(status1) == USBC_RSLT_NOTHING) {
> +		if (wcove->con.partner) {
> +			typec_disconnect(wcove->port);
> +			memset(&wcove->con, 0, sizeof(wcove->con));
> +			memset(&wcove->partner, 0, sizeof(wcove->partner));
> +		}
> +
> +		wcove_typec_func(wcove, WCOVE_FUNC_ORIENTATION,
> +				 WCOVE_ORIENTATION_NORMAL);
> +		/* Host mode by default */
> +		wcove_typec_func(wcove, WCOVE_FUNC_ROLE, WCOVE_ROLE_HOST);
> +		goto out;
> +	}
> +
> +	if (wcove->con.partner)
> +		goto out;
> +
> +	switch (USBC_STATUS1_ORIENT(status1)) {
> +	case USBC_ORIENT_NORMAL:
> +		wcove_typec_func(wcove, WCOVE_FUNC_ORIENTATION,
> +				 WCOVE_ORIENTATION_NORMAL);
> +		break;
> +	case USBC_ORIENT_REVERSE:
> +		wcove_typec_func(wcove, WCOVE_FUNC_ORIENTATION,
> +				 WCOVE_ORIENTATION_REVERSE);
> +	default:
> +		break;
> +	}
> +
> +	switch (USBC_STATUS1_RSLT(status1)) {
> +	case USBC_RSLT_SRC_DEFAULT:
> +		wcove->con.pwr_opmode = TYPEC_PWR_MODE_USB;
> +		wcove_typec_device_mode(wcove);
> +		break;
> +	case USBC_RSLT_SRC_1_5A:
> +		wcove->con.pwr_opmode = TYPEC_PWR_MODE_1_5A;
> +		wcove_typec_device_mode(wcove);
> +		break;
> +	case USBC_RSLT_SRC_3_0A:
> +		wcove->con.pwr_opmode = TYPEC_PWR_MODE_3_0A;
> +		wcove_typec_device_mode(wcove);
> +		break;
> +	case USBC_RSLT_SNK:
> +		wcove->con.partner = &wcove->partner;
> +		wcove->con.data_role = TYPEC_HOST;
> +		wcove->con.pwr_role = TYPEC_SOURCE;
> +		wcove->con.vconn_role = TYPEC_SOURCE;
> +		wcove_typec_func(wcove, WCOVE_FUNC_ROLE, WCOVE_ROLE_HOST);
> +		typec_connect(wcove->port, &wcove->con);
> +		break;
> +	case USBC_RSLT_DEBUG_ACC:
> +		wcove->partner.accessory = TYPEC_ACCESSORY_DEBUG;
> +		wcove->con.partner = &wcove->partner;
> +		typec_connect(wcove->port, &wcove->con);
> +		break;
> +	case USBC_RSLT_AUDIO_ACC:
> +		wcove->partner.accessory = TYPEC_ACCESSORY_AUDIO;
> +		wcove->con.partner = &wcove->partner;
> +		typec_connect(wcove->port, &wcove->con);
> +		break;
> +	default:
> +		dev_WARN(wcove->dev, "%s Undefined result\n", __func__);
> +		goto err;
> +	}
> +out:
> +	/* If either CC pins is requesting VCONN, we turn it on */
> +	if ((cc1_ctrl & USBC_CC_CTRL_VCONN_EN) ||
> +	    (cc2_ctrl &	USBC_CC_CTRL_VCONN_EN))
> +		wcove_typec_func(wcove, WCOVE_FUNC_DRIVE_VCONN, true);
> +	else
> +		wcove_typec_func(wcove, WCOVE_FUNC_DRIVE_VCONN, false);
> +
> +	/* Relying on the FSM to know when we need to drive VBUS. */
> +	wcove_typec_func(wcove, WCOVE_FUNC_DRIVE_VBUS,
> +			 !!(status2 & USBC_STATUS2_VBUS_REQ));
> +err:
> +	/* REVISIT: Clear WhiskeyCove CHGR Type-C interrupt */
> +	regmap_write(wcove->regmap, WCOVE_CHGRIRQ0, BIT(5));
> +
> +	mutex_unlock(&wcove->lock);
> +	return IRQ_HANDLED;
> +}
> +
> +static int wcove_typec_probe(struct platform_device *pdev)
> +{
> +	struct intel_soc_pmic *pmic = dev_get_drvdata(pdev->dev.parent);
> +	struct wcove_typec *wcove;
> +	unsigned int val;
> +	int ret;
> +
> +	wcove = devm_kzalloc(&pdev->dev, sizeof(*wcove), GFP_KERNEL);
> +	if (!wcove)
> +		return -ENOMEM;
> +
> +	mutex_init(&wcove->lock);
> +	wcove->dev = &pdev->dev;
> +	wcove->regmap = pmic->regmap;
> +
> +	ret = regmap_irq_get_virq(pmic->irq_chip_data_level2,
> +				  platform_get_irq(pdev, 0));
> +	if (ret < 0)
> +		return ret;
> +
> +	ret = devm_request_threaded_irq(&pdev->dev, ret, NULL,
> +					wcove_typec_irq, IRQF_ONESHOT,
> +					"wcove_typec", wcove);
> +	if (ret)
> +		return ret;
> +
> +	if (!acpi_check_dsm(ACPI_HANDLE(&pdev->dev), uuid.b, 0, 0x1f)) {
> +		dev_err(&pdev->dev, "Missing _DSM functions\n");
> +		return -ENODEV;
> +	}
> +
> +	wcove->cap.type = TYPEC_PORT_DRP;
> +
> +	wcove->port = typec_register_port(&pdev->dev, &wcove->cap);
> +	if (IS_ERR(wcove->port))
> +		return PTR_ERR(wcove->port);
> +
> +	/* Make sure the PD PHY is disabled until PD stack is ready */
> +	regmap_read(wcove->regmap, USBC_CONTROL3, &val);
> +	regmap_write(wcove->regmap, USBC_CONTROL3, val | USBC_CONTROL3_PD_DIS);
> +
Should this be done before registering the port ?

> +	/* DRP mode without accessory support */
> +	regmap_read(wcove->regmap, USBC_CONTROL1, &val);
> +	regmap_write(wcove->regmap, USBC_CONTROL1, USBC_CONTROL1_MODE_DRP(val));
> +
> +	/* Unmask everything */
> +	regmap_read(wcove->regmap, USBC_IRQMASK1, &val);
> +	regmap_write(wcove->regmap, USBC_IRQMASK1, val & ~USBC_IRQMASK1_ALL);
> +	regmap_read(wcove->regmap, USBC_IRQMASK2, &val);
> +	regmap_write(wcove->regmap, USBC_IRQMASK2, val & ~USBC_IRQMASK2_ALL);
> +
> +	platform_set_drvdata(pdev, wcove);
> +	return 0;
> +}
> +
> +static int wcove_typec_remove(struct platform_device *pdev)
> +{
> +	struct wcove_typec *wcove = platform_get_drvdata(pdev);
> +	unsigned int val;
> +
> +	/* Mask everything */
> +	regmap_read(wcove->regmap, USBC_IRQMASK1, &val);
> +	regmap_write(wcove->regmap, USBC_IRQMASK1, val | USBC_IRQMASK1_ALL);
> +	regmap_read(wcove->regmap, USBC_IRQMASK2, &val);
> +	regmap_write(wcove->regmap, USBC_IRQMASK2, val | USBC_IRQMASK2_ALL);
> +
> +	typec_unregister_port(wcove->port);
> +	return 0;
> +}
> +
> +static struct platform_driver wcove_typec_driver = {
> +	.driver = {
> +		.name		= "bxt_wcove_usbc",
> +	},
> +	.probe			= wcove_typec_probe,
> +	.remove			= wcove_typec_remove,
> +};
> +
> +module_platform_driver(wcove_typec_driver);
> +
> +MODULE_AUTHOR("Intel Corporation");
> +MODULE_LICENSE("GPL v2");
> +MODULE_DESCRIPTION("WhiskeyCove PMIC USB Type-C PHY driver");
> +MODULE_ALIAS("platform:bxt_wcove_usbc");
> -- 
> 2.10.2
> 
--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html



[Index of Archives]     [Linux Media]     [Linux Input]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [Old Linux USB Devel Archive]

  Powered by Linux