extcon: Add fsa9480 extcon driver
This patch adds extcon driver for Fairchild Semiconductor FSA9480 microUSB switch. Signed-off-by: Tomasz Figa <tomasz.figa@gmail.com> Signed-off-by: Jonathan Bakker <xc-racer2@live.ca> Signed-off-by: Paweł Chmiel <pawel.mikolaj.chmiel@gmail.com> Signed-off-by: Chanwoo Choi <cw00.choi@samsung.com>
This commit is contained in:
parent
fd757dbac5
commit
bad5b5e707
|
@ -37,6 +37,18 @@ config EXTCON_AXP288
|
|||
Say Y here to enable support for USB peripheral detection
|
||||
and USB MUX switching by X-Power AXP288 PMIC.
|
||||
|
||||
config EXTCON_FSA9480
|
||||
tristate "FSA9480 EXTCON Support"
|
||||
depends on INPUT
|
||||
select IRQ_DOMAIN
|
||||
select REGMAP_I2C
|
||||
help
|
||||
If you say yes here you get support for the Fairchild Semiconductor
|
||||
FSA9480 microUSB switch and accessory detector chip. The FSA9480 is a USB
|
||||
port accessory detector and switch. The FSA9480 is fully controlled using
|
||||
I2C and enables USB data, stereo and mono audio, video, microphone
|
||||
and UART data to use a common connector port.
|
||||
|
||||
config EXTCON_GPIO
|
||||
tristate "GPIO extcon support"
|
||||
depends on GPIOLIB || COMPILE_TEST
|
||||
|
|
|
@ -8,6 +8,7 @@ extcon-core-objs += extcon.o devres.o
|
|||
obj-$(CONFIG_EXTCON_ADC_JACK) += extcon-adc-jack.o
|
||||
obj-$(CONFIG_EXTCON_ARIZONA) += extcon-arizona.o
|
||||
obj-$(CONFIG_EXTCON_AXP288) += extcon-axp288.o
|
||||
obj-$(CONFIG_EXTCON_FSA9480) += extcon-fsa9480.o
|
||||
obj-$(CONFIG_EXTCON_GPIO) += extcon-gpio.o
|
||||
obj-$(CONFIG_EXTCON_INTEL_INT3496) += extcon-intel-int3496.o
|
||||
obj-$(CONFIG_EXTCON_INTEL_CHT_WC) += extcon-intel-cht-wc.o
|
||||
|
|
|
@ -0,0 +1,395 @@
|
|||
// SPDX-License-Identifier: GPL-2.0+
|
||||
/*
|
||||
* extcon-fsa9480.c - Fairchild Semiconductor FSA9480 extcon driver
|
||||
*
|
||||
* Copyright (c) 2019 Tomasz Figa <tomasz.figa@gmail.com>
|
||||
*
|
||||
* 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", },
|
||||
{ },
|
||||
};
|
||||
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 <tomasz.figa@gmail.com>");
|
||||
MODULE_LICENSE("GPL");
|
Loading…
Reference in New Issue