drivers/extcon/extcon-fsa9480.c - kernel/common - Git at Google

 // SPDX-License-Identifier: GPL-2.0+
 /*
  * extcon-fsa9480.c - Fairchild Semiconductor FSA9480 extcon driver
  *
  * Copyright (c) 2019 Tomasz Figa <[email protected]>
  *
  * Loosely based on old fsa9480 misc-device driver.
  */

 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/types.h>
 #include <linux/i2c.h>
 #include <linux/slab.h>
 #include <linux/bitops.h>
 #include <linux/interrupt.h>
 #include <linux/err.h>
 #include <linux/platform_device.h>
 #include <linux/kobject.h>
 #include <linux/extcon-provider.h>
 #include <linux/irqdomain.h>
 #include <linux/regmap.h>

 /* FSA9480 I2C registers */
 #define FSA9480_REG_DEVID               0x01
 #define FSA9480_REG_CTRL                0x02
 #define FSA9480_REG_INT1                0x03
 #define FSA9480_REG_INT2                0x04
 #define FSA9480_REG_INT1_MASK           0x05
 #define FSA9480_REG_INT2_MASK           0x06
 #define FSA9480_REG_ADC                 0x07
 #define FSA9480_REG_TIMING1             0x08
 #define FSA9480_REG_TIMING2             0x09
 #define FSA9480_REG_DEV_T1              0x0a
 #define FSA9480_REG_DEV_T2              0x0b
 #define FSA9480_REG_BTN1                0x0c
 #define FSA9480_REG_BTN2                0x0d
 #define FSA9480_REG_CK                  0x0e
 #define FSA9480_REG_CK_INT1             0x0f
 #define FSA9480_REG_CK_INT2             0x10
 #define FSA9480_REG_CK_INTMASK1         0x11
 #define FSA9480_REG_CK_INTMASK2         0x12
 #define FSA9480_REG_MANSW1              0x13
 #define FSA9480_REG_MANSW2              0x14
 #define FSA9480_REG_END                 0x15

 /* Control */
 #define CON_SWITCH_OPEN         (1 << 4)
 #define CON_RAW_DATA            (1 << 3)
 #define CON_MANUAL_SW           (1 << 2)
 #define CON_WAIT                (1 << 1)
 #define CON_INT_MASK            (1 << 0)
 #define CON_MASK                (CON_SWITCH_OPEN | CON_RAW_DATA | \
 				 CON_MANUAL_SW | CON_WAIT)

 /* Device Type 1 */
 #define DEV_USB_OTG             7
 #define DEV_DEDICATED_CHG       6
 #define DEV_USB_CHG             5
 #define DEV_CAR_KIT             4
 #define DEV_UART                3
 #define DEV_USB                 2
 #define DEV_AUDIO_2             1
 #define DEV_AUDIO_1             0

 #define DEV_T1_USB_MASK         (DEV_USB_OTG | DEV_USB)
 #define DEV_T1_UART_MASK        (DEV_UART)
 #define DEV_T1_CHARGER_MASK     (DEV_DEDICATED_CHG | DEV_USB_CHG)

 /* Device Type 2 */
 #define DEV_AV                  14
 #define DEV_TTY                 13
 #define DEV_PPD                 12
 #define DEV_JIG_UART_OFF        11
 #define DEV_JIG_UART_ON         10
 #define DEV_JIG_USB_OFF         9
 #define DEV_JIG_USB_ON          8

 #define DEV_T2_USB_MASK         (DEV_JIG_USB_OFF | DEV_JIG_USB_ON)
 #define DEV_T2_UART_MASK        (DEV_JIG_UART_OFF | DEV_JIG_UART_ON)
 #define DEV_T2_JIG_MASK         (DEV_JIG_USB_OFF | DEV_JIG_USB_ON | \
 				 DEV_JIG_UART_OFF | DEV_JIG_UART_ON)

 /*
  * Manual Switch
  * D- [7:5] / D+ [4:2]
  * 000: Open all / 001: USB / 010: AUDIO / 011: UART / 100: V_AUDIO
  */
 #define SW_VAUDIO               ((4 << 5) | (4 << 2))
 #define SW_UART                 ((3 << 5) | (3 << 2))
 #define SW_AUDIO                ((2 << 5) | (2 << 2))
 #define SW_DHOST                ((1 << 5) | (1 << 2))
 #define SW_AUTO                 ((0 << 5) | (0 << 2))

 /* Interrupt 1 */
 #define INT1_MASK               (0xff << 0)
 #define INT_DETACH              (1 << 1)
 #define INT_ATTACH              (1 << 0)

 /* Interrupt 2 mask */
 #define INT2_MASK               (0x1f << 0)

 /* Timing Set 1 */
 #define TIMING1_ADC_500MS       (0x6 << 0)

 struct fsa9480_usbsw {
 	struct device *dev;
 	struct regmap *regmap;
 	struct extcon_dev *edev;
 	u16 cable;
 };

 static const unsigned int fsa9480_extcon_cable[] = {
 	EXTCON_USB_HOST,
 	EXTCON_USB,
 	EXTCON_CHG_USB_DCP,
 	EXTCON_CHG_USB_SDP,
 	EXTCON_CHG_USB_ACA,
 	EXTCON_JACK_LINE_OUT,
 	EXTCON_JACK_VIDEO_OUT,
 	EXTCON_JIG,

 	EXTCON_NONE,
 };

 static const u64 cable_types[] = {
 	[DEV_USB_OTG] = BIT_ULL(EXTCON_USB_HOST),
 	[DEV_DEDICATED_CHG] = BIT_ULL(EXTCON_USB) | BIT_ULL(EXTCON_CHG_USB_DCP),
 	[DEV_USB_CHG] = BIT_ULL(EXTCON_USB) | BIT_ULL(EXTCON_CHG_USB_SDP),
 	[DEV_CAR_KIT] = BIT_ULL(EXTCON_USB) | BIT_ULL(EXTCON_CHG_USB_SDP)
 			| BIT_ULL(EXTCON_JACK_LINE_OUT),
 	[DEV_UART] = BIT_ULL(EXTCON_JIG),
 	[DEV_USB] = BIT_ULL(EXTCON_USB) | BIT_ULL(EXTCON_CHG_USB_SDP),
 	[DEV_AUDIO_2] = BIT_ULL(EXTCON_JACK_LINE_OUT),
 	[DEV_AUDIO_1] = BIT_ULL(EXTCON_JACK_LINE_OUT),
 	[DEV_AV] = BIT_ULL(EXTCON_JACK_LINE_OUT)
 		   | BIT_ULL(EXTCON_JACK_VIDEO_OUT),
 	[DEV_TTY] = BIT_ULL(EXTCON_JIG),
 	[DEV_PPD] = BIT_ULL(EXTCON_JACK_LINE_OUT) | BIT_ULL(EXTCON_CHG_USB_ACA),
 	[DEV_JIG_UART_OFF] = BIT_ULL(EXTCON_JIG),
 	[DEV_JIG_UART_ON] = BIT_ULL(EXTCON_JIG),
 	[DEV_JIG_USB_OFF] = BIT_ULL(EXTCON_USB) | BIT_ULL(EXTCON_JIG),
 	[DEV_JIG_USB_ON] = BIT_ULL(EXTCON_USB) | BIT_ULL(EXTCON_JIG),
 };

 /* Define regmap configuration of FSA9480 for I2C communication  */
 static bool fsa9480_volatile_reg(struct device *dev, unsigned int reg)
 {
 	switch (reg) {
 	case FSA9480_REG_INT1_MASK:
 		return true;
 	default:
 		break;
 	}
 	return false;
 }

 static const struct regmap_config fsa9480_regmap_config = {
 	.reg_bits	= 8,
 	.val_bits	= 8,
 	.volatile_reg	= fsa9480_volatile_reg,
 	.max_register	= FSA9480_REG_END,
 };

 static int fsa9480_write_reg(struct fsa9480_usbsw *usbsw, int reg, int value)
 {
 	int ret;

 	ret = regmap_write(usbsw->regmap, reg, value);
 	if (ret < 0)
 		dev_err(usbsw->dev, "%s: err %d\n", __func__, ret);

 	return ret;
 }

 static int fsa9480_read_reg(struct fsa9480_usbsw *usbsw, int reg)
 {
 	int ret, val;

 	ret = regmap_read(usbsw->regmap, reg, &val);
 	if (ret < 0) {
 		dev_err(usbsw->dev, "%s: err %d\n", __func__, ret);
 		return ret;
 	}

 	return val;
 }

 static int fsa9480_read_irq(struct fsa9480_usbsw *usbsw, int *value)
 {
 	u8 regs[2];
 	int ret;

 	ret = regmap_bulk_read(usbsw->regmap, FSA9480_REG_INT1, regs, 2);
 	if (ret < 0)
 		dev_err(usbsw->dev, "%s: err %d\n", __func__, ret);

 	*value = regs[1] << 8 | regs[0];
 	return ret;
 }

 static void fsa9480_handle_change(struct fsa9480_usbsw *usbsw,
 				  u16 mask, bool attached)
 {
 	while (mask) {
 		int dev = fls64(mask) - 1;
 		u64 cables = cable_types[dev];

 		while (cables) {
 			int cable = fls64(cables) - 1;

 			extcon_set_state_sync(usbsw->edev, cable, attached);
 			cables &= ~BIT_ULL(cable);
 		}

 		mask &= ~BIT_ULL(dev);
 	}
 }

 static void fsa9480_detect_dev(struct fsa9480_usbsw *usbsw)
 {
 	int val1, val2;
 	u16 val;

 	val1 = fsa9480_read_reg(usbsw, FSA9480_REG_DEV_T1);
 	val2 = fsa9480_read_reg(usbsw, FSA9480_REG_DEV_T2);
 	if (val1 < 0 || val2 < 0) {
 		dev_err(usbsw->dev, "%s: failed to read registers", __func__);
 		return;
 	}
 	val = val2 << 8 | val1;

 	dev_info(usbsw->dev, "dev1: 0x%x, dev2: 0x%x\n", val1, val2);

 	/* handle detached cables first */
 	fsa9480_handle_change(usbsw, usbsw->cable & ~val, false);

 	/* then handle attached ones */
 	fsa9480_handle_change(usbsw, val & ~usbsw->cable, true);

 	usbsw->cable = val;
 }

 static irqreturn_t fsa9480_irq_handler(int irq, void *data)
 {
 	struct fsa9480_usbsw *usbsw = data;
 	int intr = 0;

 	/* clear interrupt */
 	fsa9480_read_irq(usbsw, &intr);
 	if (!intr)
 		return IRQ_NONE;

 	/* device detection */
 	fsa9480_detect_dev(usbsw);

 	return IRQ_HANDLED;
 }

 static int fsa9480_probe(struct i2c_client *client,
 			 const struct i2c_device_id *id)
 {
 	struct fsa9480_usbsw *info;
 	int ret;

 	if (!client->irq) {
 		dev_err(&client->dev, "no interrupt provided\n");
 		return -EINVAL;
 	}

 	info = devm_kzalloc(&client->dev, sizeof(*info), GFP_KERNEL);
 	if (!info)
 		return -ENOMEM;
 	info->dev = &client->dev;

 	i2c_set_clientdata(client, info);

 	/* External connector */
 	info->edev = devm_extcon_dev_allocate(info->dev,
 					      fsa9480_extcon_cable);
 	if (IS_ERR(info->edev)) {
 		dev_err(info->dev, "failed to allocate memory for extcon\n");
 		ret = -ENOMEM;
 		return ret;
 	}

 	ret = devm_extcon_dev_register(info->dev, info->edev);
 	if (ret) {
 		dev_err(info->dev, "failed to register extcon device\n");
 		return ret;
 	}

 	info->regmap = devm_regmap_init_i2c(client, &fsa9480_regmap_config);
 	if (IS_ERR(info->regmap)) {
 		ret = PTR_ERR(info->regmap);
 		dev_err(info->dev, "failed to allocate register map: %d\n",
 			ret);
 		return ret;
 	}

 	/* ADC Detect Time: 500ms */
 	fsa9480_write_reg(info, FSA9480_REG_TIMING1, TIMING1_ADC_500MS);

 	/* configure automatic switching */
 	fsa9480_write_reg(info, FSA9480_REG_CTRL, CON_MASK);

 	/* unmask interrupt (attach/detach only) */
 	fsa9480_write_reg(info, FSA9480_REG_INT1_MASK,
 			  INT1_MASK & ~(INT_ATTACH | INT_DETACH));
 	fsa9480_write_reg(info, FSA9480_REG_INT2_MASK, INT2_MASK);

 	ret = devm_request_threaded_irq(info->dev, client->irq, NULL,
 					fsa9480_irq_handler,
 					IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
 					"fsa9480", info);
 	if (ret) {
 		dev_err(info->dev, "failed to request IRQ\n");
 		return ret;
 	}

 	device_init_wakeup(info->dev, true);
 	fsa9480_detect_dev(info);

 	return 0;
 }

 static int fsa9480_remove(struct i2c_client *client)
 {
 	return 0;
 }

 #ifdef CONFIG_PM_SLEEP
 static int fsa9480_suspend(struct device *dev)
 {
 	struct i2c_client *client = to_i2c_client(dev);

 	if (device_may_wakeup(&client->dev) && client->irq)
 		enable_irq_wake(client->irq);

 	return 0;
 }

 static int fsa9480_resume(struct device *dev)
 {
 	struct i2c_client *client = to_i2c_client(dev);

 	if (device_may_wakeup(&client->dev) && client->irq)
 		disable_irq_wake(client->irq);

 	return 0;
 }
 #endif

 static const struct dev_pm_ops fsa9480_pm_ops = {
 	SET_SYSTEM_SLEEP_PM_OPS(fsa9480_suspend, fsa9480_resume)
 };

 static const struct i2c_device_id fsa9480_id[] = {
 	{ "fsa9480", 0 },
 	{}
 };
 MODULE_DEVICE_TABLE(i2c, fsa9480_id);

 static const struct of_device_id fsa9480_of_match[] = {
 	{ .compatible = "fcs,fsa9480", },
 	{ .compatible = "fcs,fsa880", },
 	{ .compatible = "ti,tsu6111", },
 	{ },
 };
 MODULE_DEVICE_TABLE(of, fsa9480_of_match);

 static struct i2c_driver fsa9480_i2c_driver = {
 	.driver			= {
 		.name		= "fsa9480",
 		.pm		= &fsa9480_pm_ops,
 		.of_match_table = fsa9480_of_match,
 	},
 	.probe			= fsa9480_probe,
 	.remove			= fsa9480_remove,
 	.id_table		= fsa9480_id,
 };

 static int __init fsa9480_module_init(void)
 {
 	return i2c_add_driver(&fsa9480_i2c_driver);
 }
 subsys_initcall(fsa9480_module_init);

 static void __exit fsa9480_module_exit(void)
 {
 	i2c_del_driver(&fsa9480_i2c_driver);
 }
 module_exit(fsa9480_module_exit);

 MODULE_DESCRIPTION("Fairchild Semiconductor FSA9480 extcon driver");
 MODULE_AUTHOR("Tomasz Figa <[email protected]>");
 MODULE_LICENSE("GPL");
	// SPDX-License-Identifier: GPL-2.0+
	/*
	* extcon-fsa9480.c - Fairchild Semiconductor FSA9480 extcon driver
	*
	* Copyright (c) 2019 Tomasz Figa <[email protected]>
	*
	* Loosely based on old fsa9480 misc-device driver.
	*/

	#include <linux/kernel.h>
	#include <linux/module.h>
	#include <linux/types.h>
	#include <linux/i2c.h>
	#include <linux/slab.h>
	#include <linux/bitops.h>
	#include <linux/interrupt.h>
	#include <linux/err.h>
	#include <linux/platform_device.h>
	#include <linux/kobject.h>
	#include <linux/extcon-provider.h>
	#include <linux/irqdomain.h>
	#include <linux/regmap.h>

	/* FSA9480 I2C registers */
	#define FSA9480_REG_DEVID 0x01
	#define FSA9480_REG_CTRL 0x02
	#define FSA9480_REG_INT1 0x03
	#define FSA9480_REG_INT2 0x04
	#define FSA9480_REG_INT1_MASK 0x05
	#define FSA9480_REG_INT2_MASK 0x06
	#define FSA9480_REG_ADC 0x07
	#define FSA9480_REG_TIMING1 0x08
	#define FSA9480_REG_TIMING2 0x09
	#define FSA9480_REG_DEV_T1 0x0a
	#define FSA9480_REG_DEV_T2 0x0b
	#define FSA9480_REG_BTN1 0x0c
	#define FSA9480_REG_BTN2 0x0d
	#define FSA9480_REG_CK 0x0e
	#define FSA9480_REG_CK_INT1 0x0f
	#define FSA9480_REG_CK_INT2 0x10
	#define FSA9480_REG_CK_INTMASK1 0x11
	#define FSA9480_REG_CK_INTMASK2 0x12
	#define FSA9480_REG_MANSW1 0x13
	#define FSA9480_REG_MANSW2 0x14
	#define FSA9480_REG_END 0x15

	/* Control */
	#define CON_SWITCH_OPEN (1 << 4)
	#define CON_RAW_DATA (1 << 3)
	#define CON_MANUAL_SW (1 << 2)
	#define CON_WAIT (1 << 1)
	#define CON_INT_MASK (1 << 0)
	#define CON_MASK (CON_SWITCH_OPEN \| CON_RAW_DATA \| \
	CON_MANUAL_SW \| CON_WAIT)

	/* Device Type 1 */
	#define DEV_USB_OTG 7
	#define DEV_DEDICATED_CHG 6
	#define DEV_USB_CHG 5
	#define DEV_CAR_KIT 4
	#define DEV_UART 3
	#define DEV_USB 2
	#define DEV_AUDIO_2 1
	#define DEV_AUDIO_1 0

	#define DEV_T1_USB_MASK (DEV_USB_OTG \| DEV_USB)
	#define DEV_T1_UART_MASK (DEV_UART)
	#define DEV_T1_CHARGER_MASK (DEV_DEDICATED_CHG \| DEV_USB_CHG)

	/* Device Type 2 */
	#define DEV_AV 14
	#define DEV_TTY 13
	#define DEV_PPD 12
	#define DEV_JIG_UART_OFF 11
	#define DEV_JIG_UART_ON 10
	#define DEV_JIG_USB_OFF 9
	#define DEV_JIG_USB_ON 8

	#define DEV_T2_USB_MASK (DEV_JIG_USB_OFF \| DEV_JIG_USB_ON)
	#define DEV_T2_UART_MASK (DEV_JIG_UART_OFF \| DEV_JIG_UART_ON)
	#define DEV_T2_JIG_MASK (DEV_JIG_USB_OFF \| DEV_JIG_USB_ON \| \
	DEV_JIG_UART_OFF \| DEV_JIG_UART_ON)

	/*
	* Manual Switch
	* D- [7:5] / D+ [4:2]
	* 000: Open all / 001: USB / 010: AUDIO / 011: UART / 100: V_AUDIO
	*/
	#define SW_VAUDIO ((4 << 5) \| (4 << 2))
	#define SW_UART ((3 << 5) \| (3 << 2))
	#define SW_AUDIO ((2 << 5) \| (2 << 2))
	#define SW_DHOST ((1 << 5) \| (1 << 2))
	#define SW_AUTO ((0 << 5) \| (0 << 2))

	/* Interrupt 1 */
	#define INT1_MASK (0xff << 0)
	#define INT_DETACH (1 << 1)
	#define INT_ATTACH (1 << 0)

	/* Interrupt 2 mask */
	#define INT2_MASK (0x1f << 0)

	/* Timing Set 1 */
	#define TIMING1_ADC_500MS (0x6 << 0)

	struct fsa9480_usbsw {
	struct device *dev;
	struct regmap *regmap;
	struct extcon_dev *edev;
	u16 cable;
	};

	static const unsigned int fsa9480_extcon_cable[] = {
	EXTCON_USB_HOST,
	EXTCON_USB,
	EXTCON_CHG_USB_DCP,
	EXTCON_CHG_USB_SDP,
	EXTCON_CHG_USB_ACA,
	EXTCON_JACK_LINE_OUT,
	EXTCON_JACK_VIDEO_OUT,
	EXTCON_JIG,

	EXTCON_NONE,
	};

	static const u64 cable_types[] = {
	[DEV_USB_OTG] = BIT_ULL(EXTCON_USB_HOST),
	[DEV_DEDICATED_CHG] = BIT_ULL(EXTCON_USB) \| BIT_ULL(EXTCON_CHG_USB_DCP),
	[DEV_USB_CHG] = BIT_ULL(EXTCON_USB) \| BIT_ULL(EXTCON_CHG_USB_SDP),
	[DEV_CAR_KIT] = BIT_ULL(EXTCON_USB) \| BIT_ULL(EXTCON_CHG_USB_SDP)
	\| BIT_ULL(EXTCON_JACK_LINE_OUT),
	[DEV_UART] = BIT_ULL(EXTCON_JIG),
	[DEV_USB] = BIT_ULL(EXTCON_USB) \| BIT_ULL(EXTCON_CHG_USB_SDP),
	[DEV_AUDIO_2] = BIT_ULL(EXTCON_JACK_LINE_OUT),
	[DEV_AUDIO_1] = BIT_ULL(EXTCON_JACK_LINE_OUT),
	[DEV_AV] = BIT_ULL(EXTCON_JACK_LINE_OUT)
	\| BIT_ULL(EXTCON_JACK_VIDEO_OUT),
	[DEV_TTY] = BIT_ULL(EXTCON_JIG),
	[DEV_PPD] = BIT_ULL(EXTCON_JACK_LINE_OUT) \| BIT_ULL(EXTCON_CHG_USB_ACA),
	[DEV_JIG_UART_OFF] = BIT_ULL(EXTCON_JIG),
	[DEV_JIG_UART_ON] = BIT_ULL(EXTCON_JIG),
	[DEV_JIG_USB_OFF] = BIT_ULL(EXTCON_USB) \| BIT_ULL(EXTCON_JIG),
	[DEV_JIG_USB_ON] = BIT_ULL(EXTCON_USB) \| BIT_ULL(EXTCON_JIG),
	};

	/* Define regmap configuration of FSA9480 for I2C communication */
	static bool fsa9480_volatile_reg(struct device *dev, unsigned int reg)
	{
	switch (reg) {
	case FSA9480_REG_INT1_MASK:
	return true;
	default:
	break;
	}
	return false;
	}

	static const struct regmap_config fsa9480_regmap_config = {
	.reg_bits = 8,
	.val_bits = 8,
	.volatile_reg = fsa9480_volatile_reg,
	.max_register = FSA9480_REG_END,
	};

	static int fsa9480_write_reg(struct fsa9480_usbsw *usbsw, int reg, int value)
	{
	int ret;

	ret = regmap_write(usbsw->regmap, reg, value);
	if (ret < 0)
	dev_err(usbsw->dev, "%s: err %d\n", __func__, ret);

	return ret;
	}

	static int fsa9480_read_reg(struct fsa9480_usbsw *usbsw, int reg)
	{
	int ret, val;

	ret = regmap_read(usbsw->regmap, reg, &val);
	if (ret < 0) {
	dev_err(usbsw->dev, "%s: err %d\n", __func__, ret);
	return ret;
	}

	return val;
	}

	static int fsa9480_read_irq(struct fsa9480_usbsw usbsw, int value)
	{
	u8 regs[2];
	int ret;

	ret = regmap_bulk_read(usbsw->regmap, FSA9480_REG_INT1, regs, 2);
	if (ret < 0)
	dev_err(usbsw->dev, "%s: err %d\n", __func__, ret);

	*value = regs[1] << 8 \| regs[0];
	return ret;
	}

	static void fsa9480_handle_change(struct fsa9480_usbsw *usbsw,
	u16 mask, bool attached)
	{
	while (mask) {
	int dev = fls64(mask) - 1;
	u64 cables = cable_types[dev];

	while (cables) {
	int cable = fls64(cables) - 1;

	extcon_set_state_sync(usbsw->edev, cable, attached);
	cables &= ~BIT_ULL(cable);
	}

	mask &= ~BIT_ULL(dev);
	}
	}

	static void fsa9480_detect_dev(struct fsa9480_usbsw *usbsw)
	{
	int val1, val2;
	u16 val;

	val1 = fsa9480_read_reg(usbsw, FSA9480_REG_DEV_T1);
	val2 = fsa9480_read_reg(usbsw, FSA9480_REG_DEV_T2);
	if (val1 < 0 \|\| val2 < 0) {
	dev_err(usbsw->dev, "%s: failed to read registers", __func__);
	return;
	}
	val = val2 << 8 \| val1;

	dev_info(usbsw->dev, "dev1: 0x%x, dev2: 0x%x\n", val1, val2);

	/* handle detached cables first */
	fsa9480_handle_change(usbsw, usbsw->cable & ~val, false);

	/* then handle attached ones */
	fsa9480_handle_change(usbsw, val & ~usbsw->cable, true);

	usbsw->cable = val;
	}

	static irqreturn_t fsa9480_irq_handler(int irq, void *data)
	{
	struct fsa9480_usbsw *usbsw = data;
	int intr = 0;

	/* clear interrupt */
	fsa9480_read_irq(usbsw, &intr);
	if (!intr)
	return IRQ_NONE;

	/* device detection */
	fsa9480_detect_dev(usbsw);

	return IRQ_HANDLED;
	}

	static int fsa9480_probe(struct i2c_client *client,
	const struct i2c_device_id *id)
	{
	struct fsa9480_usbsw *info;
	int ret;

	if (!client->irq) {
	dev_err(&client->dev, "no interrupt provided\n");
	return -EINVAL;
	}

	info = devm_kzalloc(&client->dev, sizeof(*info), GFP_KERNEL);
	if (!info)
	return -ENOMEM;
	info->dev = &client->dev;

	i2c_set_clientdata(client, info);

	/* External connector */
	info->edev = devm_extcon_dev_allocate(info->dev,
	fsa9480_extcon_cable);
	if (IS_ERR(info->edev)) {
	dev_err(info->dev, "failed to allocate memory for extcon\n");
	ret = -ENOMEM;
	return ret;
	}

	ret = devm_extcon_dev_register(info->dev, info->edev);
	if (ret) {
	dev_err(info->dev, "failed to register extcon device\n");
	return ret;
	}

	info->regmap = devm_regmap_init_i2c(client, &fsa9480_regmap_config);
	if (IS_ERR(info->regmap)) {
	ret = PTR_ERR(info->regmap);
	dev_err(info->dev, "failed to allocate register map: %d\n",
	ret);
	return ret;
	}

	/* ADC Detect Time: 500ms */
	fsa9480_write_reg(info, FSA9480_REG_TIMING1, TIMING1_ADC_500MS);

	/* configure automatic switching */
	fsa9480_write_reg(info, FSA9480_REG_CTRL, CON_MASK);

	/* unmask interrupt (attach/detach only) */
	fsa9480_write_reg(info, FSA9480_REG_INT1_MASK,
	INT1_MASK & ~(INT_ATTACH \| INT_DETACH));
	fsa9480_write_reg(info, FSA9480_REG_INT2_MASK, INT2_MASK);

	ret = devm_request_threaded_irq(info->dev, client->irq, NULL,
	fsa9480_irq_handler,
	IRQF_TRIGGER_FALLING \| IRQF_ONESHOT,
	"fsa9480", info);
	if (ret) {
	dev_err(info->dev, "failed to request IRQ\n");
	return ret;
	}

	device_init_wakeup(info->dev, true);
	fsa9480_detect_dev(info);

	return 0;
	}

	static int fsa9480_remove(struct i2c_client *client)
	{
	return 0;
	}

	#ifdef CONFIG_PM_SLEEP
	static int fsa9480_suspend(struct device *dev)
	{
	struct i2c_client *client = to_i2c_client(dev);

	if (device_may_wakeup(&client->dev) && client->irq)
	enable_irq_wake(client->irq);

	return 0;
	}

	static int fsa9480_resume(struct device *dev)
	{
	struct i2c_client *client = to_i2c_client(dev);

	if (device_may_wakeup(&client->dev) && client->irq)
	disable_irq_wake(client->irq);

	return 0;
	}
	#endif

	static const struct dev_pm_ops fsa9480_pm_ops = {
	SET_SYSTEM_SLEEP_PM_OPS(fsa9480_suspend, fsa9480_resume)
	};

	static const struct i2c_device_id fsa9480_id[] = {
	{ "fsa9480", 0 },
	{}
	};
	MODULE_DEVICE_TABLE(i2c, fsa9480_id);

	static const struct of_device_id fsa9480_of_match[] = {
	{ .compatible = "fcs,fsa9480", },
	{ .compatible = "fcs,fsa880", },
	{ .compatible = "ti,tsu6111", },
	{ },
	};
	MODULE_DEVICE_TABLE(of, fsa9480_of_match);

	static struct i2c_driver fsa9480_i2c_driver = {
	.driver = {
	.name = "fsa9480",
	.pm = &fsa9480_pm_ops,
	.of_match_table = fsa9480_of_match,
	},
	.probe = fsa9480_probe,
	.remove = fsa9480_remove,
	.id_table = fsa9480_id,
	};

	static int __init fsa9480_module_init(void)
	{
	return i2c_add_driver(&fsa9480_i2c_driver);
	}
	subsys_initcall(fsa9480_module_init);

	static void __exit fsa9480_module_exit(void)
	{
	i2c_del_driver(&fsa9480_i2c_driver);
	}
	module_exit(fsa9480_module_exit);

	MODULE_DESCRIPTION("Fairchild Semiconductor FSA9480 extcon driver");
	MODULE_AUTHOR("Tomasz Figa <[email protected]>");
	MODULE_LICENSE("GPL");