Author | Tokens | Token Proportion | Commits | Commit Proportion |
---|---|---|---|---|
Tomasz Figa | 1612 | 99.57% | 1 | 50.00% |
Linus Walleij | 7 | 0.43% | 1 | 50.00% |
Total | 1619 | 2 |
// 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", }, { .compatible = "fcs,fsa880", }, { }, }; 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");
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with Cregit http://github.com/cregit/cregit
Version 2.0-RC1