kernel_xiaomi_lancelot/drivers/extcon/mediatek/usb_dual_role.c

/*
 * Copyright (C) 2018 MediaTek Inc.

 * 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.

 * 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 http://www.gnu.org/licenses/gpl-2.0.html for more details.
 */

#include <linux/init.h>
#include <linux/module.h>
#include <linux/device.h>
#include <linux/slab.h>
#include <linux/usb/class-dual-role.h>

#ifdef CONFIG_DUAL_ROLE_USB_INTF
enum dualrole_state {
	DUALROLE_NONE,
	DUALROLE_DEVICE,
	DUALROLE_HOST,
};
static struct dual_role_phy_instance *dr_usb;
static enum dualrole_state state = DUALROLE_NONE;

static enum dual_role_property mt_dual_role_props[] = {
	DUAL_ROLE_PROP_MODE,
	DUAL_ROLE_PROP_PR,
	DUAL_ROLE_PROP_DR,
	/* DUAL_ROLE_PROP_VCONN_SUPPLY, */
};
static int mt_dual_role_get_prop(struct dual_role_phy_instance *dual_role,
	enum dual_role_property prop, unsigned int *val)
{
	int ret = 0;
	int mode, pr, dr;

	if (state == DUALROLE_HOST) {
		mode = DUAL_ROLE_PROP_MODE_DFP;
		pr = DUAL_ROLE_PROP_PR_SRC;
		dr = DUAL_ROLE_PROP_DR_HOST;
	} else if (state == DUALROLE_DEVICE) {
		mode = DUAL_ROLE_PROP_MODE_UFP;
		pr = DUAL_ROLE_PROP_PR_SNK;
		dr = DUAL_ROLE_PROP_DR_DEVICE;
	} else if (state == DUALROLE_NONE) {
		mode = DUAL_ROLE_PROP_MODE_NONE;
		pr = DUAL_ROLE_PROP_PR_NONE;
		dr = DUAL_ROLE_PROP_DR_NONE;
	}

	switch (prop) {
	case DUAL_ROLE_PROP_MODE:
		*val = mode;
		break;
	case DUAL_ROLE_PROP_PR:
		*val = pr;
		break;
	case DUAL_ROLE_PROP_DR:
		*val = dr;
		break;
	case DUAL_ROLE_PROP_VCONN_SUPPLY:
		*val = DUAL_ROLE_PROP_VCONN_SUPPLY_NO;
		break;
	default:
		ret = -EINVAL;
		break;
	}
	return ret;
}

static int mt_dual_role_prop_is_writeable(
	struct dual_role_phy_instance *dual_role, enum dual_role_property prop)
{
	/* not support writeable */
	return 0;
}

static int mt_dual_role_set_prop(struct dual_role_phy_instance *dual_role,
	enum dual_role_property prop, const unsigned int *val)
{
	/* do nothing */
	return 0;
}

static int mt_usb_dual_role_changed(void)
{
	if (dr_usb)
		dual_role_instance_changed(dr_usb);

	return 0;
}
void mt_usb_dual_role_to_none(void)
{
	state = DUALROLE_NONE;
	mt_usb_dual_role_changed();
}
void mt_usb_dual_role_to_device(void)
{
	state = DUALROLE_DEVICE;
	mt_usb_dual_role_changed();
}
void mt_usb_dual_role_to_host(void)
{
	state = DUALROLE_HOST;
	mt_usb_dual_role_changed();
}

int mt_usb_dual_role_init(struct device *dev)
{
	struct dual_role_phy_desc *dual_desc;

	dual_desc = devm_kzalloc(dev, sizeof(*dual_desc),
			GFP_KERNEL);

	if (!dual_desc)
		return -ENOMEM;

	dual_desc->name = "dual-role-usb20";
	dual_desc->supported_modes = DUAL_ROLE_SUPPORTED_MODES_DFP_AND_UFP;
	dual_desc->properties = mt_dual_role_props;
	dual_desc->num_properties = ARRAY_SIZE(mt_dual_role_props);
	dual_desc->get_property = mt_dual_role_get_prop;
	dual_desc->set_property = mt_dual_role_set_prop;
	dual_desc->property_is_writeable = mt_dual_role_prop_is_writeable;

	dr_usb = devm_dual_role_instance_register(dev,
			dual_desc);
	if (IS_ERR(dr_usb)) {
		dev_info(dev, "fail to register dual role usb\n");
		return -EINVAL;
	}
	return 0;
}
#endif /* CONFIG_DUAL_ROLE_USB_INTF */