Message ID | 20220613095957.1669829-3-xji@analogixsemi.com (mailing list archive) |
---|---|
State | Superseded |
Headers | show |
Series | [v10,1/3] usb: typec: tcpci: move tcpci.h to include/linux/usb/ | expand |
On Mon, Jun 13, 2022 at 05:59:56PM +0800, Xin Ji wrote: > Add driver for analogix ANX7411 USB Type-C DRP port controller. > > Signed-off-by: Xin Ji <xji@analogixsemi.com> > --- > V9 -> V10 : Rebase on the latest code It looks like you did not check the comments I made in v9. Please go over those and resend. thanks, > V6 -> V7 : Fix Heikki's comment > Rebase on Greg's latest usb-next branch > Move tcpci.h to include/linux/usb/ > Remove double definition > V5 -> V6 : Fix Heikki's comment > V4 -> V5 : Fix Greg h-k comment, remove DEBUG define > V3 -> V4 : Fix compiling waring > V2 -> V3 : Add changelog history > V1 -> V2 : Fix compiling warning issue > --- > drivers/usb/typec/Kconfig | 11 + > drivers/usb/typec/Makefile | 1 + > drivers/usb/typec/anx7411.c | 1327 +++++++++++++++++++++++++++++++++++ > drivers/usb/typec/anx7411.h | 265 +++++++ > 4 files changed, 1604 insertions(+) > create mode 100644 drivers/usb/typec/anx7411.c > create mode 100644 drivers/usb/typec/anx7411.h > > diff --git a/drivers/usb/typec/Kconfig b/drivers/usb/typec/Kconfig > index ba24847fb245..5defdfead653 100644 > --- a/drivers/usb/typec/Kconfig > +++ b/drivers/usb/typec/Kconfig > @@ -52,6 +52,17 @@ source "drivers/usb/typec/ucsi/Kconfig" > > source "drivers/usb/typec/tipd/Kconfig" > > +config TYPEC_ANX7411 > + tristate "Analogix ANX7411 Type-C DRP Port controller driver" > + depends on I2C > + depends on USB_ROLE_SWITCH > + help > + Say Y or M here if your system has Analogix ANX7411 Type-C DRP Port > + controller driver. > + > + If you choose to build this driver as a dynamically linked module, the > + module will be called anx7411.ko. > + > config TYPEC_RT1719 > tristate "Richtek RT1719 Sink Only Type-C controller driver" > depends on USB_ROLE_SWITCH || !USB_ROLE_SWITCH > diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile > index 2f174cd3e5df..dac5c11a3234 100644 > --- a/drivers/usb/typec/Makefile > +++ b/drivers/usb/typec/Makefile > @@ -6,6 +6,7 @@ obj-$(CONFIG_TYPEC) += altmodes/ > obj-$(CONFIG_TYPEC_TCPM) += tcpm/ > obj-$(CONFIG_TYPEC_UCSI) += ucsi/ > obj-$(CONFIG_TYPEC_TPS6598X) += tipd/ > +obj-$(CONFIG_TYPEC_ANX7411) += anx7411.o > obj-$(CONFIG_TYPEC_HD3SS3220) += hd3ss3220.o > obj-$(CONFIG_TYPEC_QCOM_PMIC) += qcom-pmic-typec.o > obj-$(CONFIG_TYPEC_STUSB160X) += stusb160x.o > diff --git a/drivers/usb/typec/anx7411.c b/drivers/usb/typec/anx7411.c > new file mode 100644 > index 000000000000..cc208cdd8762 > --- /dev/null > +++ b/drivers/usb/typec/anx7411.c > @@ -0,0 +1,1327 @@ > +// SPDX-License-Identifier: GPL-2.0-only > + > +/* > + * Copyright(c) 2022, Analogix Semiconductor. All rights reserved. > + * > + */ > +#include <linux/gpio/consumer.h> > +#include <linux/i2c.h> > +#include <linux/interrupt.h> > +#include <linux/iopoll.h> > +#include <linux/kernel.h> > +#include <linux/module.h> > +#include <linux/mutex.h> > +#include <linux/of_graph.h> > +#include <linux/of_platform.h> > +#include <linux/pm_runtime.h> > +#include <linux/regulator/consumer.h> > +#include <linux/slab.h> > +#include <linux/types.h> > +#include <linux/usb/pd.h> > +#include <linux/usb/role.h> > +#include <linux/usb/tcpci.h> > +#include <linux/usb/typec.h> > +#include <linux/usb/typec_dp.h> > +#include <linux/usb/typec_mux.h> > +#include <linux/workqueue.h> > +#include <linux/power_supply.h> > + > +#include "anx7411.h" > + > +static u8 snk_identity[] = { > + LOBYTE(VID_ANALOGIX), HIBYTE(VID_ANALOGIX), 0x00, 0x82, /* snk_id_hdr */ > + 0x00, 0x00, 0x00, 0x00, /* snk_cert */ > + 0x00, 0x00, LOBYTE(PID_ANALOGIX), HIBYTE(PID_ANALOGIX), /* 5snk_ama */ > +}; > + > +static u8 dp_caps[4] = {0xC6, 0x00, 0x00, 0x00}; > + > +static int anx7411_reg_read(struct i2c_client *client, > + u8 reg_addr) > +{ > + return i2c_smbus_read_byte_data(client, reg_addr); > +} > + > +static int anx7411_reg_block_read(struct i2c_client *client, > + u8 reg_addr, u8 len, u8 *buf) > +{ > + return i2c_smbus_read_i2c_block_data(client, reg_addr, len, buf); > +} > + > +static int anx7411_reg_write(struct i2c_client *client, > + u8 reg_addr, u8 reg_val) > +{ > + return i2c_smbus_write_byte_data(client, reg_addr, reg_val); > +} > + > +static int anx7411_reg_block_write(struct i2c_client *client, > + u8 reg_addr, u8 len, u8 *buf) > +{ > + return i2c_smbus_write_i2c_block_data(client, reg_addr, len, buf); > +} > + > +static struct anx7411_i2c_select anx7411_i2c_addr[] = { > + {TCPC_ADDRESS1, SPI_ADDRESS1}, > + {TCPC_ADDRESS2, SPI_ADDRESS2}, > + {TCPC_ADDRESS3, SPI_ADDRESS3}, > + {TCPC_ADDRESS4, SPI_ADDRESS4}, > +}; > + > +static int anx7411_detect_power_mode(struct anx7411_data *ctx) > +{ > + int ret; > + int mode; > + > + ret = anx7411_reg_read(ctx->spi_client, REQUEST_CURRENT); > + if (ret < 0) > + return ret; > + > + ctx->typec.request_current = ret * CURRENT_UNIT; /* 50ma per unit */ > + > + ret = anx7411_reg_read(ctx->spi_client, REQUEST_VOLTAGE); > + if (ret < 0) > + return ret; > + > + ctx->typec.request_voltage = ret * VOLTAGE_UNIT; /* 100mv per unit */ > + > + if (ctx->psy_online == ANX7411_PSY_OFFLINE) { > + ctx->psy_online = ANX7411_PSY_FIXED_ONLINE; > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_PD; > + power_supply_changed(ctx->psy); > + } > + > + if (!ctx->typec.cc_orientation_valid) > + return 0; > + > + if (ctx->typec.cc_connect == CC1_CONNECTED) > + mode = CC1_RP(ctx->typec.cc_status); > + else > + mode = CC2_RP(ctx->typec.cc_status); > + if (mode) { > + typec_set_pwr_opmode(ctx->typec.port, mode - 1); > + return 0; > + } > + > + typec_set_pwr_opmode(ctx->typec.port, TYPEC_PWR_MODE_PD); > + > + return 0; > +} > + > +static int anx7411_register_partner(struct anx7411_data *ctx, > + int pd, int accessory) > +{ > + struct typec_partner_desc desc; > + > + if (ctx->typec.partner) > + return 0; > + > + desc.usb_pd = pd; > + desc.accessory = accessory; > + desc.identity = NULL; > + ctx->typec.partner = typec_register_partner(ctx->typec.port, &desc); > + if (IS_ERR(ctx->typec.partner)) { > + ctx->typec.partner = NULL; > + return PTR_ERR(ctx->typec.partner); > + } > + > + return 0; > +} > + > +static int anx7411_detect_cc_orientation(struct anx7411_data *ctx) > +{ > + int ret; > + int cc1_rd, cc2_rd; > + int cc1_ra, cc2_ra; > + int cc1_rp, cc2_rp; > + > + ret = anx7411_reg_read(ctx->spi_client, CC_STATUS); > + if (ret < 0) > + return ret; > + > + ctx->typec.cc_status = ret; > + > + cc1_rd = ret & CC1_RD ? 1 : 0; > + cc2_rd = ret & CC2_RD ? 1 : 0; > + cc1_ra = ret & CC1_RA ? 1 : 0; > + cc2_ra = ret & CC2_RA ? 1 : 0; > + cc1_rp = CC1_RP(ret); > + cc2_rp = CC2_RP(ret); > + > + /* Debug cable, nothing to do */ > + if (cc1_rd && cc2_rd) { > + ctx->typec.cc_orientation_valid = 0; > + anx7411_register_partner(ctx, 0, TYPEC_ACCESSORY_DEBUG); > + return 0; > + } > + > + if (cc1_ra && cc2_ra) { > + ctx->typec.cc_orientation_valid = 0; > + anx7411_register_partner(ctx, 0, TYPEC_ACCESSORY_AUDIO); > + return 0; > + } > + > + ctx->typec.cc_orientation_valid = 1; > + > + anx7411_register_partner(ctx, 1, TYPEC_ACCESSORY_NONE); > + > + if (cc1_rd || cc1_rp) { > + typec_set_orientation(ctx->typec.port, > + TYPEC_ORIENTATION_NORMAL); > + ctx->typec.cc_connect = CC1_CONNECTED; > + } > + > + if (cc2_rd || cc2_rp) { > + typec_set_orientation(ctx->typec.port, > + TYPEC_ORIENTATION_REVERSE); > + ctx->typec.cc_connect = CC2_CONNECTED; > + } > + > + return 0; > +} > + > +static int anx7411_set_mux(struct anx7411_data *ctx, int pin_assignment) > +{ > + int mode = TYPEC_STATE_SAFE; > + > + switch (pin_assignment) { > + case SELECT_PIN_ASSIGMENT_U: > + /* default 4 line USB 3.1 */ > + mode = TYPEC_STATE_MODAL; > + break; > + case SELECT_PIN_ASSIGMENT_C: > + case SELECT_PIN_ASSIGMENT_E: > + /* 4 line DP */ > + mode = TYPEC_STATE_SAFE; > + break; > + case SELECT_PIN_ASSIGMENT_D: > + /* 2 line DP, 2 line USB */ > + mode = TYPEC_MODE_USB3; > + break; > + default: > + mode = TYPEC_STATE_SAFE; > + break; > + } > + > + ctx->typec.pin_assignment = pin_assignment; > + > + return typec_set_mode(ctx->typec.port, mode); > +} > + > +static void anx7411_set_usb_role(struct anx7411_data *ctx, enum usb_role role) > +{ > + if (!ctx->typec.role_sw) > + return; > + > + usb_role_switch_set_role(ctx->typec.role_sw, role); > +} > + > +static int anx7411_data_role_detect(struct anx7411_data *ctx) > +{ > + int ret; > + > + ret = anx7411_reg_read(ctx->spi_client, SYSTEM_STSTUS); > + if (ret < 0) > + return ret; > + > + ctx->typec.data_role = (ret & DATA_ROLE) ? TYPEC_HOST : TYPEC_DEVICE; > + ctx->typec.vconn_role = (ret & VCONN_STATUS) ? TYPEC_SOURCE : TYPEC_SINK; > + > + typec_set_data_role(ctx->typec.port, ctx->typec.data_role); > + typec_set_vconn_role(ctx->typec.port, ctx->typec.vconn_role); > + > + if (ctx->typec.data_role == TYPEC_HOST) > + anx7411_set_usb_role(ctx, USB_ROLE_HOST); > + else > + anx7411_set_usb_role(ctx, USB_ROLE_DEVICE); > + > + return 0; > +} > + > +static int anx7411_power_role_detect(struct anx7411_data *ctx) > +{ > + int ret; > + > + ret = anx7411_reg_read(ctx->spi_client, SYSTEM_STSTUS); > + if (ret < 0) > + return ret; > + > + ctx->typec.power_role = (ret & SINK_STATUS) ? TYPEC_SINK : TYPEC_SOURCE; > + > + if (ctx->typec.power_role == TYPEC_SOURCE) { > + ctx->typec.request_current = DEF_1_5A; > + ctx->typec.request_voltage = DEF_5V; > + } > + > + typec_set_pwr_role(ctx->typec.port, ctx->typec.power_role); > + > + return 0; > +} > + > +static int anx7411_cc_status_detect(struct anx7411_data *ctx) > +{ > + anx7411_detect_cc_orientation(ctx); > + anx7411_detect_power_mode(ctx); > + > + return 0; > +} > + > +static int anx7411_partner_unregister_altmode(struct anx7411_data *ctx) > +{ > + int i; > + > + ctx->typec.dp_altmode_enter = 0; > + ctx->typec.cust_altmode_enter = 0; > + > + for (i = 0; i < MAX_ALTMODE; i++) > + if (ctx->typec.amode[i]) { > + typec_unregister_altmode(ctx->typec.amode[i]); > + ctx->typec.amode[i] = NULL; > + } > + > + ctx->typec.pin_assignment = 0; > + return 0; > +} > + > +static int anx7411_typec_register_altmode(struct anx7411_data *ctx, > + int svid, int vdo) > +{ > + struct device *dev = &ctx->spi_client->dev; > + struct typec_altmode_desc desc; > + int i; > + > + desc.svid = svid; > + desc.vdo = vdo; > + > + for (i = 0; i < MAX_ALTMODE; i++) > + if (!ctx->typec.amode[i]) > + break; > + > + desc.mode = i + 1; /* start with 1 */ > + > + if (i >= MAX_ALTMODE) { > + dev_err(dev, "no altmode space for registering\n"); > + return -ENOMEM; > + } > + > + ctx->typec.amode[i] = typec_partner_register_altmode(ctx->typec.partner, > + &desc); > + if (IS_ERR(ctx->typec.amode[i])) { > + dev_err(dev, "failed to register altmode\n"); > + ctx->typec.amode[i] = NULL; > + return PTR_ERR(ctx->typec.amode); > + } > + > + return 0; > +} > + > +static int anx7411_unregister_partner(struct anx7411_data *ctx) > +{ > + if (ctx->typec.partner) { > + typec_unregister_partner(ctx->typec.partner); > + ctx->typec.partner = NULL; > + } > + > + return 0; > +} > + > +static int anx7411_update_altmode(struct anx7411_data *ctx, int svid) > +{ > + int i; > + > + if (svid == DP_SVID) > + ctx->typec.dp_altmode_enter = 1; > + else > + ctx->typec.cust_altmode_enter = 1; > + > + for (i = 0; i < MAX_ALTMODE; i++) { > + if (!ctx->typec.amode[i]) > + continue; > + > + if (ctx->typec.amode[i]->svid == svid) { > + typec_altmode_update_active(ctx->typec.amode[i], true); > + typec_altmode_notify(ctx->typec.amode[i], > + ctx->typec.pin_assignment, > + &ctx->typec.data); > + break; > + } > + } > + > + return 0; > +} > + > +static int anx7411_register_altmode(struct anx7411_data *ctx, > + bool dp_altmode, u8 *buf) > +{ > + int ret; > + int svid; > + int mid; > + > + if (!ctx->typec.partner) > + return 0; > + > + svid = DP_SVID; > + if (dp_altmode) { > + mid = buf[0] | (buf[1] << 8) | (buf[2] << 16) | (buf[3] << 24); > + > + return anx7411_typec_register_altmode(ctx, svid, mid); > + } > + > + svid = (buf[3] << 8) | buf[2]; > + if ((buf[0] & VDM_CMD_AND_ACK_MASK) != (VDM_ACK | VDM_CMD_ENTER_MODE)) > + return anx7411_update_altmode(ctx, svid); > + > + if ((buf[0] & VDM_CMD_AND_ACK_MASK) != (VDM_ACK | VDM_CMD_DIS_MOD)) > + return 0; > + > + mid = buf[4] | (buf[5] << 8) | (buf[6] << 16) | (buf[7] << 24); > + > + ret = anx7411_typec_register_altmode(ctx, svid, mid); > + if (ctx->typec.cust_altmode_enter) > + ret |= anx7411_update_altmode(ctx, svid); > + > + return ret; > +} > + > +static int anx7411_parse_cmd(struct anx7411_data *ctx, u8 type, u8 *buf, u8 len) > +{ > + struct device *dev = &ctx->spi_client->dev; > + u8 cur_50ma, vol_100mv; > + > + dev_info(dev, "received message: type:0x%.02x, len:%d, buf[0]:%d\n", > + type, len, buf[0]); > + > + switch (type) { > + case TYPE_SRC_CAP: > + cur_50ma = anx7411_reg_read(ctx->spi_client, REQUEST_CURRENT); > + vol_100mv = anx7411_reg_read(ctx->spi_client, REQUEST_VOLTAGE); > + dev_info(dev, "get current(%dma), voltage(%dmv), power(%dmw)\n", > + cur_50ma * CURRENT_UNIT, vol_100mv * VOLTAGE_UNIT, > + cur_50ma * vol_100mv * 5); > + > + ctx->typec.request_voltage = vol_100mv * VOLTAGE_UNIT; > + ctx->typec.request_current = cur_50ma * CURRENT_UNIT; > + > + ctx->psy_online = ANX7411_PSY_FIXED_ONLINE; > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_PD; > + power_supply_changed(ctx->psy); > + break; > + case TYPE_SNK_CAP: > + break; > + case TYPE_SVID: > + break; > + case TYPE_SNK_IDENTITY: > + break; > + case TYPE_GET_DP_ALT_ENTER: > + /* DP alt mode enter success */ > + if (buf[0]) > + anx7411_update_altmode(ctx, DP_SVID); > + break; > + case TYPE_DP_ALT_ENTER: > + /* Update DP altmode */ > + anx7411_update_altmode(ctx, DP_SVID); > + break; > + case TYPE_OBJ_REQ: > + anx7411_detect_power_mode(ctx); > + break; > + case TYPE_DP_CONFIGURE: > + anx7411_set_mux(ctx, buf[1]); > + break; > + case TYPE_DP_DISCOVER_MODES_INFO: > + /* Make sure discover modes valid */ > + if (buf[0] | buf[1]) > + /* Register DP Altmode */ > + anx7411_register_altmode(ctx, 1, buf); > + break; > + case TYPE_VDM: > + /* Register other altmode */ > + anx7411_register_altmode(ctx, 0, buf); > + break; > + default: > + dev_err(dev, "ignore message(0x%.02x).\n", type); > + break; > + } > + > + return 0; > +} > + > +static u8 checksum(struct device *dev, u8 *buf, u8 len) > +{ > + u8 ret = 0; > + u8 i; > + > + for (i = 0; i < len; i++) > + ret += buf[i]; > + > + return ret; > +} > + > +static int anx7411_read_msg_ctrl_status(struct i2c_client *client) > +{ > + return anx7411_reg_read(client, CMD_SEND_BUF); > +} > + > +static int anx7411_wait_msg_empty(struct i2c_client *client) > +{ > + int val; > + > + return readx_poll_timeout(anx7411_read_msg_ctrl_status, > + client, val, (val < 0) || (val == 0), > + 2000, 2000 * 150); > +} > + > +static int anx7411_send_msg(struct anx7411_data *ctx, u8 type, u8 *buf, u8 size) > +{ > + struct device *dev = &ctx->spi_client->dev; > + u8 msg[MSG_LEN]; > + u8 crc; > + int ret; > + > + if (size) > + memcpy(&msg[MSG_RAWDATA], buf, size); > + msg[MSG_TYPE] = type; > + msg[MSG_HEADER] = size + 1; > + > + crc = checksum(dev, msg, size + HEADER_LEN); > + msg[size + HEADER_LEN] = 0 - crc; > + > + ret = anx7411_wait_msg_empty(ctx->spi_client); > + if (ret) > + return ret; > + > + anx7411_reg_block_write(ctx->spi_client, > + CMD_SEND_BUF + 1, size + HEADER_LEN, > + &msg[MSG_TYPE]); > + return anx7411_reg_write(ctx->spi_client, CMD_SEND_BUF, > + msg[MSG_HEADER]); > +} > + > +static int anx7411_process_cmd(struct anx7411_data *ctx) > +{ > + struct device *dev = &ctx->spi_client->dev; > + u8 msg[MSG_LEN]; > + u8 len; > + u8 crc; > + > + /* Read message from firmware */ > + anx7411_reg_block_read(ctx->spi_client, CMD_RECV_BUF, MSG_LEN, msg); > + anx7411_reg_write(ctx->spi_client, CMD_RECV_BUF, 0); > + > + if (!msg[MSG_HEADER]) > + return 0; > + > + len = msg[MSG_HEADER] & MSG_LEN_MASK; > + crc = checksum(dev, msg, len + HEADER_LEN); > + if (crc) { > + dev_err(dev, "message error crc(0x%.02x)\n", crc); > + return -ERANGE; > + } > + > + return anx7411_parse_cmd(ctx, msg[MSG_TYPE], > + &msg[MSG_RAWDATA], len - 1); > +} > + > +static void anx7411_translate_payload(struct device *dev, __le32 *payload, > + u32 *pdo, int nr, const char *type) > +{ > + int i; > + > + if (nr > PDO_MAX_OBJECTS) { > + dev_err(dev, "nr(%d) exceed PDO_MAX_OBJECTS(%d)\n", > + nr, PDO_MAX_OBJECTS); > + > + return; > + } > + > + for (i = 0; i < nr; i++) > + payload[i] = cpu_to_le32(pdo[i]); > +} > + > +static void anx7411_config(struct anx7411_data *ctx) > +{ > + struct device *dev = &ctx->spi_client->dev; > + struct typec_params *typecp = &ctx->typec; > + __le32 payload[PDO_MAX_OBJECTS]; > + > + /* Config PD FW work under PD 2.0 */ > + anx7411_reg_write(ctx->spi_client, PD_REV_INIT, PD_REV20); > + anx7411_reg_write(ctx->tcpc_client, FW_CTRL_0, > + UNSTRUCT_VDM_EN | DELAY_200MS | > + VSAFE1 | FRS_EN); > + anx7411_reg_write(ctx->spi_client, FW_CTRL_1, > + AUTO_PD_EN | FORCE_SEND_RDO); > + > + /* Set VBUS current threshold */ > + anx7411_reg_write(ctx->tcpc_client, VBUS_THRESHOLD_H, 0xff); > + anx7411_reg_write(ctx->tcpc_client, VBUS_THRESHOLD_L, 0x03); > + > + /* Fix dongle compatible issue */ > + anx7411_reg_write(ctx->tcpc_client, FW_PARAM, > + anx7411_reg_read(ctx->tcpc_client, FW_PARAM) | > + DONGLE_IOP); > + anx7411_reg_write(ctx->spi_client, INT_MASK, 0); > + > + anx7411_reg_write(ctx->spi_client, PD_EXT_MSG_CTRL, 0xFF); > + > + if (typecp->caps_flags & HAS_SOURCE_CAP) { > + anx7411_translate_payload(dev, payload, typecp->src_pdo, > + typecp->src_pdo_nr, "source"); > + anx7411_send_msg(ctx, TYPE_SRC_CAP, (u8 *)&payload, > + typecp->src_pdo_nr * 4); > + anx7411_send_msg(ctx, TYPE_SNK_IDENTITY, snk_identity, > + sizeof(snk_identity)); > + anx7411_send_msg(ctx, TYPE_SET_SNK_DP_CAP, dp_caps, > + sizeof(dp_caps)); > + } > + > + if (typecp->caps_flags & HAS_SINK_CAP) { > + anx7411_translate_payload(dev, payload, typecp->sink_pdo, > + typecp->sink_pdo_nr, "sink"); > + anx7411_send_msg(ctx, TYPE_SNK_CAP, (u8 *)&payload, > + typecp->sink_pdo_nr * 4); > + } > + > + if (typecp->caps_flags & HAS_SINK_WATT) { > + if (typecp->sink_watt) { > + anx7411_reg_write(ctx->spi_client, MAX_POWER, > + typecp->sink_watt); > + /* Set min power to 1W */ > + anx7411_reg_write(ctx->spi_client, MIN_POWER, 2); > + } > + > + if (typecp->sink_voltage) > + anx7411_reg_write(ctx->spi_client, MAX_VOLTAGE, > + typecp->sink_voltage); > + } > + > + if (!typecp->caps_flags) > + usleep_range(5000, 6000); > + > + ctx->fw_version = anx7411_reg_read(ctx->spi_client, FW_VER); > + ctx->fw_subversion = anx7411_reg_read(ctx->spi_client, > + FW_SUBVER); > +} > + > +static void anx7411_chip_standby(struct anx7411_data *ctx) > +{ > + anx7411_reg_write(ctx->spi_client, OCM_CTRL_0, > + anx7411_reg_read(ctx->spi_client, OCM_CTRL_0) | > + OCM_RESET); > + anx7411_reg_write(ctx->tcpc_client, ANALOG_CTRL_10, 0x80); > + /* Set TCPC to RD and DRP enable */ > + anx7411_reg_write(ctx->tcpc_client, > + TCPC_ROLE_CTRL, > + TCPC_ROLE_CTRL_DRP | > + (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT) | > + (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT)); > + > + /* Send DRP toggle command */ > + anx7411_reg_write(ctx->tcpc_client, TCPC_COMMAND, > + TCPC_CMD_LOOK4CONNECTION); > + > + /* Send TCPC enter standby command */ > + anx7411_reg_write(ctx->tcpc_client, TCPC_COMMAND, TCPC_CMD_I2C_IDLE); > +} > + > +static void anx7411_work_func(struct work_struct *work) > +{ > + int ret; > + u8 buf[STATUS_LEN]; > + u8 int_change; /* Interrupt change */ > + u8 int_status; /* Firmware status update */ > + u8 alert0, alert1; /* Interrupt alert source */ > + struct anx7411_data *ctx = container_of(work, struct anx7411_data, work); > + > + mutex_lock(&ctx->lock); > + > + /* Read interrupt change status */ > + ret = anx7411_reg_block_read(ctx->spi_client, INT_STS, STATUS_LEN, buf); > + if (ret < 0) { > + /* Power standby mode, just return */ > + goto unlock; > + } > + int_change = buf[0]; > + int_status = buf[1]; > + > + /* Read alert register */ > + ret = anx7411_reg_block_read(ctx->tcpc_client, ALERT_0, STATUS_LEN, buf); > + if (ret < 0) > + goto unlock; > + > + alert0 = buf[0]; > + alert1 = buf[1]; > + > + /* Clear interrupt and alert status */ > + anx7411_reg_write(ctx->spi_client, INT_STS, 0); > + anx7411_reg_write(ctx->tcpc_client, ALERT_0, alert0); > + anx7411_reg_write(ctx->tcpc_client, ALERT_1, alert1); > + > + if (alert1 & INTP_POW_OFF) { > + anx7411_partner_unregister_altmode(ctx); > + anx7411_set_usb_role(ctx, USB_ROLE_NONE); > + anx7411_unregister_partner(ctx); > + ctx->psy_online = ANX7411_PSY_OFFLINE; > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_C; > + ctx->typec.request_voltage = 0; > + ctx->typec.request_current = 0; > + power_supply_changed(ctx->psy); > + anx7411_chip_standby(ctx); > + goto unlock; > + } > + > + if ((alert0 & SOFTWARE_INT) && (int_change & OCM_BOOT_UP)) { > + anx7411_config(ctx); > + anx7411_data_role_detect(ctx); > + anx7411_power_role_detect(ctx); > + anx7411_set_mux(ctx, SELECT_PIN_ASSIGMENT_C); > + } > + > + if (alert0 & RECEIVED_MSG) > + anx7411_process_cmd(ctx); > + > + ret = (int_status & DATA_ROLE) ? TYPEC_HOST : TYPEC_DEVICE; > + if (ctx->typec.data_role != ret) > + anx7411_data_role_detect(ctx); > + > + ret = (int_status & SINK_STATUS) ? TYPEC_SINK : TYPEC_SOURCE; > + if (ctx->typec.power_role != ret) > + anx7411_power_role_detect(ctx); > + > + if ((alert0 & SOFTWARE_INT) && (int_change & CC_STATUS_CHANGE)) > + anx7411_cc_status_detect(ctx); > + > +unlock: > + mutex_unlock(&ctx->lock); > +} > + > +static irqreturn_t anx7411_intr_isr(int irq, void *data) > +{ > + struct anx7411_data *ctx = (struct anx7411_data *)data; > + > + queue_work(ctx->workqueue, &ctx->work); > + > + return IRQ_HANDLED; > +} > + > +static int anx7411_register_i2c_dummy_clients(struct anx7411_data *ctx, > + struct i2c_client *client) > +{ > + int i; > + u8 spi_addr; > + > + for (i = 0; i < sizeof(anx7411_i2c_addr); i++) { > + if (client->addr == (anx7411_i2c_addr[i].tcpc_address >> 1)) { > + spi_addr = anx7411_i2c_addr[i].spi_address >> 1; > + ctx->spi_client = i2c_new_dummy_device(client->adapter, > + spi_addr); > + if (ctx->spi_client) > + return 0; > + } > + } > + > + dev_err(&client->dev, "unable to get SPI slave\n"); > + return -ENOMEM; > +} > + > +static void anx7411_port_unregister_altmodes(struct typec_altmode **adev) > +{ > + int i; > + > + for (i = 0; i < MAX_ALTMODE; i++) > + if (adev[i]) { > + typec_unregister_altmode(adev[i]); > + adev[i] = NULL; > + } > +} > + > +static int anx7411_usb_mux_set(struct typec_mux_dev *mux, > + struct typec_mux_state *state) > +{ > + struct anx7411_data *ctx = typec_mux_get_drvdata(mux); > + struct device *dev = &ctx->spi_client->dev; > + int has_dp; > + > + has_dp = (state->alt && state->alt->svid == USB_TYPEC_DP_SID && > + state->alt->mode == USB_TYPEC_DP_MODE); > + if (!has_dp) > + dev_err(dev, "dp altmode not register\n"); > + > + return 0; > +} > + > +static int anx7411_usb_set_orientation(struct typec_switch_dev *sw, > + enum typec_orientation orientation) > +{ > + /* No need set */ > + > + return 0; > +} > + > +static int anx7411_register_switch(struct anx7411_data *ctx, > + struct device *dev, > + struct fwnode_handle *fwnode) > +{ > + struct typec_switch_desc sw_desc = { }; > + > + sw_desc.fwnode = fwnode; > + sw_desc.drvdata = ctx; > + sw_desc.name = fwnode_get_name(fwnode); > + sw_desc.set = anx7411_usb_set_orientation; > + > + ctx->typec.typec_switch = typec_switch_register(dev, &sw_desc); > + if (IS_ERR(ctx->typec.typec_switch)) { > + dev_err(dev, "switch register failed\n"); > + return PTR_ERR(ctx->typec.typec_switch); > + } > + > + return 0; > +} > + > +static int anx7411_register_mux(struct anx7411_data *ctx, > + struct device *dev, > + struct fwnode_handle *fwnode) > +{ > + struct typec_mux_desc mux_desc = { }; > + > + mux_desc.fwnode = fwnode; > + mux_desc.drvdata = ctx; > + mux_desc.name = fwnode_get_name(fwnode); > + mux_desc.set = anx7411_usb_mux_set; > + > + ctx->typec.typec_mux = typec_mux_register(dev, &mux_desc); > + if (IS_ERR(ctx->typec.typec_mux)) { > + dev_err(dev, "mux register failed\n"); > + return PTR_ERR(ctx->typec.typec_mux); > + } > + > + return 0; > +} > + > +static void anx7411_unregister_mux(struct anx7411_data *ctx) > +{ > + if (ctx->typec.typec_mux) { > + typec_mux_unregister(ctx->typec.typec_mux); > + ctx->typec.typec_mux = NULL; > + } > +} > + > +static void anx7411_unregister_switch(struct anx7411_data *ctx) > +{ > + if (ctx->typec.typec_switch) { > + typec_switch_unregister(ctx->typec.typec_switch); > + ctx->typec.typec_switch = NULL; > + } > +} > + > +static int anx7411_typec_switch_probe(struct anx7411_data *ctx, > + struct device *dev) > +{ > + int ret; > + struct device_node *node; > + > + node = of_find_node_by_name(dev->of_node, "orientation_switch"); > + if (!node) { > + dev_info(dev, "no typec switch exist\n"); > + return 0; > + } > + > + ret = anx7411_register_switch(ctx, dev, &node->fwnode); > + if (ret) { > + dev_err(dev, "failed register switch"); > + return ret; > + } > + > + node = of_find_node_by_name(dev->of_node, "mode_switch"); > + if (!node) { > + dev_err(dev, "no typec mux exist"); > + ret = -ENODEV; > + goto unregister_switch; > + } > + > + ret = anx7411_register_mux(ctx, dev, &node->fwnode); > + if (ret) { > + dev_err(dev, "failed register mode switch"); > + ret = -ENODEV; > + goto unregister_switch; > + } > + > + return 0; > + > +unregister_switch: > + anx7411_unregister_switch(ctx); > + > + return ret; > +} > + > +static int anx7411_typec_port_probe(struct anx7411_data *ctx, > + struct device *dev) > +{ > + struct typec_capability *cap = &ctx->typec.caps; > + struct typec_params *typecp = &ctx->typec; > + struct fwnode_handle *fwnode; > + const char *buf; > + int ret, i; > + > + fwnode = device_get_named_child_node(dev, "connector"); > + if (!fwnode) > + return -EINVAL; > + > + ret = fwnode_property_read_string(fwnode, "power-role", &buf); > + if (ret) { > + dev_err(dev, "power-role not found: %d\n", ret); > + return ret; > + } > + > + ret = typec_find_port_power_role(buf); > + if (ret < 0) > + return ret; > + cap->type = ret; > + > + ret = fwnode_property_read_string(fwnode, "data-role", &buf); > + if (ret) { > + dev_err(dev, "data-role not found: %d\n", ret); > + return ret; > + } > + > + ret = typec_find_port_data_role(buf); > + if (ret < 0) > + return ret; > + cap->data = ret; > + > + ret = fwnode_property_read_string(fwnode, "try-power-role", &buf); > + if (ret) { > + dev_err(dev, "try-power-role not found: %d\n", ret); > + return ret; > + } > + > + ret = typec_find_power_role(buf); > + if (ret < 0) > + return ret; > + cap->prefer_role = ret; > + > + /* Get source pdos */ > + ret = fwnode_property_count_u32(fwnode, "source-pdos"); > + if (ret > 0) { > + dev_info(dev, "%d source-pdos found\n", ret); > + typecp->src_pdo_nr = min(ret, PDO_MAX_OBJECTS); > + ret = fwnode_property_read_u32_array(fwnode, "source-pdos", > + typecp->src_pdo, > + typecp->src_pdo_nr); > + if (ret < 0) { > + dev_err(dev, "source cap validate failed: %d\n", ret); > + return -EINVAL; > + } > + > + typecp->caps_flags |= HAS_SOURCE_CAP; > + } > + > + ret = fwnode_property_count_u32(fwnode, "sink-pdos"); > + if (ret > 0) { > + dev_info(dev, "%d sink-pdos found\n", ret); > + typecp->sink_pdo_nr = min(ret, PDO_MAX_OBJECTS); > + ret = fwnode_property_read_u32_array(fwnode, "sink-pdos", > + typecp->sink_pdo, > + typecp->sink_pdo_nr); > + if (ret < 0) { > + dev_err(dev, "sink cap validate failed: %d\n", ret); > + return -EINVAL; > + } > + > + for (i = 0; i < typecp->sink_pdo_nr; i++) { > + ret = 0; > + switch (pdo_type(typecp->sink_pdo[i])) { > + case PDO_TYPE_FIXED: > + ret = pdo_fixed_voltage(typecp->sink_pdo[i]); > + break; > + case PDO_TYPE_BATT: > + case PDO_TYPE_VAR: > + ret = pdo_max_voltage(typecp->sink_pdo[i]); > + break; > + case PDO_TYPE_APDO: > + default: > + ret = 0; > + break; > + } > + > + /* 100mv per unit */ > + typecp->sink_voltage = max(5000, ret) / 100; > + } > + > + typecp->caps_flags |= HAS_SINK_CAP; > + } > + > + if (!fwnode_property_read_u32(fwnode, "op-sink-microwatt", &ret)) { > + dev_info(dev, "%d sink-microwat found\n", ret); > + typecp->sink_watt = ret / 500000; /* 500mw per unit */ > + typecp->caps_flags |= HAS_SINK_WATT; > + } > + > + cap->fwnode = fwnode; > + > + ctx->typec.role_sw = usb_role_switch_get(dev); > + if (IS_ERR(ctx->typec.role_sw)) { > + dev_err(dev, "USB role switch not found.\n"); > + ctx->typec.role_sw = NULL; > + } > + > + ctx->typec.port = typec_register_port(dev, cap); > + if (IS_ERR(ctx->typec.port)) { > + ret = PTR_ERR(ctx->typec.port); > + ctx->typec.port = NULL; > + dev_err(dev, "Failed to register type c port %d\n", ret); > + return ret; > + } > + > + typec_port_register_altmodes(ctx->typec.port, NULL, ctx, > + ctx->typec.port_amode, > + MAX_ALTMODE); > + > + return 0; > +} > + > +static int anx7411_typec_check_connection(struct anx7411_data *ctx) > +{ > + int ret; > + > + ret = anx7411_reg_read(ctx->spi_client, FW_VER); > + if (ret < 0) > + return 0; /* No device attached in typec port */ > + > + /* Clear interrupt and alert status */ > + anx7411_reg_write(ctx->spi_client, INT_STS, 0); > + anx7411_reg_write(ctx->tcpc_client, ALERT_0, 0xFF); > + anx7411_reg_write(ctx->tcpc_client, ALERT_1, 0xFF); > + > + anx7411_cc_status_detect(ctx); > + anx7411_power_role_detect(ctx); > + anx7411_data_role_detect(ctx); > + anx7411_set_mux(ctx, SELECT_PIN_ASSIGMENT_C); > + > + anx7411_send_msg(ctx, TYPE_GET_DP_ALT_ENTER, NULL, 0); > + anx7411_send_msg(ctx, TYPE_GET_DP_DISCOVER_MODES_INFO, NULL, 0); > + > + return 0; > +} > + > +static int __maybe_unused anx7411_runtime_pm_suspend(struct device *dev) > +{ > + struct anx7411_data *ctx = dev_get_drvdata(dev); > + > + mutex_lock(&ctx->lock); > + > + anx7411_partner_unregister_altmode(ctx); > + > + if (ctx->typec.partner) > + anx7411_unregister_partner(ctx); > + > + mutex_unlock(&ctx->lock); > + > + return 0; > +} > + > +static int __maybe_unused anx7411_runtime_pm_resume(struct device *dev) > +{ > + struct anx7411_data *ctx = dev_get_drvdata(dev); > + > + mutex_lock(&ctx->lock); > + /* Detect PD connection */ > + anx7411_typec_check_connection(ctx); > + > + mutex_unlock(&ctx->lock); > + > + return 0; > +} > + > +static const struct dev_pm_ops anx7411_pm_ops = { > + SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, > + pm_runtime_force_resume) > + SET_RUNTIME_PM_OPS(anx7411_runtime_pm_suspend, > + anx7411_runtime_pm_resume, NULL) > +}; > + > +static void anx7411_get_gpio_irq(struct anx7411_data *ctx) > +{ > + struct device *dev = &ctx->tcpc_client->dev; > + > + ctx->intp_gpiod = devm_gpiod_get_optional(dev, "interrupt", GPIOD_IN); > + if (!ctx->intp_gpiod) { > + dev_err(dev, "no interrupt gpio property\n"); > + return; > + } > + > + ctx->intp_irq = gpiod_to_irq(ctx->intp_gpiod); > + dev_info(dev, "request gpio(%d) irq(%d)\n", > + desc_to_gpio(ctx->intp_gpiod), ctx->intp_irq); > + > + if (!ctx->intp_irq) > + dev_err(dev, "failed to get GPIO IRQ\n"); > +} > + > +static const char *anx7411_psy_name_prefix = "anx7411-source-psy-"; > + > +static enum power_supply_usb_type anx7411_psy_usb_types[] = { > + POWER_SUPPLY_USB_TYPE_C, > + POWER_SUPPLY_USB_TYPE_PD, > + POWER_SUPPLY_USB_TYPE_PD_PPS, > +}; > + > +static enum power_supply_property anx7411_psy_props[] = { > + POWER_SUPPLY_PROP_USB_TYPE, > + POWER_SUPPLY_PROP_ONLINE, > + POWER_SUPPLY_PROP_VOLTAGE_MIN, > + POWER_SUPPLY_PROP_VOLTAGE_MAX, > + POWER_SUPPLY_PROP_VOLTAGE_NOW, > + POWER_SUPPLY_PROP_CURRENT_MAX, > + POWER_SUPPLY_PROP_CURRENT_NOW, > +}; > + > +static int anx7411_psy_set_prop(struct power_supply *psy, > + enum power_supply_property psp, > + const union power_supply_propval *val) > +{ > + struct anx7411_data *ctx = power_supply_get_drvdata(psy); > + int ret = 0; > + > + if (psp == POWER_SUPPLY_PROP_ONLINE) > + ctx->psy_online = val->intval; > + else > + ret = -EINVAL; > + > + power_supply_changed(ctx->psy); > + return ret; > +} > + > +static int anx7411_psy_prop_writeable(struct power_supply *psy, > + enum power_supply_property psp) > +{ > + return psp == POWER_SUPPLY_PROP_ONLINE; > +} > + > +static int anx7411_psy_get_prop(struct power_supply *psy, > + enum power_supply_property psp, > + union power_supply_propval *val) > +{ > + struct anx7411_data *ctx = power_supply_get_drvdata(psy); > + int ret = 0; > + > + switch (psp) { > + case POWER_SUPPLY_PROP_USB_TYPE: > + val->intval = ctx->usb_type; > + break; > + case POWER_SUPPLY_PROP_ONLINE: > + val->intval = ctx->psy_online; > + break; > + case POWER_SUPPLY_PROP_VOLTAGE_NOW: > + case POWER_SUPPLY_PROP_VOLTAGE_MIN: > + case POWER_SUPPLY_PROP_VOLTAGE_MAX: > + val->intval = (ctx->psy_online) ? > + ctx->typec.request_voltage * 1000 : 0; > + break; > + case POWER_SUPPLY_PROP_CURRENT_NOW: > + case POWER_SUPPLY_PROP_CURRENT_MAX: > + val->intval = (ctx->psy_online) ? > + ctx->typec.request_current * 1000 : 0; > + break; > + default: > + ret = -EINVAL; > + break; > + } > + return ret; > +} > + > +static int anx7411_psy_register(struct anx7411_data *ctx) > +{ > + struct power_supply_config psy_cfg = {}; > + const char *port_dev_name = dev_name(ctx->dev); > + size_t psy_name_len = strlen(anx7411_psy_name_prefix) + > + strlen(port_dev_name) + 1; > + char *psy_name; > + struct power_supply_desc *psy_desc = &ctx->psy_desc; > + > + psy_cfg.drv_data = ctx; > + psy_cfg.fwnode = dev_fwnode(ctx->dev); > + psy_name = devm_kzalloc(ctx->dev, psy_name_len, GFP_KERNEL); > + if (!psy_name) { > + dev_warn(ctx->dev, "unable to alloc psy memory\n"); > + return -ENOMEM; > + } > + > + snprintf(psy_name, psy_name_len, "%s%s", anx7411_psy_name_prefix, > + port_dev_name); > + > + psy_desc->name = psy_name; > + psy_desc->type = POWER_SUPPLY_TYPE_USB; > + psy_desc->usb_types = anx7411_psy_usb_types; > + psy_desc->num_usb_types = ARRAY_SIZE(anx7411_psy_usb_types); > + psy_desc->properties = anx7411_psy_props, > + psy_desc->num_properties = ARRAY_SIZE(anx7411_psy_props), > + > + psy_desc->get_property = anx7411_psy_get_prop, > + psy_desc->set_property = anx7411_psy_set_prop, > + psy_desc->property_is_writeable = anx7411_psy_prop_writeable, > + > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_C; > + ctx->psy = devm_power_supply_register(ctx->dev, psy_desc, &psy_cfg); > + > + if (IS_ERR(ctx->psy)) > + dev_warn(ctx->dev, "unable to register psy\n"); > + > + return PTR_ERR_OR_ZERO(ctx->psy); > +} > + > +static int anx7411_i2c_probe(struct i2c_client *client, > + const struct i2c_device_id *id) > +{ > + struct anx7411_data *plat; > + struct device *dev = &client->dev; > + int ret; > + > + if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_I2C_BLOCK)) > + return -ENODEV; > + > + plat = devm_kzalloc(dev, sizeof(*plat), GFP_KERNEL); > + if (!plat) > + return -ENOMEM; > + > + plat->tcpc_client = client; > + i2c_set_clientdata(client, plat); > + > + mutex_init(&plat->lock); > + > + ret = anx7411_register_i2c_dummy_clients(plat, client); > + if (ret) { > + dev_err(dev, "fail to reserve I2C bus\n"); > + return ret; > + } > + > + ret = anx7411_typec_switch_probe(plat, dev); > + if (ret) { > + dev_err(dev, "fail to probe typec switch\n"); > + goto free_i2c_dummy; > + } > + > + ret = anx7411_typec_port_probe(plat, dev); > + if (ret) { > + dev_err(dev, "fail to probe typec property.\n"); > + ret = -ENODEV; > + goto free_typec_switch; > + } > + > + plat->intp_irq = client->irq; > + if (!client->irq) { > + dev_warn(dev, "no default interrupt IRQ, probe GPIO interrupt"); > + anx7411_get_gpio_irq(plat); > + } > + > + if (!plat->intp_irq) { > + dev_err(dev, "fail to get interrupt IRQ\n"); > + goto free_typec_port; > + } > + > + plat->dev = dev; > + plat->psy_online = ANX7411_PSY_OFFLINE; > + anx7411_psy_register(plat); > + > + if (plat->intp_irq) { > + INIT_WORK(&plat->work, anx7411_work_func); > + plat->workqueue = alloc_workqueue("anx7411_work", > + WQ_FREEZABLE | > + WQ_MEM_RECLAIM, > + 1); > + if (!plat->workqueue) { > + dev_err(dev, "fail to create work queue\n"); > + ret = -ENOMEM; > + goto free_typec_port; > + } > + > + ret = devm_request_threaded_irq(dev, plat->intp_irq, > + NULL, anx7411_intr_isr, > + IRQF_TRIGGER_FALLING | > + IRQF_ONESHOT, > + "anx7411-intp", plat); > + if (ret) { > + dev_err(dev, "fail to request irq\n"); > + goto free_wq; > + } > + } > + > + anx7411_typec_check_connection(plat); > + > + pm_runtime_enable(dev); > + > + return 0; > + > +free_wq: > + destroy_workqueue(plat->workqueue); > + > +free_typec_port: > + typec_unregister_port(plat->typec.port); > + anx7411_port_unregister_altmodes(plat->typec.port_amode); > + > +free_typec_switch: > + anx7411_unregister_switch(plat); > + anx7411_unregister_mux(plat); > + > +free_i2c_dummy: > + i2c_unregister_device(plat->spi_client); > + > + return ret; > +} > + > +static int anx7411_i2c_remove(struct i2c_client *client) > +{ > + struct anx7411_data *plat = i2c_get_clientdata(client); > + > + anx7411_partner_unregister_altmode(plat); > + anx7411_unregister_partner(plat); > + > + if (plat->workqueue) > + destroy_workqueue(plat->workqueue); > + > + if (plat->spi_client) > + i2c_unregister_device(plat->spi_client); > + > + if (plat->typec.role_sw) > + usb_role_switch_put(plat->typec.role_sw); > + > + anx7411_unregister_mux(plat); > + > + anx7411_unregister_switch(plat); > + > + if (plat->typec.port) > + typec_unregister_port(plat->typec.port); > + > + anx7411_port_unregister_altmodes(plat->typec.port_amode); > + > + return 0; > +} > + > +static const struct i2c_device_id anx7411_id[] = { > + {"anx7411", 0}, > + {} > +}; > + > +MODULE_DEVICE_TABLE(i2c, anx7411_id); > + > +static const struct of_device_id anx_match_table[] = { > + {.compatible = "analogix,anx7411",}, > + {}, > +}; > + > +static struct i2c_driver anx7411_driver = { > + .driver = { > + .name = "anx7411", > + .of_match_table = anx_match_table, > + .pm = &anx7411_pm_ops, > + }, > + .probe = anx7411_i2c_probe, > + .remove = anx7411_i2c_remove, > + > + .id_table = anx7411_id, > +}; > + > +module_i2c_driver(anx7411_driver); > + > +MODULE_DESCRIPTION("Anx7411 USB Type-C PD driver"); > +MODULE_AUTHOR("Xin Ji <xji@analogixsemi.com>"); > +MODULE_LICENSE("GPL v2"); > +MODULE_VERSION("0.1.5"); > diff --git a/drivers/usb/typec/anx7411.h b/drivers/usb/typec/anx7411.h > new file mode 100644 > index 000000000000..09ff80517a5c > --- /dev/null > +++ b/drivers/usb/typec/anx7411.h > @@ -0,0 +1,265 @@ > +/* SPDX-License-Identifier: GPL-2.0-only */ > + > +/* > + * Copyright(c) 2022, Analogix Semiconductor. All rights reserved. > + * > + */ > + > +#ifndef __ANX7411_H__ > +#define __ANX7411_H__ > + > +#define TCPC_ADDRESS1 0x58 > +#define TCPC_ADDRESS2 0x56 > +#define TCPC_ADDRESS3 0x54 > +#define TCPC_ADDRESS4 0x52 > +#define SPI_ADDRESS1 0x7e > +#define SPI_ADDRESS2 0x6e > +#define SPI_ADDRESS3 0x64 > +#define SPI_ADDRESS4 0x62 > + > +struct anx7411_i2c_select { > + u8 tcpc_address; > + u8 spi_address; > +}; > + > +#define VID_ANALOGIX 0x1F29 > +#define PID_ANALOGIX 0x7411 > + > +/* TCPC register define */ > + > +#define ANALOG_CTRL_10 0xAA > + > +#define STATUS_LEN 2 > +#define ALERT_0 0xCB > +#define RECEIVED_MSG BIT(7) > +#define SOFTWARE_INT BIT(6) > +#define MSG_LEN 32 > +#define HEADER_LEN 2 > +#define MSG_HEADER 0x00 > +#define MSG_TYPE 0x01 > +#define MSG_RAWDATA 0x02 > +#define MSG_LEN_MASK 0x1F > + > +#define ALERT_1 0xCC > +#define INTP_POW_ON BIT(7) > +#define INTP_POW_OFF BIT(6) > + > +#define VBUS_THRESHOLD_H 0xDD > +#define VBUS_THRESHOLD_L 0xDE > + > +#define FW_CTRL_0 0xF0 > +#define UNSTRUCT_VDM_EN BIT(0) > +#define DELAY_200MS BIT(1) > +#define VSAFE0 0 > +#define VSAFE1 BIT(2) > +#define VSAFE2 BIT(3) > +#define VSAFE3 (BIT(2) | BIT(3)) > +#define FRS_EN BIT(7) > + > +#define FW_PARAM 0xF1 > +#define DONGLE_IOP BIT(0) > + > +#define FW_CTRL_2 0xF7 > +#define SINK_CTRL_DIS_FLAG BIT(5) > + > +/* SPI register define */ > +#define OCM_CTRL_0 0x6E > +#define OCM_RESET BIT(6) > + > +#define MAX_VOLTAGE 0xAC > +#define MAX_POWER 0xAD > +#define MIN_POWER 0xAE > + > +#define REQUEST_VOLTAGE 0xAF > +#define VOLTAGE_UNIT 100 /* mV per unit */ > + > +#define REQUEST_CURRENT 0xB1 > +#define CURRENT_UNIT 50 /* mA per unit */ > + > +#define CMD_SEND_BUF 0xC0 > +#define CMD_RECV_BUF 0xE0 > + > +#define REQ_VOL_20V_IN_100MV 0xC8 > +#define REQ_CUR_2_25A_IN_50MA 0x2D > +#define REQ_CUR_3_25A_IN_50MA 0x41 > + > +#define DEF_5V 5000 > +#define DEF_1_5A 1500 > + > +#define LOBYTE(w) ((u8)(w) & 0xFF) > +#define HIBYTE(w) ((u8)(((u16)(w) >> 8) & 0xFF)) > + > +enum anx7411_typec_message_type { > + TYPE_SRC_CAP = 0x00, > + TYPE_SNK_CAP = 0x01, > + TYPE_SNK_IDENTITY = 0x02, > + TYPE_SVID = 0x03, > + TYPE_SET_SNK_DP_CAP = 0x08, > + TYPE_PSWAP_REQ = 0x10, > + TYPE_DSWAP_REQ = 0x11, > + TYPE_VDM = 0x14, > + TYPE_OBJ_REQ = 0x16, > + TYPE_DP_ALT_ENTER = 0x19, > + TYPE_DP_DISCOVER_MODES_INFO = 0x27, > + TYPE_GET_DP_CONFIG = 0x29, > + TYPE_DP_CONFIGURE = 0x2A, > + TYPE_GET_DP_DISCOVER_MODES_INFO = 0x2E, > + TYPE_GET_DP_ALT_ENTER = 0x2F, > +}; > + > +#define FW_CTRL_1 0xB2 > +#define AUTO_PD_EN BIT(1) > +#define TRYSRC_EN BIT(2) > +#define TRYSNK_EN BIT(3) > +#define FORCE_SEND_RDO BIT(6) > + > +#define FW_VER 0xB4 > +#define FW_SUBVER 0xB5 > + > +#define INT_MASK 0xB6 > +#define INT_STS 0xB7 > +#define OCM_BOOT_UP BIT(0) > +#define OC_OV_EVENT BIT(1) > +#define VCONN_CHANGE BIT(2) > +#define VBUS_CHANGE BIT(3) > +#define CC_STATUS_CHANGE BIT(4) > +#define DATA_ROLE_CHANGE BIT(5) > +#define PR_CONSUMER_GOT_POWER BIT(6) > +#define HPD_STATUS_CHANGE BIT(7) > + > +#define SYSTEM_STSTUS 0xB8 > +/* 0: SINK off; 1: SINK on */ > +#define SINK_STATUS BIT(1) > +/* 0: VCONN off; 1: VCONN on*/ > +#define VCONN_STATUS BIT(2) > +/* 0: vbus off; 1: vbus on*/ > +#define VBUS_STATUS BIT(3) > +/* 1: host; 0:device*/ > +#define DATA_ROLE BIT(5) > +/* 0: Chunking; 1: Unchunked*/ > +#define SUPPORT_UNCHUNKING BIT(6) > +/* 0: HPD low; 1: HPD high*/ > +#define HPD_STATUS BIT(7) > + > +#define DATA_DFP 1 > +#define DATA_UFP 2 > +#define POWER_SOURCE 1 > +#define POWER_SINK 2 > + > +#define CC_STATUS 0xB9 > +#define CC1_RD BIT(0) > +#define CC2_RD BIT(4) > +#define CC1_RA BIT(1) > +#define CC2_RA BIT(5) > +#define CC1_RD BIT(0) > +#define CC1_RP(cc) (((cc) >> 2) & 0x03) > +#define CC2_RP(cc) (((cc) >> 6) & 0x03) > + > +#define PD_REV_INIT 0xBA > + > +#define PD_EXT_MSG_CTRL 0xBB > +#define SRC_CAP_EXT_REPLY BIT(0) > +#define MANUFACTURER_INFO_REPLY BIT(1) > +#define BATTERY_STS_REPLY BIT(2) > +#define BATTERY_CAP_REPLY BIT(3) > +#define ALERT_REPLY BIT(4) > +#define STATUS_REPLY BIT(5) > +#define PPS_STATUS_REPLY BIT(6) > +#define SNK_CAP_EXT_REPLY BIT(7) > + > +#define NO_CONNECT 0x00 > +#define USB3_1_CONNECTED 0x01 > +#define DP_ALT_4LANES 0x02 > +#define USB3_1_DP_2LANES 0x03 > +#define CC1_CONNECTED 0x01 > +#define CC2_CONNECTED 0x02 > +#define SELECT_PIN_ASSIGMENT_C 0x04 > +#define SELECT_PIN_ASSIGMENT_D 0x08 > +#define SELECT_PIN_ASSIGMENT_E 0x10 > +#define SELECT_PIN_ASSIGMENT_U 0x00 > +#define REDRIVER_ADDRESS 0x20 > +#define REDRIVER_OFFSET 0x00 > + > +#define DP_SVID 0xFF01 > +#define VDM_ACK 0x40 > +#define VDM_CMD_RES 0x00 > +#define VDM_CMD_DIS_ID 0x01 > +#define VDM_CMD_DIS_SVID 0x02 > +#define VDM_CMD_DIS_MOD 0x03 > +#define VDM_CMD_ENTER_MODE 0x04 > +#define VDM_CMD_EXIT_MODE 0x05 > +#define VDM_CMD_ATTENTION 0x06 > +#define VDM_CMD_GET_STS 0x10 > +#define VDM_CMD_AND_ACK_MASK 0x5F > + > +#define MAX_ALTMODE 2 > + > +#define HAS_SOURCE_CAP BIT(0) > +#define HAS_SINK_CAP BIT(1) > +#define HAS_SINK_WATT BIT(2) > + > +enum anx7411_psy_state { > + /* copy from drivers/usb/typec/tcpm */ > + ANX7411_PSY_OFFLINE = 0, > + ANX7411_PSY_FIXED_ONLINE, > + > + /* private */ > + /* PD keep in, but disconnct power to bq25700, > + * this state can be active when higher capacity adapter plug in, > + * and change to ONLINE state when higher capacity adapter plug out > + */ > + ANX7411_PSY_HANG = 0xff, > +}; > + > +struct typec_params { > + int request_current; /* ma */ > + int request_voltage; /* mv */ > + int cc_connect; > + int cc_orientation_valid; > + int cc_status; > + int data_role; > + int power_role; > + int vconn_role; > + int dp_altmode_enter; > + int cust_altmode_enter; > + struct usb_role_switch *role_sw; > + struct typec_port *port; > + struct typec_partner *partner; > + struct typec_mux_dev *typec_mux; > + struct typec_switch_dev *typec_switch; > + struct typec_altmode *amode[MAX_ALTMODE]; > + struct typec_altmode *port_amode[MAX_ALTMODE]; > + struct typec_displayport_data data; > + int pin_assignment; > + struct typec_capability caps; > + u32 src_pdo[PDO_MAX_OBJECTS]; > + u32 sink_pdo[PDO_MAX_OBJECTS]; > + u8 caps_flags; > + u8 src_pdo_nr; > + u8 sink_pdo_nr; > + u8 sink_watt; > + u8 sink_voltage; > +}; > + > +struct anx7411_data { > + int fw_version; > + int fw_subversion; > + struct i2c_client *tcpc_client; > + struct i2c_client *spi_client; > + struct gpio_desc *intp_gpiod; > + struct fwnode_handle *connector_fwnode; > + struct typec_params typec; > + int intp_irq; > + struct work_struct work; > + struct workqueue_struct *workqueue; > + /* Lock for interrupt work queue */ > + struct mutex lock; > + > + enum anx7411_psy_state psy_online; > + enum power_supply_usb_type usb_type; > + struct power_supply *psy; > + struct power_supply_desc psy_desc; > + struct device *dev; > +}; > + > +#endif /* __ANX7411_H__ */ > -- > 2.25.1
On Tue, Jun 14, 2022 at 12:16:51PM +0300, Heikki Krogerus wrote: > On Mon, Jun 13, 2022 at 05:59:56PM +0800, Xin Ji wrote: > > Add driver for analogix ANX7411 USB Type-C DRP port controller. > > > > Signed-off-by: Xin Ji <xji@analogixsemi.com> > > --- > > V9 -> V10 : Rebase on the latest code > > It looks like you did not check the comments I made in v9. Please go > over those and resend. Hi Heikki, sorry, I'll check it again. Thanks, Xin > > thanks, > > > V6 -> V7 : Fix Heikki's comment > > Rebase on Greg's latest usb-next branch > > Move tcpci.h to include/linux/usb/ > > Remove double definition > > V5 -> V6 : Fix Heikki's comment > > V4 -> V5 : Fix Greg h-k comment, remove DEBUG define > > V3 -> V4 : Fix compiling waring > > V2 -> V3 : Add changelog history > > V1 -> V2 : Fix compiling warning issue > > --- > > drivers/usb/typec/Kconfig | 11 + > > drivers/usb/typec/Makefile | 1 + > > drivers/usb/typec/anx7411.c | 1327 +++++++++++++++++++++++++++++++++++ > > drivers/usb/typec/anx7411.h | 265 +++++++ > > 4 files changed, 1604 insertions(+) > > create mode 100644 drivers/usb/typec/anx7411.c > > create mode 100644 drivers/usb/typec/anx7411.h > > > > diff --git a/drivers/usb/typec/Kconfig b/drivers/usb/typec/Kconfig > > index ba24847fb245..5defdfead653 100644 > > --- a/drivers/usb/typec/Kconfig > > +++ b/drivers/usb/typec/Kconfig > > @@ -52,6 +52,17 @@ source "drivers/usb/typec/ucsi/Kconfig" > > > > source "drivers/usb/typec/tipd/Kconfig" > > > > +config TYPEC_ANX7411 > > + tristate "Analogix ANX7411 Type-C DRP Port controller driver" > > + depends on I2C > > + depends on USB_ROLE_SWITCH > > + help > > + Say Y or M here if your system has Analogix ANX7411 Type-C DRP Port > > + controller driver. > > + > > + If you choose to build this driver as a dynamically linked module, the > > + module will be called anx7411.ko. > > + > > config TYPEC_RT1719 > > tristate "Richtek RT1719 Sink Only Type-C controller driver" > > depends on USB_ROLE_SWITCH || !USB_ROLE_SWITCH > > diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile > > index 2f174cd3e5df..dac5c11a3234 100644 > > --- a/drivers/usb/typec/Makefile > > +++ b/drivers/usb/typec/Makefile > > @@ -6,6 +6,7 @@ obj-$(CONFIG_TYPEC) += altmodes/ > > obj-$(CONFIG_TYPEC_TCPM) += tcpm/ > > obj-$(CONFIG_TYPEC_UCSI) += ucsi/ > > obj-$(CONFIG_TYPEC_TPS6598X) += tipd/ > > +obj-$(CONFIG_TYPEC_ANX7411) += anx7411.o > > obj-$(CONFIG_TYPEC_HD3SS3220) += hd3ss3220.o > > obj-$(CONFIG_TYPEC_QCOM_PMIC) += qcom-pmic-typec.o > > obj-$(CONFIG_TYPEC_STUSB160X) += stusb160x.o > > diff --git a/drivers/usb/typec/anx7411.c b/drivers/usb/typec/anx7411.c > > new file mode 100644 > > index 000000000000..cc208cdd8762 > > --- /dev/null > > +++ b/drivers/usb/typec/anx7411.c > > @@ -0,0 +1,1327 @@ > > +// SPDX-License-Identifier: GPL-2.0-only > > + > > +/* > > + * Copyright(c) 2022, Analogix Semiconductor. All rights reserved. > > + * > > + */ > > +#include <linux/gpio/consumer.h> > > +#include <linux/i2c.h> > > +#include <linux/interrupt.h> > > +#include <linux/iopoll.h> > > +#include <linux/kernel.h> > > +#include <linux/module.h> > > +#include <linux/mutex.h> > > +#include <linux/of_graph.h> > > +#include <linux/of_platform.h> > > +#include <linux/pm_runtime.h> > > +#include <linux/regulator/consumer.h> > > +#include <linux/slab.h> > > +#include <linux/types.h> > > +#include <linux/usb/pd.h> > > +#include <linux/usb/role.h> > > +#include <linux/usb/tcpci.h> > > +#include <linux/usb/typec.h> > > +#include <linux/usb/typec_dp.h> > > +#include <linux/usb/typec_mux.h> > > +#include <linux/workqueue.h> > > +#include <linux/power_supply.h> > > + > > +#include "anx7411.h" > > + > > +static u8 snk_identity[] = { > > + LOBYTE(VID_ANALOGIX), HIBYTE(VID_ANALOGIX), 0x00, 0x82, /* snk_id_hdr */ > > + 0x00, 0x00, 0x00, 0x00, /* snk_cert */ > > + 0x00, 0x00, LOBYTE(PID_ANALOGIX), HIBYTE(PID_ANALOGIX), /* 5snk_ama */ > > +}; > > + > > +static u8 dp_caps[4] = {0xC6, 0x00, 0x00, 0x00}; > > + > > +static int anx7411_reg_read(struct i2c_client *client, > > + u8 reg_addr) > > +{ > > + return i2c_smbus_read_byte_data(client, reg_addr); > > +} > > + > > +static int anx7411_reg_block_read(struct i2c_client *client, > > + u8 reg_addr, u8 len, u8 *buf) > > +{ > > + return i2c_smbus_read_i2c_block_data(client, reg_addr, len, buf); > > +} > > + > > +static int anx7411_reg_write(struct i2c_client *client, > > + u8 reg_addr, u8 reg_val) > > +{ > > + return i2c_smbus_write_byte_data(client, reg_addr, reg_val); > > +} > > + > > +static int anx7411_reg_block_write(struct i2c_client *client, > > + u8 reg_addr, u8 len, u8 *buf) > > +{ > > + return i2c_smbus_write_i2c_block_data(client, reg_addr, len, buf); > > +} > > + > > +static struct anx7411_i2c_select anx7411_i2c_addr[] = { > > + {TCPC_ADDRESS1, SPI_ADDRESS1}, > > + {TCPC_ADDRESS2, SPI_ADDRESS2}, > > + {TCPC_ADDRESS3, SPI_ADDRESS3}, > > + {TCPC_ADDRESS4, SPI_ADDRESS4}, > > +}; > > + > > +static int anx7411_detect_power_mode(struct anx7411_data *ctx) > > +{ > > + int ret; > > + int mode; > > + > > + ret = anx7411_reg_read(ctx->spi_client, REQUEST_CURRENT); > > + if (ret < 0) > > + return ret; > > + > > + ctx->typec.request_current = ret * CURRENT_UNIT; /* 50ma per unit */ > > + > > + ret = anx7411_reg_read(ctx->spi_client, REQUEST_VOLTAGE); > > + if (ret < 0) > > + return ret; > > + > > + ctx->typec.request_voltage = ret * VOLTAGE_UNIT; /* 100mv per unit */ > > + > > + if (ctx->psy_online == ANX7411_PSY_OFFLINE) { > > + ctx->psy_online = ANX7411_PSY_FIXED_ONLINE; > > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_PD; > > + power_supply_changed(ctx->psy); > > + } > > + > > + if (!ctx->typec.cc_orientation_valid) > > + return 0; > > + > > + if (ctx->typec.cc_connect == CC1_CONNECTED) > > + mode = CC1_RP(ctx->typec.cc_status); > > + else > > + mode = CC2_RP(ctx->typec.cc_status); > > + if (mode) { > > + typec_set_pwr_opmode(ctx->typec.port, mode - 1); > > + return 0; > > + } > > + > > + typec_set_pwr_opmode(ctx->typec.port, TYPEC_PWR_MODE_PD); > > + > > + return 0; > > +} > > + > > +static int anx7411_register_partner(struct anx7411_data *ctx, > > + int pd, int accessory) > > +{ > > + struct typec_partner_desc desc; > > + > > + if (ctx->typec.partner) > > + return 0; > > + > > + desc.usb_pd = pd; > > + desc.accessory = accessory; > > + desc.identity = NULL; > > + ctx->typec.partner = typec_register_partner(ctx->typec.port, &desc); > > + if (IS_ERR(ctx->typec.partner)) { > > + ctx->typec.partner = NULL; > > + return PTR_ERR(ctx->typec.partner); > > + } > > + > > + return 0; > > +} > > + > > +static int anx7411_detect_cc_orientation(struct anx7411_data *ctx) > > +{ > > + int ret; > > + int cc1_rd, cc2_rd; > > + int cc1_ra, cc2_ra; > > + int cc1_rp, cc2_rp; > > + > > + ret = anx7411_reg_read(ctx->spi_client, CC_STATUS); > > + if (ret < 0) > > + return ret; > > + > > + ctx->typec.cc_status = ret; > > + > > + cc1_rd = ret & CC1_RD ? 1 : 0; > > + cc2_rd = ret & CC2_RD ? 1 : 0; > > + cc1_ra = ret & CC1_RA ? 1 : 0; > > + cc2_ra = ret & CC2_RA ? 1 : 0; > > + cc1_rp = CC1_RP(ret); > > + cc2_rp = CC2_RP(ret); > > + > > + /* Debug cable, nothing to do */ > > + if (cc1_rd && cc2_rd) { > > + ctx->typec.cc_orientation_valid = 0; > > + anx7411_register_partner(ctx, 0, TYPEC_ACCESSORY_DEBUG); > > + return 0; > > + } > > + > > + if (cc1_ra && cc2_ra) { > > + ctx->typec.cc_orientation_valid = 0; > > + anx7411_register_partner(ctx, 0, TYPEC_ACCESSORY_AUDIO); > > + return 0; > > + } > > + > > + ctx->typec.cc_orientation_valid = 1; > > + > > + anx7411_register_partner(ctx, 1, TYPEC_ACCESSORY_NONE); > > + > > + if (cc1_rd || cc1_rp) { > > + typec_set_orientation(ctx->typec.port, > > + TYPEC_ORIENTATION_NORMAL); > > + ctx->typec.cc_connect = CC1_CONNECTED; > > + } > > + > > + if (cc2_rd || cc2_rp) { > > + typec_set_orientation(ctx->typec.port, > > + TYPEC_ORIENTATION_REVERSE); > > + ctx->typec.cc_connect = CC2_CONNECTED; > > + } > > + > > + return 0; > > +} > > + > > +static int anx7411_set_mux(struct anx7411_data *ctx, int pin_assignment) > > +{ > > + int mode = TYPEC_STATE_SAFE; > > + > > + switch (pin_assignment) { > > + case SELECT_PIN_ASSIGMENT_U: > > + /* default 4 line USB 3.1 */ > > + mode = TYPEC_STATE_MODAL; > > + break; > > + case SELECT_PIN_ASSIGMENT_C: > > + case SELECT_PIN_ASSIGMENT_E: > > + /* 4 line DP */ > > + mode = TYPEC_STATE_SAFE; > > + break; > > + case SELECT_PIN_ASSIGMENT_D: > > + /* 2 line DP, 2 line USB */ > > + mode = TYPEC_MODE_USB3; > > + break; > > + default: > > + mode = TYPEC_STATE_SAFE; > > + break; > > + } > > + > > + ctx->typec.pin_assignment = pin_assignment; > > + > > + return typec_set_mode(ctx->typec.port, mode); > > +} > > + > > +static void anx7411_set_usb_role(struct anx7411_data *ctx, enum usb_role role) > > +{ > > + if (!ctx->typec.role_sw) > > + return; > > + > > + usb_role_switch_set_role(ctx->typec.role_sw, role); > > +} > > + > > +static int anx7411_data_role_detect(struct anx7411_data *ctx) > > +{ > > + int ret; > > + > > + ret = anx7411_reg_read(ctx->spi_client, SYSTEM_STSTUS); > > + if (ret < 0) > > + return ret; > > + > > + ctx->typec.data_role = (ret & DATA_ROLE) ? TYPEC_HOST : TYPEC_DEVICE; > > + ctx->typec.vconn_role = (ret & VCONN_STATUS) ? TYPEC_SOURCE : TYPEC_SINK; > > + > > + typec_set_data_role(ctx->typec.port, ctx->typec.data_role); > > + typec_set_vconn_role(ctx->typec.port, ctx->typec.vconn_role); > > + > > + if (ctx->typec.data_role == TYPEC_HOST) > > + anx7411_set_usb_role(ctx, USB_ROLE_HOST); > > + else > > + anx7411_set_usb_role(ctx, USB_ROLE_DEVICE); > > + > > + return 0; > > +} > > + > > +static int anx7411_power_role_detect(struct anx7411_data *ctx) > > +{ > > + int ret; > > + > > + ret = anx7411_reg_read(ctx->spi_client, SYSTEM_STSTUS); > > + if (ret < 0) > > + return ret; > > + > > + ctx->typec.power_role = (ret & SINK_STATUS) ? TYPEC_SINK : TYPEC_SOURCE; > > + > > + if (ctx->typec.power_role == TYPEC_SOURCE) { > > + ctx->typec.request_current = DEF_1_5A; > > + ctx->typec.request_voltage = DEF_5V; > > + } > > + > > + typec_set_pwr_role(ctx->typec.port, ctx->typec.power_role); > > + > > + return 0; > > +} > > + > > +static int anx7411_cc_status_detect(struct anx7411_data *ctx) > > +{ > > + anx7411_detect_cc_orientation(ctx); > > + anx7411_detect_power_mode(ctx); > > + > > + return 0; > > +} > > + > > +static int anx7411_partner_unregister_altmode(struct anx7411_data *ctx) > > +{ > > + int i; > > + > > + ctx->typec.dp_altmode_enter = 0; > > + ctx->typec.cust_altmode_enter = 0; > > + > > + for (i = 0; i < MAX_ALTMODE; i++) > > + if (ctx->typec.amode[i]) { > > + typec_unregister_altmode(ctx->typec.amode[i]); > > + ctx->typec.amode[i] = NULL; > > + } > > + > > + ctx->typec.pin_assignment = 0; > > + return 0; > > +} > > + > > +static int anx7411_typec_register_altmode(struct anx7411_data *ctx, > > + int svid, int vdo) > > +{ > > + struct device *dev = &ctx->spi_client->dev; > > + struct typec_altmode_desc desc; > > + int i; > > + > > + desc.svid = svid; > > + desc.vdo = vdo; > > + > > + for (i = 0; i < MAX_ALTMODE; i++) > > + if (!ctx->typec.amode[i]) > > + break; > > + > > + desc.mode = i + 1; /* start with 1 */ > > + > > + if (i >= MAX_ALTMODE) { > > + dev_err(dev, "no altmode space for registering\n"); > > + return -ENOMEM; > > + } > > + > > + ctx->typec.amode[i] = typec_partner_register_altmode(ctx->typec.partner, > > + &desc); > > + if (IS_ERR(ctx->typec.amode[i])) { > > + dev_err(dev, "failed to register altmode\n"); > > + ctx->typec.amode[i] = NULL; > > + return PTR_ERR(ctx->typec.amode); > > + } > > + > > + return 0; > > +} > > + > > +static int anx7411_unregister_partner(struct anx7411_data *ctx) > > +{ > > + if (ctx->typec.partner) { > > + typec_unregister_partner(ctx->typec.partner); > > + ctx->typec.partner = NULL; > > + } > > + > > + return 0; > > +} > > + > > +static int anx7411_update_altmode(struct anx7411_data *ctx, int svid) > > +{ > > + int i; > > + > > + if (svid == DP_SVID) > > + ctx->typec.dp_altmode_enter = 1; > > + else > > + ctx->typec.cust_altmode_enter = 1; > > + > > + for (i = 0; i < MAX_ALTMODE; i++) { > > + if (!ctx->typec.amode[i]) > > + continue; > > + > > + if (ctx->typec.amode[i]->svid == svid) { > > + typec_altmode_update_active(ctx->typec.amode[i], true); > > + typec_altmode_notify(ctx->typec.amode[i], > > + ctx->typec.pin_assignment, > > + &ctx->typec.data); > > + break; > > + } > > + } > > + > > + return 0; > > +} > > + > > +static int anx7411_register_altmode(struct anx7411_data *ctx, > > + bool dp_altmode, u8 *buf) > > +{ > > + int ret; > > + int svid; > > + int mid; > > + > > + if (!ctx->typec.partner) > > + return 0; > > + > > + svid = DP_SVID; > > + if (dp_altmode) { > > + mid = buf[0] | (buf[1] << 8) | (buf[2] << 16) | (buf[3] << 24); > > + > > + return anx7411_typec_register_altmode(ctx, svid, mid); > > + } > > + > > + svid = (buf[3] << 8) | buf[2]; > > + if ((buf[0] & VDM_CMD_AND_ACK_MASK) != (VDM_ACK | VDM_CMD_ENTER_MODE)) > > + return anx7411_update_altmode(ctx, svid); > > + > > + if ((buf[0] & VDM_CMD_AND_ACK_MASK) != (VDM_ACK | VDM_CMD_DIS_MOD)) > > + return 0; > > + > > + mid = buf[4] | (buf[5] << 8) | (buf[6] << 16) | (buf[7] << 24); > > + > > + ret = anx7411_typec_register_altmode(ctx, svid, mid); > > + if (ctx->typec.cust_altmode_enter) > > + ret |= anx7411_update_altmode(ctx, svid); > > + > > + return ret; > > +} > > + > > +static int anx7411_parse_cmd(struct anx7411_data *ctx, u8 type, u8 *buf, u8 len) > > +{ > > + struct device *dev = &ctx->spi_client->dev; > > + u8 cur_50ma, vol_100mv; > > + > > + dev_info(dev, "received message: type:0x%.02x, len:%d, buf[0]:%d\n", > > + type, len, buf[0]); > > + > > + switch (type) { > > + case TYPE_SRC_CAP: > > + cur_50ma = anx7411_reg_read(ctx->spi_client, REQUEST_CURRENT); > > + vol_100mv = anx7411_reg_read(ctx->spi_client, REQUEST_VOLTAGE); > > + dev_info(dev, "get current(%dma), voltage(%dmv), power(%dmw)\n", > > + cur_50ma * CURRENT_UNIT, vol_100mv * VOLTAGE_UNIT, > > + cur_50ma * vol_100mv * 5); > > + > > + ctx->typec.request_voltage = vol_100mv * VOLTAGE_UNIT; > > + ctx->typec.request_current = cur_50ma * CURRENT_UNIT; > > + > > + ctx->psy_online = ANX7411_PSY_FIXED_ONLINE; > > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_PD; > > + power_supply_changed(ctx->psy); > > + break; > > + case TYPE_SNK_CAP: > > + break; > > + case TYPE_SVID: > > + break; > > + case TYPE_SNK_IDENTITY: > > + break; > > + case TYPE_GET_DP_ALT_ENTER: > > + /* DP alt mode enter success */ > > + if (buf[0]) > > + anx7411_update_altmode(ctx, DP_SVID); > > + break; > > + case TYPE_DP_ALT_ENTER: > > + /* Update DP altmode */ > > + anx7411_update_altmode(ctx, DP_SVID); > > + break; > > + case TYPE_OBJ_REQ: > > + anx7411_detect_power_mode(ctx); > > + break; > > + case TYPE_DP_CONFIGURE: > > + anx7411_set_mux(ctx, buf[1]); > > + break; > > + case TYPE_DP_DISCOVER_MODES_INFO: > > + /* Make sure discover modes valid */ > > + if (buf[0] | buf[1]) > > + /* Register DP Altmode */ > > + anx7411_register_altmode(ctx, 1, buf); > > + break; > > + case TYPE_VDM: > > + /* Register other altmode */ > > + anx7411_register_altmode(ctx, 0, buf); > > + break; > > + default: > > + dev_err(dev, "ignore message(0x%.02x).\n", type); > > + break; > > + } > > + > > + return 0; > > +} > > + > > +static u8 checksum(struct device *dev, u8 *buf, u8 len) > > +{ > > + u8 ret = 0; > > + u8 i; > > + > > + for (i = 0; i < len; i++) > > + ret += buf[i]; > > + > > + return ret; > > +} > > + > > +static int anx7411_read_msg_ctrl_status(struct i2c_client *client) > > +{ > > + return anx7411_reg_read(client, CMD_SEND_BUF); > > +} > > + > > +static int anx7411_wait_msg_empty(struct i2c_client *client) > > +{ > > + int val; > > + > > + return readx_poll_timeout(anx7411_read_msg_ctrl_status, > > + client, val, (val < 0) || (val == 0), > > + 2000, 2000 * 150); > > +} > > + > > +static int anx7411_send_msg(struct anx7411_data *ctx, u8 type, u8 *buf, u8 size) > > +{ > > + struct device *dev = &ctx->spi_client->dev; > > + u8 msg[MSG_LEN]; > > + u8 crc; > > + int ret; > > + > > + if (size) > > + memcpy(&msg[MSG_RAWDATA], buf, size); > > + msg[MSG_TYPE] = type; > > + msg[MSG_HEADER] = size + 1; > > + > > + crc = checksum(dev, msg, size + HEADER_LEN); > > + msg[size + HEADER_LEN] = 0 - crc; > > + > > + ret = anx7411_wait_msg_empty(ctx->spi_client); > > + if (ret) > > + return ret; > > + > > + anx7411_reg_block_write(ctx->spi_client, > > + CMD_SEND_BUF + 1, size + HEADER_LEN, > > + &msg[MSG_TYPE]); > > + return anx7411_reg_write(ctx->spi_client, CMD_SEND_BUF, > > + msg[MSG_HEADER]); > > +} > > + > > +static int anx7411_process_cmd(struct anx7411_data *ctx) > > +{ > > + struct device *dev = &ctx->spi_client->dev; > > + u8 msg[MSG_LEN]; > > + u8 len; > > + u8 crc; > > + > > + /* Read message from firmware */ > > + anx7411_reg_block_read(ctx->spi_client, CMD_RECV_BUF, MSG_LEN, msg); > > + anx7411_reg_write(ctx->spi_client, CMD_RECV_BUF, 0); > > + > > + if (!msg[MSG_HEADER]) > > + return 0; > > + > > + len = msg[MSG_HEADER] & MSG_LEN_MASK; > > + crc = checksum(dev, msg, len + HEADER_LEN); > > + if (crc) { > > + dev_err(dev, "message error crc(0x%.02x)\n", crc); > > + return -ERANGE; > > + } > > + > > + return anx7411_parse_cmd(ctx, msg[MSG_TYPE], > > + &msg[MSG_RAWDATA], len - 1); > > +} > > + > > +static void anx7411_translate_payload(struct device *dev, __le32 *payload, > > + u32 *pdo, int nr, const char *type) > > +{ > > + int i; > > + > > + if (nr > PDO_MAX_OBJECTS) { > > + dev_err(dev, "nr(%d) exceed PDO_MAX_OBJECTS(%d)\n", > > + nr, PDO_MAX_OBJECTS); > > + > > + return; > > + } > > + > > + for (i = 0; i < nr; i++) > > + payload[i] = cpu_to_le32(pdo[i]); > > +} > > + > > +static void anx7411_config(struct anx7411_data *ctx) > > +{ > > + struct device *dev = &ctx->spi_client->dev; > > + struct typec_params *typecp = &ctx->typec; > > + __le32 payload[PDO_MAX_OBJECTS]; > > + > > + /* Config PD FW work under PD 2.0 */ > > + anx7411_reg_write(ctx->spi_client, PD_REV_INIT, PD_REV20); > > + anx7411_reg_write(ctx->tcpc_client, FW_CTRL_0, > > + UNSTRUCT_VDM_EN | DELAY_200MS | > > + VSAFE1 | FRS_EN); > > + anx7411_reg_write(ctx->spi_client, FW_CTRL_1, > > + AUTO_PD_EN | FORCE_SEND_RDO); > > + > > + /* Set VBUS current threshold */ > > + anx7411_reg_write(ctx->tcpc_client, VBUS_THRESHOLD_H, 0xff); > > + anx7411_reg_write(ctx->tcpc_client, VBUS_THRESHOLD_L, 0x03); > > + > > + /* Fix dongle compatible issue */ > > + anx7411_reg_write(ctx->tcpc_client, FW_PARAM, > > + anx7411_reg_read(ctx->tcpc_client, FW_PARAM) | > > + DONGLE_IOP); > > + anx7411_reg_write(ctx->spi_client, INT_MASK, 0); > > + > > + anx7411_reg_write(ctx->spi_client, PD_EXT_MSG_CTRL, 0xFF); > > + > > + if (typecp->caps_flags & HAS_SOURCE_CAP) { > > + anx7411_translate_payload(dev, payload, typecp->src_pdo, > > + typecp->src_pdo_nr, "source"); > > + anx7411_send_msg(ctx, TYPE_SRC_CAP, (u8 *)&payload, > > + typecp->src_pdo_nr * 4); > > + anx7411_send_msg(ctx, TYPE_SNK_IDENTITY, snk_identity, > > + sizeof(snk_identity)); > > + anx7411_send_msg(ctx, TYPE_SET_SNK_DP_CAP, dp_caps, > > + sizeof(dp_caps)); > > + } > > + > > + if (typecp->caps_flags & HAS_SINK_CAP) { > > + anx7411_translate_payload(dev, payload, typecp->sink_pdo, > > + typecp->sink_pdo_nr, "sink"); > > + anx7411_send_msg(ctx, TYPE_SNK_CAP, (u8 *)&payload, > > + typecp->sink_pdo_nr * 4); > > + } > > + > > + if (typecp->caps_flags & HAS_SINK_WATT) { > > + if (typecp->sink_watt) { > > + anx7411_reg_write(ctx->spi_client, MAX_POWER, > > + typecp->sink_watt); > > + /* Set min power to 1W */ > > + anx7411_reg_write(ctx->spi_client, MIN_POWER, 2); > > + } > > + > > + if (typecp->sink_voltage) > > + anx7411_reg_write(ctx->spi_client, MAX_VOLTAGE, > > + typecp->sink_voltage); > > + } > > + > > + if (!typecp->caps_flags) > > + usleep_range(5000, 6000); > > + > > + ctx->fw_version = anx7411_reg_read(ctx->spi_client, FW_VER); > > + ctx->fw_subversion = anx7411_reg_read(ctx->spi_client, > > + FW_SUBVER); > > +} > > + > > +static void anx7411_chip_standby(struct anx7411_data *ctx) > > +{ > > + anx7411_reg_write(ctx->spi_client, OCM_CTRL_0, > > + anx7411_reg_read(ctx->spi_client, OCM_CTRL_0) | > > + OCM_RESET); > > + anx7411_reg_write(ctx->tcpc_client, ANALOG_CTRL_10, 0x80); > > + /* Set TCPC to RD and DRP enable */ > > + anx7411_reg_write(ctx->tcpc_client, > > + TCPC_ROLE_CTRL, > > + TCPC_ROLE_CTRL_DRP | > > + (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT) | > > + (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT)); > > + > > + /* Send DRP toggle command */ > > + anx7411_reg_write(ctx->tcpc_client, TCPC_COMMAND, > > + TCPC_CMD_LOOK4CONNECTION); > > + > > + /* Send TCPC enter standby command */ > > + anx7411_reg_write(ctx->tcpc_client, TCPC_COMMAND, TCPC_CMD_I2C_IDLE); > > +} > > + > > +static void anx7411_work_func(struct work_struct *work) > > +{ > > + int ret; > > + u8 buf[STATUS_LEN]; > > + u8 int_change; /* Interrupt change */ > > + u8 int_status; /* Firmware status update */ > > + u8 alert0, alert1; /* Interrupt alert source */ > > + struct anx7411_data *ctx = container_of(work, struct anx7411_data, work); > > + > > + mutex_lock(&ctx->lock); > > + > > + /* Read interrupt change status */ > > + ret = anx7411_reg_block_read(ctx->spi_client, INT_STS, STATUS_LEN, buf); > > + if (ret < 0) { > > + /* Power standby mode, just return */ > > + goto unlock; > > + } > > + int_change = buf[0]; > > + int_status = buf[1]; > > + > > + /* Read alert register */ > > + ret = anx7411_reg_block_read(ctx->tcpc_client, ALERT_0, STATUS_LEN, buf); > > + if (ret < 0) > > + goto unlock; > > + > > + alert0 = buf[0]; > > + alert1 = buf[1]; > > + > > + /* Clear interrupt and alert status */ > > + anx7411_reg_write(ctx->spi_client, INT_STS, 0); > > + anx7411_reg_write(ctx->tcpc_client, ALERT_0, alert0); > > + anx7411_reg_write(ctx->tcpc_client, ALERT_1, alert1); > > + > > + if (alert1 & INTP_POW_OFF) { > > + anx7411_partner_unregister_altmode(ctx); > > + anx7411_set_usb_role(ctx, USB_ROLE_NONE); > > + anx7411_unregister_partner(ctx); > > + ctx->psy_online = ANX7411_PSY_OFFLINE; > > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_C; > > + ctx->typec.request_voltage = 0; > > + ctx->typec.request_current = 0; > > + power_supply_changed(ctx->psy); > > + anx7411_chip_standby(ctx); > > + goto unlock; > > + } > > + > > + if ((alert0 & SOFTWARE_INT) && (int_change & OCM_BOOT_UP)) { > > + anx7411_config(ctx); > > + anx7411_data_role_detect(ctx); > > + anx7411_power_role_detect(ctx); > > + anx7411_set_mux(ctx, SELECT_PIN_ASSIGMENT_C); > > + } > > + > > + if (alert0 & RECEIVED_MSG) > > + anx7411_process_cmd(ctx); > > + > > + ret = (int_status & DATA_ROLE) ? TYPEC_HOST : TYPEC_DEVICE; > > + if (ctx->typec.data_role != ret) > > + anx7411_data_role_detect(ctx); > > + > > + ret = (int_status & SINK_STATUS) ? TYPEC_SINK : TYPEC_SOURCE; > > + if (ctx->typec.power_role != ret) > > + anx7411_power_role_detect(ctx); > > + > > + if ((alert0 & SOFTWARE_INT) && (int_change & CC_STATUS_CHANGE)) > > + anx7411_cc_status_detect(ctx); > > + > > +unlock: > > + mutex_unlock(&ctx->lock); > > +} > > + > > +static irqreturn_t anx7411_intr_isr(int irq, void *data) > > +{ > > + struct anx7411_data *ctx = (struct anx7411_data *)data; > > + > > + queue_work(ctx->workqueue, &ctx->work); > > + > > + return IRQ_HANDLED; > > +} > > + > > +static int anx7411_register_i2c_dummy_clients(struct anx7411_data *ctx, > > + struct i2c_client *client) > > +{ > > + int i; > > + u8 spi_addr; > > + > > + for (i = 0; i < sizeof(anx7411_i2c_addr); i++) { > > + if (client->addr == (anx7411_i2c_addr[i].tcpc_address >> 1)) { > > + spi_addr = anx7411_i2c_addr[i].spi_address >> 1; > > + ctx->spi_client = i2c_new_dummy_device(client->adapter, > > + spi_addr); > > + if (ctx->spi_client) > > + return 0; > > + } > > + } > > + > > + dev_err(&client->dev, "unable to get SPI slave\n"); > > + return -ENOMEM; > > +} > > + > > +static void anx7411_port_unregister_altmodes(struct typec_altmode **adev) > > +{ > > + int i; > > + > > + for (i = 0; i < MAX_ALTMODE; i++) > > + if (adev[i]) { > > + typec_unregister_altmode(adev[i]); > > + adev[i] = NULL; > > + } > > +} > > + > > +static int anx7411_usb_mux_set(struct typec_mux_dev *mux, > > + struct typec_mux_state *state) > > +{ > > + struct anx7411_data *ctx = typec_mux_get_drvdata(mux); > > + struct device *dev = &ctx->spi_client->dev; > > + int has_dp; > > + > > + has_dp = (state->alt && state->alt->svid == USB_TYPEC_DP_SID && > > + state->alt->mode == USB_TYPEC_DP_MODE); > > + if (!has_dp) > > + dev_err(dev, "dp altmode not register\n"); > > + > > + return 0; > > +} > > + > > +static int anx7411_usb_set_orientation(struct typec_switch_dev *sw, > > + enum typec_orientation orientation) > > +{ > > + /* No need set */ > > + > > + return 0; > > +} > > + > > +static int anx7411_register_switch(struct anx7411_data *ctx, > > + struct device *dev, > > + struct fwnode_handle *fwnode) > > +{ > > + struct typec_switch_desc sw_desc = { }; > > + > > + sw_desc.fwnode = fwnode; > > + sw_desc.drvdata = ctx; > > + sw_desc.name = fwnode_get_name(fwnode); > > + sw_desc.set = anx7411_usb_set_orientation; > > + > > + ctx->typec.typec_switch = typec_switch_register(dev, &sw_desc); > > + if (IS_ERR(ctx->typec.typec_switch)) { > > + dev_err(dev, "switch register failed\n"); > > + return PTR_ERR(ctx->typec.typec_switch); > > + } > > + > > + return 0; > > +} > > + > > +static int anx7411_register_mux(struct anx7411_data *ctx, > > + struct device *dev, > > + struct fwnode_handle *fwnode) > > +{ > > + struct typec_mux_desc mux_desc = { }; > > + > > + mux_desc.fwnode = fwnode; > > + mux_desc.drvdata = ctx; > > + mux_desc.name = fwnode_get_name(fwnode); > > + mux_desc.set = anx7411_usb_mux_set; > > + > > + ctx->typec.typec_mux = typec_mux_register(dev, &mux_desc); > > + if (IS_ERR(ctx->typec.typec_mux)) { > > + dev_err(dev, "mux register failed\n"); > > + return PTR_ERR(ctx->typec.typec_mux); > > + } > > + > > + return 0; > > +} > > + > > +static void anx7411_unregister_mux(struct anx7411_data *ctx) > > +{ > > + if (ctx->typec.typec_mux) { > > + typec_mux_unregister(ctx->typec.typec_mux); > > + ctx->typec.typec_mux = NULL; > > + } > > +} > > + > > +static void anx7411_unregister_switch(struct anx7411_data *ctx) > > +{ > > + if (ctx->typec.typec_switch) { > > + typec_switch_unregister(ctx->typec.typec_switch); > > + ctx->typec.typec_switch = NULL; > > + } > > +} > > + > > +static int anx7411_typec_switch_probe(struct anx7411_data *ctx, > > + struct device *dev) > > +{ > > + int ret; > > + struct device_node *node; > > + > > + node = of_find_node_by_name(dev->of_node, "orientation_switch"); > > + if (!node) { > > + dev_info(dev, "no typec switch exist\n"); > > + return 0; > > + } > > + > > + ret = anx7411_register_switch(ctx, dev, &node->fwnode); > > + if (ret) { > > + dev_err(dev, "failed register switch"); > > + return ret; > > + } > > + > > + node = of_find_node_by_name(dev->of_node, "mode_switch"); > > + if (!node) { > > + dev_err(dev, "no typec mux exist"); > > + ret = -ENODEV; > > + goto unregister_switch; > > + } > > + > > + ret = anx7411_register_mux(ctx, dev, &node->fwnode); > > + if (ret) { > > + dev_err(dev, "failed register mode switch"); > > + ret = -ENODEV; > > + goto unregister_switch; > > + } > > + > > + return 0; > > + > > +unregister_switch: > > + anx7411_unregister_switch(ctx); > > + > > + return ret; > > +} > > + > > +static int anx7411_typec_port_probe(struct anx7411_data *ctx, > > + struct device *dev) > > +{ > > + struct typec_capability *cap = &ctx->typec.caps; > > + struct typec_params *typecp = &ctx->typec; > > + struct fwnode_handle *fwnode; > > + const char *buf; > > + int ret, i; > > + > > + fwnode = device_get_named_child_node(dev, "connector"); > > + if (!fwnode) > > + return -EINVAL; > > + > > + ret = fwnode_property_read_string(fwnode, "power-role", &buf); > > + if (ret) { > > + dev_err(dev, "power-role not found: %d\n", ret); > > + return ret; > > + } > > + > > + ret = typec_find_port_power_role(buf); > > + if (ret < 0) > > + return ret; > > + cap->type = ret; > > + > > + ret = fwnode_property_read_string(fwnode, "data-role", &buf); > > + if (ret) { > > + dev_err(dev, "data-role not found: %d\n", ret); > > + return ret; > > + } > > + > > + ret = typec_find_port_data_role(buf); > > + if (ret < 0) > > + return ret; > > + cap->data = ret; > > + > > + ret = fwnode_property_read_string(fwnode, "try-power-role", &buf); > > + if (ret) { > > + dev_err(dev, "try-power-role not found: %d\n", ret); > > + return ret; > > + } > > + > > + ret = typec_find_power_role(buf); > > + if (ret < 0) > > + return ret; > > + cap->prefer_role = ret; > > + > > + /* Get source pdos */ > > + ret = fwnode_property_count_u32(fwnode, "source-pdos"); > > + if (ret > 0) { > > + dev_info(dev, "%d source-pdos found\n", ret); > > + typecp->src_pdo_nr = min(ret, PDO_MAX_OBJECTS); > > + ret = fwnode_property_read_u32_array(fwnode, "source-pdos", > > + typecp->src_pdo, > > + typecp->src_pdo_nr); > > + if (ret < 0) { > > + dev_err(dev, "source cap validate failed: %d\n", ret); > > + return -EINVAL; > > + } > > + > > + typecp->caps_flags |= HAS_SOURCE_CAP; > > + } > > + > > + ret = fwnode_property_count_u32(fwnode, "sink-pdos"); > > + if (ret > 0) { > > + dev_info(dev, "%d sink-pdos found\n", ret); > > + typecp->sink_pdo_nr = min(ret, PDO_MAX_OBJECTS); > > + ret = fwnode_property_read_u32_array(fwnode, "sink-pdos", > > + typecp->sink_pdo, > > + typecp->sink_pdo_nr); > > + if (ret < 0) { > > + dev_err(dev, "sink cap validate failed: %d\n", ret); > > + return -EINVAL; > > + } > > + > > + for (i = 0; i < typecp->sink_pdo_nr; i++) { > > + ret = 0; > > + switch (pdo_type(typecp->sink_pdo[i])) { > > + case PDO_TYPE_FIXED: > > + ret = pdo_fixed_voltage(typecp->sink_pdo[i]); > > + break; > > + case PDO_TYPE_BATT: > > + case PDO_TYPE_VAR: > > + ret = pdo_max_voltage(typecp->sink_pdo[i]); > > + break; > > + case PDO_TYPE_APDO: > > + default: > > + ret = 0; > > + break; > > + } > > + > > + /* 100mv per unit */ > > + typecp->sink_voltage = max(5000, ret) / 100; > > + } > > + > > + typecp->caps_flags |= HAS_SINK_CAP; > > + } > > + > > + if (!fwnode_property_read_u32(fwnode, "op-sink-microwatt", &ret)) { > > + dev_info(dev, "%d sink-microwat found\n", ret); > > + typecp->sink_watt = ret / 500000; /* 500mw per unit */ > > + typecp->caps_flags |= HAS_SINK_WATT; > > + } > > + > > + cap->fwnode = fwnode; > > + > > + ctx->typec.role_sw = usb_role_switch_get(dev); > > + if (IS_ERR(ctx->typec.role_sw)) { > > + dev_err(dev, "USB role switch not found.\n"); > > + ctx->typec.role_sw = NULL; > > + } > > + > > + ctx->typec.port = typec_register_port(dev, cap); > > + if (IS_ERR(ctx->typec.port)) { > > + ret = PTR_ERR(ctx->typec.port); > > + ctx->typec.port = NULL; > > + dev_err(dev, "Failed to register type c port %d\n", ret); > > + return ret; > > + } > > + > > + typec_port_register_altmodes(ctx->typec.port, NULL, ctx, > > + ctx->typec.port_amode, > > + MAX_ALTMODE); > > + > > + return 0; > > +} > > + > > +static int anx7411_typec_check_connection(struct anx7411_data *ctx) > > +{ > > + int ret; > > + > > + ret = anx7411_reg_read(ctx->spi_client, FW_VER); > > + if (ret < 0) > > + return 0; /* No device attached in typec port */ > > + > > + /* Clear interrupt and alert status */ > > + anx7411_reg_write(ctx->spi_client, INT_STS, 0); > > + anx7411_reg_write(ctx->tcpc_client, ALERT_0, 0xFF); > > + anx7411_reg_write(ctx->tcpc_client, ALERT_1, 0xFF); > > + > > + anx7411_cc_status_detect(ctx); > > + anx7411_power_role_detect(ctx); > > + anx7411_data_role_detect(ctx); > > + anx7411_set_mux(ctx, SELECT_PIN_ASSIGMENT_C); > > + > > + anx7411_send_msg(ctx, TYPE_GET_DP_ALT_ENTER, NULL, 0); > > + anx7411_send_msg(ctx, TYPE_GET_DP_DISCOVER_MODES_INFO, NULL, 0); > > + > > + return 0; > > +} > > + > > +static int __maybe_unused anx7411_runtime_pm_suspend(struct device *dev) > > +{ > > + struct anx7411_data *ctx = dev_get_drvdata(dev); > > + > > + mutex_lock(&ctx->lock); > > + > > + anx7411_partner_unregister_altmode(ctx); > > + > > + if (ctx->typec.partner) > > + anx7411_unregister_partner(ctx); > > + > > + mutex_unlock(&ctx->lock); > > + > > + return 0; > > +} > > + > > +static int __maybe_unused anx7411_runtime_pm_resume(struct device *dev) > > +{ > > + struct anx7411_data *ctx = dev_get_drvdata(dev); > > + > > + mutex_lock(&ctx->lock); > > + /* Detect PD connection */ > > + anx7411_typec_check_connection(ctx); > > + > > + mutex_unlock(&ctx->lock); > > + > > + return 0; > > +} > > + > > +static const struct dev_pm_ops anx7411_pm_ops = { > > + SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, > > + pm_runtime_force_resume) > > + SET_RUNTIME_PM_OPS(anx7411_runtime_pm_suspend, > > + anx7411_runtime_pm_resume, NULL) > > +}; > > + > > +static void anx7411_get_gpio_irq(struct anx7411_data *ctx) > > +{ > > + struct device *dev = &ctx->tcpc_client->dev; > > + > > + ctx->intp_gpiod = devm_gpiod_get_optional(dev, "interrupt", GPIOD_IN); > > + if (!ctx->intp_gpiod) { > > + dev_err(dev, "no interrupt gpio property\n"); > > + return; > > + } > > + > > + ctx->intp_irq = gpiod_to_irq(ctx->intp_gpiod); > > + dev_info(dev, "request gpio(%d) irq(%d)\n", > > + desc_to_gpio(ctx->intp_gpiod), ctx->intp_irq); > > + > > + if (!ctx->intp_irq) > > + dev_err(dev, "failed to get GPIO IRQ\n"); > > +} > > + > > +static const char *anx7411_psy_name_prefix = "anx7411-source-psy-"; > > + > > +static enum power_supply_usb_type anx7411_psy_usb_types[] = { > > + POWER_SUPPLY_USB_TYPE_C, > > + POWER_SUPPLY_USB_TYPE_PD, > > + POWER_SUPPLY_USB_TYPE_PD_PPS, > > +}; > > + > > +static enum power_supply_property anx7411_psy_props[] = { > > + POWER_SUPPLY_PROP_USB_TYPE, > > + POWER_SUPPLY_PROP_ONLINE, > > + POWER_SUPPLY_PROP_VOLTAGE_MIN, > > + POWER_SUPPLY_PROP_VOLTAGE_MAX, > > + POWER_SUPPLY_PROP_VOLTAGE_NOW, > > + POWER_SUPPLY_PROP_CURRENT_MAX, > > + POWER_SUPPLY_PROP_CURRENT_NOW, > > +}; > > + > > +static int anx7411_psy_set_prop(struct power_supply *psy, > > + enum power_supply_property psp, > > + const union power_supply_propval *val) > > +{ > > + struct anx7411_data *ctx = power_supply_get_drvdata(psy); > > + int ret = 0; > > + > > + if (psp == POWER_SUPPLY_PROP_ONLINE) > > + ctx->psy_online = val->intval; > > + else > > + ret = -EINVAL; > > + > > + power_supply_changed(ctx->psy); > > + return ret; > > +} > > + > > +static int anx7411_psy_prop_writeable(struct power_supply *psy, > > + enum power_supply_property psp) > > +{ > > + return psp == POWER_SUPPLY_PROP_ONLINE; > > +} > > + > > +static int anx7411_psy_get_prop(struct power_supply *psy, > > + enum power_supply_property psp, > > + union power_supply_propval *val) > > +{ > > + struct anx7411_data *ctx = power_supply_get_drvdata(psy); > > + int ret = 0; > > + > > + switch (psp) { > > + case POWER_SUPPLY_PROP_USB_TYPE: > > + val->intval = ctx->usb_type; > > + break; > > + case POWER_SUPPLY_PROP_ONLINE: > > + val->intval = ctx->psy_online; > > + break; > > + case POWER_SUPPLY_PROP_VOLTAGE_NOW: > > + case POWER_SUPPLY_PROP_VOLTAGE_MIN: > > + case POWER_SUPPLY_PROP_VOLTAGE_MAX: > > + val->intval = (ctx->psy_online) ? > > + ctx->typec.request_voltage * 1000 : 0; > > + break; > > + case POWER_SUPPLY_PROP_CURRENT_NOW: > > + case POWER_SUPPLY_PROP_CURRENT_MAX: > > + val->intval = (ctx->psy_online) ? > > + ctx->typec.request_current * 1000 : 0; > > + break; > > + default: > > + ret = -EINVAL; > > + break; > > + } > > + return ret; > > +} > > + > > +static int anx7411_psy_register(struct anx7411_data *ctx) > > +{ > > + struct power_supply_config psy_cfg = {}; > > + const char *port_dev_name = dev_name(ctx->dev); > > + size_t psy_name_len = strlen(anx7411_psy_name_prefix) + > > + strlen(port_dev_name) + 1; > > + char *psy_name; > > + struct power_supply_desc *psy_desc = &ctx->psy_desc; > > + > > + psy_cfg.drv_data = ctx; > > + psy_cfg.fwnode = dev_fwnode(ctx->dev); > > + psy_name = devm_kzalloc(ctx->dev, psy_name_len, GFP_KERNEL); > > + if (!psy_name) { > > + dev_warn(ctx->dev, "unable to alloc psy memory\n"); > > + return -ENOMEM; > > + } > > + > > + snprintf(psy_name, psy_name_len, "%s%s", anx7411_psy_name_prefix, > > + port_dev_name); > > + > > + psy_desc->name = psy_name; > > + psy_desc->type = POWER_SUPPLY_TYPE_USB; > > + psy_desc->usb_types = anx7411_psy_usb_types; > > + psy_desc->num_usb_types = ARRAY_SIZE(anx7411_psy_usb_types); > > + psy_desc->properties = anx7411_psy_props, > > + psy_desc->num_properties = ARRAY_SIZE(anx7411_psy_props), > > + > > + psy_desc->get_property = anx7411_psy_get_prop, > > + psy_desc->set_property = anx7411_psy_set_prop, > > + psy_desc->property_is_writeable = anx7411_psy_prop_writeable, > > + > > + ctx->usb_type = POWER_SUPPLY_USB_TYPE_C; > > + ctx->psy = devm_power_supply_register(ctx->dev, psy_desc, &psy_cfg); > > + > > + if (IS_ERR(ctx->psy)) > > + dev_warn(ctx->dev, "unable to register psy\n"); > > + > > + return PTR_ERR_OR_ZERO(ctx->psy); > > +} > > + > > +static int anx7411_i2c_probe(struct i2c_client *client, > > + const struct i2c_device_id *id) > > +{ > > + struct anx7411_data *plat; > > + struct device *dev = &client->dev; > > + int ret; > > + > > + if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_I2C_BLOCK)) > > + return -ENODEV; > > + > > + plat = devm_kzalloc(dev, sizeof(*plat), GFP_KERNEL); > > + if (!plat) > > + return -ENOMEM; > > + > > + plat->tcpc_client = client; > > + i2c_set_clientdata(client, plat); > > + > > + mutex_init(&plat->lock); > > + > > + ret = anx7411_register_i2c_dummy_clients(plat, client); > > + if (ret) { > > + dev_err(dev, "fail to reserve I2C bus\n"); > > + return ret; > > + } > > + > > + ret = anx7411_typec_switch_probe(plat, dev); > > + if (ret) { > > + dev_err(dev, "fail to probe typec switch\n"); > > + goto free_i2c_dummy; > > + } > > + > > + ret = anx7411_typec_port_probe(plat, dev); > > + if (ret) { > > + dev_err(dev, "fail to probe typec property.\n"); > > + ret = -ENODEV; > > + goto free_typec_switch; > > + } > > + > > + plat->intp_irq = client->irq; > > + if (!client->irq) { > > + dev_warn(dev, "no default interrupt IRQ, probe GPIO interrupt"); > > + anx7411_get_gpio_irq(plat); > > + } > > + > > + if (!plat->intp_irq) { > > + dev_err(dev, "fail to get interrupt IRQ\n"); > > + goto free_typec_port; > > + } > > + > > + plat->dev = dev; > > + plat->psy_online = ANX7411_PSY_OFFLINE; > > + anx7411_psy_register(plat); > > + > > + if (plat->intp_irq) { > > + INIT_WORK(&plat->work, anx7411_work_func); > > + plat->workqueue = alloc_workqueue("anx7411_work", > > + WQ_FREEZABLE | > > + WQ_MEM_RECLAIM, > > + 1); > > + if (!plat->workqueue) { > > + dev_err(dev, "fail to create work queue\n"); > > + ret = -ENOMEM; > > + goto free_typec_port; > > + } > > + > > + ret = devm_request_threaded_irq(dev, plat->intp_irq, > > + NULL, anx7411_intr_isr, > > + IRQF_TRIGGER_FALLING | > > + IRQF_ONESHOT, > > + "anx7411-intp", plat); > > + if (ret) { > > + dev_err(dev, "fail to request irq\n"); > > + goto free_wq; > > + } > > + } > > + > > + anx7411_typec_check_connection(plat); > > + > > + pm_runtime_enable(dev); > > + > > + return 0; > > + > > +free_wq: > > + destroy_workqueue(plat->workqueue); > > + > > +free_typec_port: > > + typec_unregister_port(plat->typec.port); > > + anx7411_port_unregister_altmodes(plat->typec.port_amode); > > + > > +free_typec_switch: > > + anx7411_unregister_switch(plat); > > + anx7411_unregister_mux(plat); > > + > > +free_i2c_dummy: > > + i2c_unregister_device(plat->spi_client); > > + > > + return ret; > > +} > > + > > +static int anx7411_i2c_remove(struct i2c_client *client) > > +{ > > + struct anx7411_data *plat = i2c_get_clientdata(client); > > + > > + anx7411_partner_unregister_altmode(plat); > > + anx7411_unregister_partner(plat); > > + > > + if (plat->workqueue) > > + destroy_workqueue(plat->workqueue); > > + > > + if (plat->spi_client) > > + i2c_unregister_device(plat->spi_client); > > + > > + if (plat->typec.role_sw) > > + usb_role_switch_put(plat->typec.role_sw); > > + > > + anx7411_unregister_mux(plat); > > + > > + anx7411_unregister_switch(plat); > > + > > + if (plat->typec.port) > > + typec_unregister_port(plat->typec.port); > > + > > + anx7411_port_unregister_altmodes(plat->typec.port_amode); > > + > > + return 0; > > +} > > + > > +static const struct i2c_device_id anx7411_id[] = { > > + {"anx7411", 0}, > > + {} > > +}; > > + > > +MODULE_DEVICE_TABLE(i2c, anx7411_id); > > + > > +static const struct of_device_id anx_match_table[] = { > > + {.compatible = "analogix,anx7411",}, > > + {}, > > +}; > > + > > +static struct i2c_driver anx7411_driver = { > > + .driver = { > > + .name = "anx7411", > > + .of_match_table = anx_match_table, > > + .pm = &anx7411_pm_ops, > > + }, > > + .probe = anx7411_i2c_probe, > > + .remove = anx7411_i2c_remove, > > + > > + .id_table = anx7411_id, > > +}; > > + > > +module_i2c_driver(anx7411_driver); > > + > > +MODULE_DESCRIPTION("Anx7411 USB Type-C PD driver"); > > +MODULE_AUTHOR("Xin Ji <xji@analogixsemi.com>"); > > +MODULE_LICENSE("GPL v2"); > > +MODULE_VERSION("0.1.5"); > > diff --git a/drivers/usb/typec/anx7411.h b/drivers/usb/typec/anx7411.h > > new file mode 100644 > > index 000000000000..09ff80517a5c > > --- /dev/null > > +++ b/drivers/usb/typec/anx7411.h > > @@ -0,0 +1,265 @@ > > +/* SPDX-License-Identifier: GPL-2.0-only */ > > + > > +/* > > + * Copyright(c) 2022, Analogix Semiconductor. All rights reserved. > > + * > > + */ > > + > > +#ifndef __ANX7411_H__ > > +#define __ANX7411_H__ > > + > > +#define TCPC_ADDRESS1 0x58 > > +#define TCPC_ADDRESS2 0x56 > > +#define TCPC_ADDRESS3 0x54 > > +#define TCPC_ADDRESS4 0x52 > > +#define SPI_ADDRESS1 0x7e > > +#define SPI_ADDRESS2 0x6e > > +#define SPI_ADDRESS3 0x64 > > +#define SPI_ADDRESS4 0x62 > > + > > +struct anx7411_i2c_select { > > + u8 tcpc_address; > > + u8 spi_address; > > +}; > > + > > +#define VID_ANALOGIX 0x1F29 > > +#define PID_ANALOGIX 0x7411 > > + > > +/* TCPC register define */ > > + > > +#define ANALOG_CTRL_10 0xAA > > + > > +#define STATUS_LEN 2 > > +#define ALERT_0 0xCB > > +#define RECEIVED_MSG BIT(7) > > +#define SOFTWARE_INT BIT(6) > > +#define MSG_LEN 32 > > +#define HEADER_LEN 2 > > +#define MSG_HEADER 0x00 > > +#define MSG_TYPE 0x01 > > +#define MSG_RAWDATA 0x02 > > +#define MSG_LEN_MASK 0x1F > > + > > +#define ALERT_1 0xCC > > +#define INTP_POW_ON BIT(7) > > +#define INTP_POW_OFF BIT(6) > > + > > +#define VBUS_THRESHOLD_H 0xDD > > +#define VBUS_THRESHOLD_L 0xDE > > + > > +#define FW_CTRL_0 0xF0 > > +#define UNSTRUCT_VDM_EN BIT(0) > > +#define DELAY_200MS BIT(1) > > +#define VSAFE0 0 > > +#define VSAFE1 BIT(2) > > +#define VSAFE2 BIT(3) > > +#define VSAFE3 (BIT(2) | BIT(3)) > > +#define FRS_EN BIT(7) > > + > > +#define FW_PARAM 0xF1 > > +#define DONGLE_IOP BIT(0) > > + > > +#define FW_CTRL_2 0xF7 > > +#define SINK_CTRL_DIS_FLAG BIT(5) > > + > > +/* SPI register define */ > > +#define OCM_CTRL_0 0x6E > > +#define OCM_RESET BIT(6) > > + > > +#define MAX_VOLTAGE 0xAC > > +#define MAX_POWER 0xAD > > +#define MIN_POWER 0xAE > > + > > +#define REQUEST_VOLTAGE 0xAF > > +#define VOLTAGE_UNIT 100 /* mV per unit */ > > + > > +#define REQUEST_CURRENT 0xB1 > > +#define CURRENT_UNIT 50 /* mA per unit */ > > + > > +#define CMD_SEND_BUF 0xC0 > > +#define CMD_RECV_BUF 0xE0 > > + > > +#define REQ_VOL_20V_IN_100MV 0xC8 > > +#define REQ_CUR_2_25A_IN_50MA 0x2D > > +#define REQ_CUR_3_25A_IN_50MA 0x41 > > + > > +#define DEF_5V 5000 > > +#define DEF_1_5A 1500 > > + > > +#define LOBYTE(w) ((u8)(w) & 0xFF) > > +#define HIBYTE(w) ((u8)(((u16)(w) >> 8) & 0xFF)) > > + > > +enum anx7411_typec_message_type { > > + TYPE_SRC_CAP = 0x00, > > + TYPE_SNK_CAP = 0x01, > > + TYPE_SNK_IDENTITY = 0x02, > > + TYPE_SVID = 0x03, > > + TYPE_SET_SNK_DP_CAP = 0x08, > > + TYPE_PSWAP_REQ = 0x10, > > + TYPE_DSWAP_REQ = 0x11, > > + TYPE_VDM = 0x14, > > + TYPE_OBJ_REQ = 0x16, > > + TYPE_DP_ALT_ENTER = 0x19, > > + TYPE_DP_DISCOVER_MODES_INFO = 0x27, > > + TYPE_GET_DP_CONFIG = 0x29, > > + TYPE_DP_CONFIGURE = 0x2A, > > + TYPE_GET_DP_DISCOVER_MODES_INFO = 0x2E, > > + TYPE_GET_DP_ALT_ENTER = 0x2F, > > +}; > > + > > +#define FW_CTRL_1 0xB2 > > +#define AUTO_PD_EN BIT(1) > > +#define TRYSRC_EN BIT(2) > > +#define TRYSNK_EN BIT(3) > > +#define FORCE_SEND_RDO BIT(6) > > + > > +#define FW_VER 0xB4 > > +#define FW_SUBVER 0xB5 > > + > > +#define INT_MASK 0xB6 > > +#define INT_STS 0xB7 > > +#define OCM_BOOT_UP BIT(0) > > +#define OC_OV_EVENT BIT(1) > > +#define VCONN_CHANGE BIT(2) > > +#define VBUS_CHANGE BIT(3) > > +#define CC_STATUS_CHANGE BIT(4) > > +#define DATA_ROLE_CHANGE BIT(5) > > +#define PR_CONSUMER_GOT_POWER BIT(6) > > +#define HPD_STATUS_CHANGE BIT(7) > > + > > +#define SYSTEM_STSTUS 0xB8 > > +/* 0: SINK off; 1: SINK on */ > > +#define SINK_STATUS BIT(1) > > +/* 0: VCONN off; 1: VCONN on*/ > > +#define VCONN_STATUS BIT(2) > > +/* 0: vbus off; 1: vbus on*/ > > +#define VBUS_STATUS BIT(3) > > +/* 1: host; 0:device*/ > > +#define DATA_ROLE BIT(5) > > +/* 0: Chunking; 1: Unchunked*/ > > +#define SUPPORT_UNCHUNKING BIT(6) > > +/* 0: HPD low; 1: HPD high*/ > > +#define HPD_STATUS BIT(7) > > + > > +#define DATA_DFP 1 > > +#define DATA_UFP 2 > > +#define POWER_SOURCE 1 > > +#define POWER_SINK 2 > > + > > +#define CC_STATUS 0xB9 > > +#define CC1_RD BIT(0) > > +#define CC2_RD BIT(4) > > +#define CC1_RA BIT(1) > > +#define CC2_RA BIT(5) > > +#define CC1_RD BIT(0) > > +#define CC1_RP(cc) (((cc) >> 2) & 0x03) > > +#define CC2_RP(cc) (((cc) >> 6) & 0x03) > > + > > +#define PD_REV_INIT 0xBA > > + > > +#define PD_EXT_MSG_CTRL 0xBB > > +#define SRC_CAP_EXT_REPLY BIT(0) > > +#define MANUFACTURER_INFO_REPLY BIT(1) > > +#define BATTERY_STS_REPLY BIT(2) > > +#define BATTERY_CAP_REPLY BIT(3) > > +#define ALERT_REPLY BIT(4) > > +#define STATUS_REPLY BIT(5) > > +#define PPS_STATUS_REPLY BIT(6) > > +#define SNK_CAP_EXT_REPLY BIT(7) > > + > > +#define NO_CONNECT 0x00 > > +#define USB3_1_CONNECTED 0x01 > > +#define DP_ALT_4LANES 0x02 > > +#define USB3_1_DP_2LANES 0x03 > > +#define CC1_CONNECTED 0x01 > > +#define CC2_CONNECTED 0x02 > > +#define SELECT_PIN_ASSIGMENT_C 0x04 > > +#define SELECT_PIN_ASSIGMENT_D 0x08 > > +#define SELECT_PIN_ASSIGMENT_E 0x10 > > +#define SELECT_PIN_ASSIGMENT_U 0x00 > > +#define REDRIVER_ADDRESS 0x20 > > +#define REDRIVER_OFFSET 0x00 > > + > > +#define DP_SVID 0xFF01 > > +#define VDM_ACK 0x40 > > +#define VDM_CMD_RES 0x00 > > +#define VDM_CMD_DIS_ID 0x01 > > +#define VDM_CMD_DIS_SVID 0x02 > > +#define VDM_CMD_DIS_MOD 0x03 > > +#define VDM_CMD_ENTER_MODE 0x04 > > +#define VDM_CMD_EXIT_MODE 0x05 > > +#define VDM_CMD_ATTENTION 0x06 > > +#define VDM_CMD_GET_STS 0x10 > > +#define VDM_CMD_AND_ACK_MASK 0x5F > > + > > +#define MAX_ALTMODE 2 > > + > > +#define HAS_SOURCE_CAP BIT(0) > > +#define HAS_SINK_CAP BIT(1) > > +#define HAS_SINK_WATT BIT(2) > > + > > +enum anx7411_psy_state { > > + /* copy from drivers/usb/typec/tcpm */ > > + ANX7411_PSY_OFFLINE = 0, > > + ANX7411_PSY_FIXED_ONLINE, > > + > > + /* private */ > > + /* PD keep in, but disconnct power to bq25700, > > + * this state can be active when higher capacity adapter plug in, > > + * and change to ONLINE state when higher capacity adapter plug out > > + */ > > + ANX7411_PSY_HANG = 0xff, > > +}; > > + > > +struct typec_params { > > + int request_current; /* ma */ > > + int request_voltage; /* mv */ > > + int cc_connect; > > + int cc_orientation_valid; > > + int cc_status; > > + int data_role; > > + int power_role; > > + int vconn_role; > > + int dp_altmode_enter; > > + int cust_altmode_enter; > > + struct usb_role_switch *role_sw; > > + struct typec_port *port; > > + struct typec_partner *partner; > > + struct typec_mux_dev *typec_mux; > > + struct typec_switch_dev *typec_switch; > > + struct typec_altmode *amode[MAX_ALTMODE]; > > + struct typec_altmode *port_amode[MAX_ALTMODE]; > > + struct typec_displayport_data data; > > + int pin_assignment; > > + struct typec_capability caps; > > + u32 src_pdo[PDO_MAX_OBJECTS]; > > + u32 sink_pdo[PDO_MAX_OBJECTS]; > > + u8 caps_flags; > > + u8 src_pdo_nr; > > + u8 sink_pdo_nr; > > + u8 sink_watt; > > + u8 sink_voltage; > > +}; > > + > > +struct anx7411_data { > > + int fw_version; > > + int fw_subversion; > > + struct i2c_client *tcpc_client; > > + struct i2c_client *spi_client; > > + struct gpio_desc *intp_gpiod; > > + struct fwnode_handle *connector_fwnode; > > + struct typec_params typec; > > + int intp_irq; > > + struct work_struct work; > > + struct workqueue_struct *workqueue; > > + /* Lock for interrupt work queue */ > > + struct mutex lock; > > + > > + enum anx7411_psy_state psy_online; > > + enum power_supply_usb_type usb_type; > > + struct power_supply *psy; > > + struct power_supply_desc psy_desc; > > + struct device *dev; > > +}; > > + > > +#endif /* __ANX7411_H__ */ > > -- > > 2.25.1 > > -- > heikki
diff --git a/drivers/usb/typec/Kconfig b/drivers/usb/typec/Kconfig index ba24847fb245..5defdfead653 100644 --- a/drivers/usb/typec/Kconfig +++ b/drivers/usb/typec/Kconfig @@ -52,6 +52,17 @@ source "drivers/usb/typec/ucsi/Kconfig" source "drivers/usb/typec/tipd/Kconfig" +config TYPEC_ANX7411 + tristate "Analogix ANX7411 Type-C DRP Port controller driver" + depends on I2C + depends on USB_ROLE_SWITCH + help + Say Y or M here if your system has Analogix ANX7411 Type-C DRP Port + controller driver. + + If you choose to build this driver as a dynamically linked module, the + module will be called anx7411.ko. + config TYPEC_RT1719 tristate "Richtek RT1719 Sink Only Type-C controller driver" depends on USB_ROLE_SWITCH || !USB_ROLE_SWITCH diff --git a/drivers/usb/typec/Makefile b/drivers/usb/typec/Makefile index 2f174cd3e5df..dac5c11a3234 100644 --- a/drivers/usb/typec/Makefile +++ b/drivers/usb/typec/Makefile @@ -6,6 +6,7 @@ obj-$(CONFIG_TYPEC) += altmodes/ obj-$(CONFIG_TYPEC_TCPM) += tcpm/ obj-$(CONFIG_TYPEC_UCSI) += ucsi/ obj-$(CONFIG_TYPEC_TPS6598X) += tipd/ +obj-$(CONFIG_TYPEC_ANX7411) += anx7411.o obj-$(CONFIG_TYPEC_HD3SS3220) += hd3ss3220.o obj-$(CONFIG_TYPEC_QCOM_PMIC) += qcom-pmic-typec.o obj-$(CONFIG_TYPEC_STUSB160X) += stusb160x.o diff --git a/drivers/usb/typec/anx7411.c b/drivers/usb/typec/anx7411.c new file mode 100644 index 000000000000..cc208cdd8762 --- /dev/null +++ b/drivers/usb/typec/anx7411.c @@ -0,0 +1,1327 @@ +// SPDX-License-Identifier: GPL-2.0-only + +/* + * Copyright(c) 2022, Analogix Semiconductor. All rights reserved. + * + */ +#include <linux/gpio/consumer.h> +#include <linux/i2c.h> +#include <linux/interrupt.h> +#include <linux/iopoll.h> +#include <linux/kernel.h> +#include <linux/module.h> +#include <linux/mutex.h> +#include <linux/of_graph.h> +#include <linux/of_platform.h> +#include <linux/pm_runtime.h> +#include <linux/regulator/consumer.h> +#include <linux/slab.h> +#include <linux/types.h> +#include <linux/usb/pd.h> +#include <linux/usb/role.h> +#include <linux/usb/tcpci.h> +#include <linux/usb/typec.h> +#include <linux/usb/typec_dp.h> +#include <linux/usb/typec_mux.h> +#include <linux/workqueue.h> +#include <linux/power_supply.h> + +#include "anx7411.h" + +static u8 snk_identity[] = { + LOBYTE(VID_ANALOGIX), HIBYTE(VID_ANALOGIX), 0x00, 0x82, /* snk_id_hdr */ + 0x00, 0x00, 0x00, 0x00, /* snk_cert */ + 0x00, 0x00, LOBYTE(PID_ANALOGIX), HIBYTE(PID_ANALOGIX), /* 5snk_ama */ +}; + +static u8 dp_caps[4] = {0xC6, 0x00, 0x00, 0x00}; + +static int anx7411_reg_read(struct i2c_client *client, + u8 reg_addr) +{ + return i2c_smbus_read_byte_data(client, reg_addr); +} + +static int anx7411_reg_block_read(struct i2c_client *client, + u8 reg_addr, u8 len, u8 *buf) +{ + return i2c_smbus_read_i2c_block_data(client, reg_addr, len, buf); +} + +static int anx7411_reg_write(struct i2c_client *client, + u8 reg_addr, u8 reg_val) +{ + return i2c_smbus_write_byte_data(client, reg_addr, reg_val); +} + +static int anx7411_reg_block_write(struct i2c_client *client, + u8 reg_addr, u8 len, u8 *buf) +{ + return i2c_smbus_write_i2c_block_data(client, reg_addr, len, buf); +} + +static struct anx7411_i2c_select anx7411_i2c_addr[] = { + {TCPC_ADDRESS1, SPI_ADDRESS1}, + {TCPC_ADDRESS2, SPI_ADDRESS2}, + {TCPC_ADDRESS3, SPI_ADDRESS3}, + {TCPC_ADDRESS4, SPI_ADDRESS4}, +}; + +static int anx7411_detect_power_mode(struct anx7411_data *ctx) +{ + int ret; + int mode; + + ret = anx7411_reg_read(ctx->spi_client, REQUEST_CURRENT); + if (ret < 0) + return ret; + + ctx->typec.request_current = ret * CURRENT_UNIT; /* 50ma per unit */ + + ret = anx7411_reg_read(ctx->spi_client, REQUEST_VOLTAGE); + if (ret < 0) + return ret; + + ctx->typec.request_voltage = ret * VOLTAGE_UNIT; /* 100mv per unit */ + + if (ctx->psy_online == ANX7411_PSY_OFFLINE) { + ctx->psy_online = ANX7411_PSY_FIXED_ONLINE; + ctx->usb_type = POWER_SUPPLY_USB_TYPE_PD; + power_supply_changed(ctx->psy); + } + + if (!ctx->typec.cc_orientation_valid) + return 0; + + if (ctx->typec.cc_connect == CC1_CONNECTED) + mode = CC1_RP(ctx->typec.cc_status); + else + mode = CC2_RP(ctx->typec.cc_status); + if (mode) { + typec_set_pwr_opmode(ctx->typec.port, mode - 1); + return 0; + } + + typec_set_pwr_opmode(ctx->typec.port, TYPEC_PWR_MODE_PD); + + return 0; +} + +static int anx7411_register_partner(struct anx7411_data *ctx, + int pd, int accessory) +{ + struct typec_partner_desc desc; + + if (ctx->typec.partner) + return 0; + + desc.usb_pd = pd; + desc.accessory = accessory; + desc.identity = NULL; + ctx->typec.partner = typec_register_partner(ctx->typec.port, &desc); + if (IS_ERR(ctx->typec.partner)) { + ctx->typec.partner = NULL; + return PTR_ERR(ctx->typec.partner); + } + + return 0; +} + +static int anx7411_detect_cc_orientation(struct anx7411_data *ctx) +{ + int ret; + int cc1_rd, cc2_rd; + int cc1_ra, cc2_ra; + int cc1_rp, cc2_rp; + + ret = anx7411_reg_read(ctx->spi_client, CC_STATUS); + if (ret < 0) + return ret; + + ctx->typec.cc_status = ret; + + cc1_rd = ret & CC1_RD ? 1 : 0; + cc2_rd = ret & CC2_RD ? 1 : 0; + cc1_ra = ret & CC1_RA ? 1 : 0; + cc2_ra = ret & CC2_RA ? 1 : 0; + cc1_rp = CC1_RP(ret); + cc2_rp = CC2_RP(ret); + + /* Debug cable, nothing to do */ + if (cc1_rd && cc2_rd) { + ctx->typec.cc_orientation_valid = 0; + anx7411_register_partner(ctx, 0, TYPEC_ACCESSORY_DEBUG); + return 0; + } + + if (cc1_ra && cc2_ra) { + ctx->typec.cc_orientation_valid = 0; + anx7411_register_partner(ctx, 0, TYPEC_ACCESSORY_AUDIO); + return 0; + } + + ctx->typec.cc_orientation_valid = 1; + + anx7411_register_partner(ctx, 1, TYPEC_ACCESSORY_NONE); + + if (cc1_rd || cc1_rp) { + typec_set_orientation(ctx->typec.port, + TYPEC_ORIENTATION_NORMAL); + ctx->typec.cc_connect = CC1_CONNECTED; + } + + if (cc2_rd || cc2_rp) { + typec_set_orientation(ctx->typec.port, + TYPEC_ORIENTATION_REVERSE); + ctx->typec.cc_connect = CC2_CONNECTED; + } + + return 0; +} + +static int anx7411_set_mux(struct anx7411_data *ctx, int pin_assignment) +{ + int mode = TYPEC_STATE_SAFE; + + switch (pin_assignment) { + case SELECT_PIN_ASSIGMENT_U: + /* default 4 line USB 3.1 */ + mode = TYPEC_STATE_MODAL; + break; + case SELECT_PIN_ASSIGMENT_C: + case SELECT_PIN_ASSIGMENT_E: + /* 4 line DP */ + mode = TYPEC_STATE_SAFE; + break; + case SELECT_PIN_ASSIGMENT_D: + /* 2 line DP, 2 line USB */ + mode = TYPEC_MODE_USB3; + break; + default: + mode = TYPEC_STATE_SAFE; + break; + } + + ctx->typec.pin_assignment = pin_assignment; + + return typec_set_mode(ctx->typec.port, mode); +} + +static void anx7411_set_usb_role(struct anx7411_data *ctx, enum usb_role role) +{ + if (!ctx->typec.role_sw) + return; + + usb_role_switch_set_role(ctx->typec.role_sw, role); +} + +static int anx7411_data_role_detect(struct anx7411_data *ctx) +{ + int ret; + + ret = anx7411_reg_read(ctx->spi_client, SYSTEM_STSTUS); + if (ret < 0) + return ret; + + ctx->typec.data_role = (ret & DATA_ROLE) ? TYPEC_HOST : TYPEC_DEVICE; + ctx->typec.vconn_role = (ret & VCONN_STATUS) ? TYPEC_SOURCE : TYPEC_SINK; + + typec_set_data_role(ctx->typec.port, ctx->typec.data_role); + typec_set_vconn_role(ctx->typec.port, ctx->typec.vconn_role); + + if (ctx->typec.data_role == TYPEC_HOST) + anx7411_set_usb_role(ctx, USB_ROLE_HOST); + else + anx7411_set_usb_role(ctx, USB_ROLE_DEVICE); + + return 0; +} + +static int anx7411_power_role_detect(struct anx7411_data *ctx) +{ + int ret; + + ret = anx7411_reg_read(ctx->spi_client, SYSTEM_STSTUS); + if (ret < 0) + return ret; + + ctx->typec.power_role = (ret & SINK_STATUS) ? TYPEC_SINK : TYPEC_SOURCE; + + if (ctx->typec.power_role == TYPEC_SOURCE) { + ctx->typec.request_current = DEF_1_5A; + ctx->typec.request_voltage = DEF_5V; + } + + typec_set_pwr_role(ctx->typec.port, ctx->typec.power_role); + + return 0; +} + +static int anx7411_cc_status_detect(struct anx7411_data *ctx) +{ + anx7411_detect_cc_orientation(ctx); + anx7411_detect_power_mode(ctx); + + return 0; +} + +static int anx7411_partner_unregister_altmode(struct anx7411_data *ctx) +{ + int i; + + ctx->typec.dp_altmode_enter = 0; + ctx->typec.cust_altmode_enter = 0; + + for (i = 0; i < MAX_ALTMODE; i++) + if (ctx->typec.amode[i]) { + typec_unregister_altmode(ctx->typec.amode[i]); + ctx->typec.amode[i] = NULL; + } + + ctx->typec.pin_assignment = 0; + return 0; +} + +static int anx7411_typec_register_altmode(struct anx7411_data *ctx, + int svid, int vdo) +{ + struct device *dev = &ctx->spi_client->dev; + struct typec_altmode_desc desc; + int i; + + desc.svid = svid; + desc.vdo = vdo; + + for (i = 0; i < MAX_ALTMODE; i++) + if (!ctx->typec.amode[i]) + break; + + desc.mode = i + 1; /* start with 1 */ + + if (i >= MAX_ALTMODE) { + dev_err(dev, "no altmode space for registering\n"); + return -ENOMEM; + } + + ctx->typec.amode[i] = typec_partner_register_altmode(ctx->typec.partner, + &desc); + if (IS_ERR(ctx->typec.amode[i])) { + dev_err(dev, "failed to register altmode\n"); + ctx->typec.amode[i] = NULL; + return PTR_ERR(ctx->typec.amode); + } + + return 0; +} + +static int anx7411_unregister_partner(struct anx7411_data *ctx) +{ + if (ctx->typec.partner) { + typec_unregister_partner(ctx->typec.partner); + ctx->typec.partner = NULL; + } + + return 0; +} + +static int anx7411_update_altmode(struct anx7411_data *ctx, int svid) +{ + int i; + + if (svid == DP_SVID) + ctx->typec.dp_altmode_enter = 1; + else + ctx->typec.cust_altmode_enter = 1; + + for (i = 0; i < MAX_ALTMODE; i++) { + if (!ctx->typec.amode[i]) + continue; + + if (ctx->typec.amode[i]->svid == svid) { + typec_altmode_update_active(ctx->typec.amode[i], true); + typec_altmode_notify(ctx->typec.amode[i], + ctx->typec.pin_assignment, + &ctx->typec.data); + break; + } + } + + return 0; +} + +static int anx7411_register_altmode(struct anx7411_data *ctx, + bool dp_altmode, u8 *buf) +{ + int ret; + int svid; + int mid; + + if (!ctx->typec.partner) + return 0; + + svid = DP_SVID; + if (dp_altmode) { + mid = buf[0] | (buf[1] << 8) | (buf[2] << 16) | (buf[3] << 24); + + return anx7411_typec_register_altmode(ctx, svid, mid); + } + + svid = (buf[3] << 8) | buf[2]; + if ((buf[0] & VDM_CMD_AND_ACK_MASK) != (VDM_ACK | VDM_CMD_ENTER_MODE)) + return anx7411_update_altmode(ctx, svid); + + if ((buf[0] & VDM_CMD_AND_ACK_MASK) != (VDM_ACK | VDM_CMD_DIS_MOD)) + return 0; + + mid = buf[4] | (buf[5] << 8) | (buf[6] << 16) | (buf[7] << 24); + + ret = anx7411_typec_register_altmode(ctx, svid, mid); + if (ctx->typec.cust_altmode_enter) + ret |= anx7411_update_altmode(ctx, svid); + + return ret; +} + +static int anx7411_parse_cmd(struct anx7411_data *ctx, u8 type, u8 *buf, u8 len) +{ + struct device *dev = &ctx->spi_client->dev; + u8 cur_50ma, vol_100mv; + + dev_info(dev, "received message: type:0x%.02x, len:%d, buf[0]:%d\n", + type, len, buf[0]); + + switch (type) { + case TYPE_SRC_CAP: + cur_50ma = anx7411_reg_read(ctx->spi_client, REQUEST_CURRENT); + vol_100mv = anx7411_reg_read(ctx->spi_client, REQUEST_VOLTAGE); + dev_info(dev, "get current(%dma), voltage(%dmv), power(%dmw)\n", + cur_50ma * CURRENT_UNIT, vol_100mv * VOLTAGE_UNIT, + cur_50ma * vol_100mv * 5); + + ctx->typec.request_voltage = vol_100mv * VOLTAGE_UNIT; + ctx->typec.request_current = cur_50ma * CURRENT_UNIT; + + ctx->psy_online = ANX7411_PSY_FIXED_ONLINE; + ctx->usb_type = POWER_SUPPLY_USB_TYPE_PD; + power_supply_changed(ctx->psy); + break; + case TYPE_SNK_CAP: + break; + case TYPE_SVID: + break; + case TYPE_SNK_IDENTITY: + break; + case TYPE_GET_DP_ALT_ENTER: + /* DP alt mode enter success */ + if (buf[0]) + anx7411_update_altmode(ctx, DP_SVID); + break; + case TYPE_DP_ALT_ENTER: + /* Update DP altmode */ + anx7411_update_altmode(ctx, DP_SVID); + break; + case TYPE_OBJ_REQ: + anx7411_detect_power_mode(ctx); + break; + case TYPE_DP_CONFIGURE: + anx7411_set_mux(ctx, buf[1]); + break; + case TYPE_DP_DISCOVER_MODES_INFO: + /* Make sure discover modes valid */ + if (buf[0] | buf[1]) + /* Register DP Altmode */ + anx7411_register_altmode(ctx, 1, buf); + break; + case TYPE_VDM: + /* Register other altmode */ + anx7411_register_altmode(ctx, 0, buf); + break; + default: + dev_err(dev, "ignore message(0x%.02x).\n", type); + break; + } + + return 0; +} + +static u8 checksum(struct device *dev, u8 *buf, u8 len) +{ + u8 ret = 0; + u8 i; + + for (i = 0; i < len; i++) + ret += buf[i]; + + return ret; +} + +static int anx7411_read_msg_ctrl_status(struct i2c_client *client) +{ + return anx7411_reg_read(client, CMD_SEND_BUF); +} + +static int anx7411_wait_msg_empty(struct i2c_client *client) +{ + int val; + + return readx_poll_timeout(anx7411_read_msg_ctrl_status, + client, val, (val < 0) || (val == 0), + 2000, 2000 * 150); +} + +static int anx7411_send_msg(struct anx7411_data *ctx, u8 type, u8 *buf, u8 size) +{ + struct device *dev = &ctx->spi_client->dev; + u8 msg[MSG_LEN]; + u8 crc; + int ret; + + if (size) + memcpy(&msg[MSG_RAWDATA], buf, size); + msg[MSG_TYPE] = type; + msg[MSG_HEADER] = size + 1; + + crc = checksum(dev, msg, size + HEADER_LEN); + msg[size + HEADER_LEN] = 0 - crc; + + ret = anx7411_wait_msg_empty(ctx->spi_client); + if (ret) + return ret; + + anx7411_reg_block_write(ctx->spi_client, + CMD_SEND_BUF + 1, size + HEADER_LEN, + &msg[MSG_TYPE]); + return anx7411_reg_write(ctx->spi_client, CMD_SEND_BUF, + msg[MSG_HEADER]); +} + +static int anx7411_process_cmd(struct anx7411_data *ctx) +{ + struct device *dev = &ctx->spi_client->dev; + u8 msg[MSG_LEN]; + u8 len; + u8 crc; + + /* Read message from firmware */ + anx7411_reg_block_read(ctx->spi_client, CMD_RECV_BUF, MSG_LEN, msg); + anx7411_reg_write(ctx->spi_client, CMD_RECV_BUF, 0); + + if (!msg[MSG_HEADER]) + return 0; + + len = msg[MSG_HEADER] & MSG_LEN_MASK; + crc = checksum(dev, msg, len + HEADER_LEN); + if (crc) { + dev_err(dev, "message error crc(0x%.02x)\n", crc); + return -ERANGE; + } + + return anx7411_parse_cmd(ctx, msg[MSG_TYPE], + &msg[MSG_RAWDATA], len - 1); +} + +static void anx7411_translate_payload(struct device *dev, __le32 *payload, + u32 *pdo, int nr, const char *type) +{ + int i; + + if (nr > PDO_MAX_OBJECTS) { + dev_err(dev, "nr(%d) exceed PDO_MAX_OBJECTS(%d)\n", + nr, PDO_MAX_OBJECTS); + + return; + } + + for (i = 0; i < nr; i++) + payload[i] = cpu_to_le32(pdo[i]); +} + +static void anx7411_config(struct anx7411_data *ctx) +{ + struct device *dev = &ctx->spi_client->dev; + struct typec_params *typecp = &ctx->typec; + __le32 payload[PDO_MAX_OBJECTS]; + + /* Config PD FW work under PD 2.0 */ + anx7411_reg_write(ctx->spi_client, PD_REV_INIT, PD_REV20); + anx7411_reg_write(ctx->tcpc_client, FW_CTRL_0, + UNSTRUCT_VDM_EN | DELAY_200MS | + VSAFE1 | FRS_EN); + anx7411_reg_write(ctx->spi_client, FW_CTRL_1, + AUTO_PD_EN | FORCE_SEND_RDO); + + /* Set VBUS current threshold */ + anx7411_reg_write(ctx->tcpc_client, VBUS_THRESHOLD_H, 0xff); + anx7411_reg_write(ctx->tcpc_client, VBUS_THRESHOLD_L, 0x03); + + /* Fix dongle compatible issue */ + anx7411_reg_write(ctx->tcpc_client, FW_PARAM, + anx7411_reg_read(ctx->tcpc_client, FW_PARAM) | + DONGLE_IOP); + anx7411_reg_write(ctx->spi_client, INT_MASK, 0); + + anx7411_reg_write(ctx->spi_client, PD_EXT_MSG_CTRL, 0xFF); + + if (typecp->caps_flags & HAS_SOURCE_CAP) { + anx7411_translate_payload(dev, payload, typecp->src_pdo, + typecp->src_pdo_nr, "source"); + anx7411_send_msg(ctx, TYPE_SRC_CAP, (u8 *)&payload, + typecp->src_pdo_nr * 4); + anx7411_send_msg(ctx, TYPE_SNK_IDENTITY, snk_identity, + sizeof(snk_identity)); + anx7411_send_msg(ctx, TYPE_SET_SNK_DP_CAP, dp_caps, + sizeof(dp_caps)); + } + + if (typecp->caps_flags & HAS_SINK_CAP) { + anx7411_translate_payload(dev, payload, typecp->sink_pdo, + typecp->sink_pdo_nr, "sink"); + anx7411_send_msg(ctx, TYPE_SNK_CAP, (u8 *)&payload, + typecp->sink_pdo_nr * 4); + } + + if (typecp->caps_flags & HAS_SINK_WATT) { + if (typecp->sink_watt) { + anx7411_reg_write(ctx->spi_client, MAX_POWER, + typecp->sink_watt); + /* Set min power to 1W */ + anx7411_reg_write(ctx->spi_client, MIN_POWER, 2); + } + + if (typecp->sink_voltage) + anx7411_reg_write(ctx->spi_client, MAX_VOLTAGE, + typecp->sink_voltage); + } + + if (!typecp->caps_flags) + usleep_range(5000, 6000); + + ctx->fw_version = anx7411_reg_read(ctx->spi_client, FW_VER); + ctx->fw_subversion = anx7411_reg_read(ctx->spi_client, + FW_SUBVER); +} + +static void anx7411_chip_standby(struct anx7411_data *ctx) +{ + anx7411_reg_write(ctx->spi_client, OCM_CTRL_0, + anx7411_reg_read(ctx->spi_client, OCM_CTRL_0) | + OCM_RESET); + anx7411_reg_write(ctx->tcpc_client, ANALOG_CTRL_10, 0x80); + /* Set TCPC to RD and DRP enable */ + anx7411_reg_write(ctx->tcpc_client, + TCPC_ROLE_CTRL, + TCPC_ROLE_CTRL_DRP | + (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC1_SHIFT) | + (TCPC_ROLE_CTRL_CC_RD << TCPC_ROLE_CTRL_CC2_SHIFT)); + + /* Send DRP toggle command */ + anx7411_reg_write(ctx->tcpc_client, TCPC_COMMAND, + TCPC_CMD_LOOK4CONNECTION); + + /* Send TCPC enter standby command */ + anx7411_reg_write(ctx->tcpc_client, TCPC_COMMAND, TCPC_CMD_I2C_IDLE); +} + +static void anx7411_work_func(struct work_struct *work) +{ + int ret; + u8 buf[STATUS_LEN]; + u8 int_change; /* Interrupt change */ + u8 int_status; /* Firmware status update */ + u8 alert0, alert1; /* Interrupt alert source */ + struct anx7411_data *ctx = container_of(work, struct anx7411_data, work); + + mutex_lock(&ctx->lock); + + /* Read interrupt change status */ + ret = anx7411_reg_block_read(ctx->spi_client, INT_STS, STATUS_LEN, buf); + if (ret < 0) { + /* Power standby mode, just return */ + goto unlock; + } + int_change = buf[0]; + int_status = buf[1]; + + /* Read alert register */ + ret = anx7411_reg_block_read(ctx->tcpc_client, ALERT_0, STATUS_LEN, buf); + if (ret < 0) + goto unlock; + + alert0 = buf[0]; + alert1 = buf[1]; + + /* Clear interrupt and alert status */ + anx7411_reg_write(ctx->spi_client, INT_STS, 0); + anx7411_reg_write(ctx->tcpc_client, ALERT_0, alert0); + anx7411_reg_write(ctx->tcpc_client, ALERT_1, alert1); + + if (alert1 & INTP_POW_OFF) { + anx7411_partner_unregister_altmode(ctx); + anx7411_set_usb_role(ctx, USB_ROLE_NONE); + anx7411_unregister_partner(ctx); + ctx->psy_online = ANX7411_PSY_OFFLINE; + ctx->usb_type = POWER_SUPPLY_USB_TYPE_C; + ctx->typec.request_voltage = 0; + ctx->typec.request_current = 0; + power_supply_changed(ctx->psy); + anx7411_chip_standby(ctx); + goto unlock; + } + + if ((alert0 & SOFTWARE_INT) && (int_change & OCM_BOOT_UP)) { + anx7411_config(ctx); + anx7411_data_role_detect(ctx); + anx7411_power_role_detect(ctx); + anx7411_set_mux(ctx, SELECT_PIN_ASSIGMENT_C); + } + + if (alert0 & RECEIVED_MSG) + anx7411_process_cmd(ctx); + + ret = (int_status & DATA_ROLE) ? TYPEC_HOST : TYPEC_DEVICE; + if (ctx->typec.data_role != ret) + anx7411_data_role_detect(ctx); + + ret = (int_status & SINK_STATUS) ? TYPEC_SINK : TYPEC_SOURCE; + if (ctx->typec.power_role != ret) + anx7411_power_role_detect(ctx); + + if ((alert0 & SOFTWARE_INT) && (int_change & CC_STATUS_CHANGE)) + anx7411_cc_status_detect(ctx); + +unlock: + mutex_unlock(&ctx->lock); +} + +static irqreturn_t anx7411_intr_isr(int irq, void *data) +{ + struct anx7411_data *ctx = (struct anx7411_data *)data; + + queue_work(ctx->workqueue, &ctx->work); + + return IRQ_HANDLED; +} + +static int anx7411_register_i2c_dummy_clients(struct anx7411_data *ctx, + struct i2c_client *client) +{ + int i; + u8 spi_addr; + + for (i = 0; i < sizeof(anx7411_i2c_addr); i++) { + if (client->addr == (anx7411_i2c_addr[i].tcpc_address >> 1)) { + spi_addr = anx7411_i2c_addr[i].spi_address >> 1; + ctx->spi_client = i2c_new_dummy_device(client->adapter, + spi_addr); + if (ctx->spi_client) + return 0; + } + } + + dev_err(&client->dev, "unable to get SPI slave\n"); + return -ENOMEM; +} + +static void anx7411_port_unregister_altmodes(struct typec_altmode **adev) +{ + int i; + + for (i = 0; i < MAX_ALTMODE; i++) + if (adev[i]) { + typec_unregister_altmode(adev[i]); + adev[i] = NULL; + } +} + +static int anx7411_usb_mux_set(struct typec_mux_dev *mux, + struct typec_mux_state *state) +{ + struct anx7411_data *ctx = typec_mux_get_drvdata(mux); + struct device *dev = &ctx->spi_client->dev; + int has_dp; + + has_dp = (state->alt && state->alt->svid == USB_TYPEC_DP_SID && + state->alt->mode == USB_TYPEC_DP_MODE); + if (!has_dp) + dev_err(dev, "dp altmode not register\n"); + + return 0; +} + +static int anx7411_usb_set_orientation(struct typec_switch_dev *sw, + enum typec_orientation orientation) +{ + /* No need set */ + + return 0; +} + +static int anx7411_register_switch(struct anx7411_data *ctx, + struct device *dev, + struct fwnode_handle *fwnode) +{ + struct typec_switch_desc sw_desc = { }; + + sw_desc.fwnode = fwnode; + sw_desc.drvdata = ctx; + sw_desc.name = fwnode_get_name(fwnode); + sw_desc.set = anx7411_usb_set_orientation; + + ctx->typec.typec_switch = typec_switch_register(dev, &sw_desc); + if (IS_ERR(ctx->typec.typec_switch)) { + dev_err(dev, "switch register failed\n"); + return PTR_ERR(ctx->typec.typec_switch); + } + + return 0; +} + +static int anx7411_register_mux(struct anx7411_data *ctx, + struct device *dev, + struct fwnode_handle *fwnode) +{ + struct typec_mux_desc mux_desc = { }; + + mux_desc.fwnode = fwnode; + mux_desc.drvdata = ctx; + mux_desc.name = fwnode_get_name(fwnode); + mux_desc.set = anx7411_usb_mux_set; + + ctx->typec.typec_mux = typec_mux_register(dev, &mux_desc); + if (IS_ERR(ctx->typec.typec_mux)) { + dev_err(dev, "mux register failed\n"); + return PTR_ERR(ctx->typec.typec_mux); + } + + return 0; +} + +static void anx7411_unregister_mux(struct anx7411_data *ctx) +{ + if (ctx->typec.typec_mux) { + typec_mux_unregister(ctx->typec.typec_mux); + ctx->typec.typec_mux = NULL; + } +} + +static void anx7411_unregister_switch(struct anx7411_data *ctx) +{ + if (ctx->typec.typec_switch) { + typec_switch_unregister(ctx->typec.typec_switch); + ctx->typec.typec_switch = NULL; + } +} + +static int anx7411_typec_switch_probe(struct anx7411_data *ctx, + struct device *dev) +{ + int ret; + struct device_node *node; + + node = of_find_node_by_name(dev->of_node, "orientation_switch"); + if (!node) { + dev_info(dev, "no typec switch exist\n"); + return 0; + } + + ret = anx7411_register_switch(ctx, dev, &node->fwnode); + if (ret) { + dev_err(dev, "failed register switch"); + return ret; + } + + node = of_find_node_by_name(dev->of_node, "mode_switch"); + if (!node) { + dev_err(dev, "no typec mux exist"); + ret = -ENODEV; + goto unregister_switch; + } + + ret = anx7411_register_mux(ctx, dev, &node->fwnode); + if (ret) { + dev_err(dev, "failed register mode switch"); + ret = -ENODEV; + goto unregister_switch; + } + + return 0; + +unregister_switch: + anx7411_unregister_switch(ctx); + + return ret; +} + +static int anx7411_typec_port_probe(struct anx7411_data *ctx, + struct device *dev) +{ + struct typec_capability *cap = &ctx->typec.caps; + struct typec_params *typecp = &ctx->typec; + struct fwnode_handle *fwnode; + const char *buf; + int ret, i; + + fwnode = device_get_named_child_node(dev, "connector"); + if (!fwnode) + return -EINVAL; + + ret = fwnode_property_read_string(fwnode, "power-role", &buf); + if (ret) { + dev_err(dev, "power-role not found: %d\n", ret); + return ret; + } + + ret = typec_find_port_power_role(buf); + if (ret < 0) + return ret; + cap->type = ret; + + ret = fwnode_property_read_string(fwnode, "data-role", &buf); + if (ret) { + dev_err(dev, "data-role not found: %d\n", ret); + return ret; + } + + ret = typec_find_port_data_role(buf); + if (ret < 0) + return ret; + cap->data = ret; + + ret = fwnode_property_read_string(fwnode, "try-power-role", &buf); + if (ret) { + dev_err(dev, "try-power-role not found: %d\n", ret); + return ret; + } + + ret = typec_find_power_role(buf); + if (ret < 0) + return ret; + cap->prefer_role = ret; + + /* Get source pdos */ + ret = fwnode_property_count_u32(fwnode, "source-pdos"); + if (ret > 0) { + dev_info(dev, "%d source-pdos found\n", ret); + typecp->src_pdo_nr = min(ret, PDO_MAX_OBJECTS); + ret = fwnode_property_read_u32_array(fwnode, "source-pdos", + typecp->src_pdo, + typecp->src_pdo_nr); + if (ret < 0) { + dev_err(dev, "source cap validate failed: %d\n", ret); + return -EINVAL; + } + + typecp->caps_flags |= HAS_SOURCE_CAP; + } + + ret = fwnode_property_count_u32(fwnode, "sink-pdos"); + if (ret > 0) { + dev_info(dev, "%d sink-pdos found\n", ret); + typecp->sink_pdo_nr = min(ret, PDO_MAX_OBJECTS); + ret = fwnode_property_read_u32_array(fwnode, "sink-pdos", + typecp->sink_pdo, + typecp->sink_pdo_nr); + if (ret < 0) { + dev_err(dev, "sink cap validate failed: %d\n", ret); + return -EINVAL; + } + + for (i = 0; i < typecp->sink_pdo_nr; i++) { + ret = 0; + switch (pdo_type(typecp->sink_pdo[i])) { + case PDO_TYPE_FIXED: + ret = pdo_fixed_voltage(typecp->sink_pdo[i]); + break; + case PDO_TYPE_BATT: + case PDO_TYPE_VAR: + ret = pdo_max_voltage(typecp->sink_pdo[i]); + break; + case PDO_TYPE_APDO: + default: + ret = 0; + break; + } + + /* 100mv per unit */ + typecp->sink_voltage = max(5000, ret) / 100; + } + + typecp->caps_flags |= HAS_SINK_CAP; + } + + if (!fwnode_property_read_u32(fwnode, "op-sink-microwatt", &ret)) { + dev_info(dev, "%d sink-microwat found\n", ret); + typecp->sink_watt = ret / 500000; /* 500mw per unit */ + typecp->caps_flags |= HAS_SINK_WATT; + } + + cap->fwnode = fwnode; + + ctx->typec.role_sw = usb_role_switch_get(dev); + if (IS_ERR(ctx->typec.role_sw)) { + dev_err(dev, "USB role switch not found.\n"); + ctx->typec.role_sw = NULL; + } + + ctx->typec.port = typec_register_port(dev, cap); + if (IS_ERR(ctx->typec.port)) { + ret = PTR_ERR(ctx->typec.port); + ctx->typec.port = NULL; + dev_err(dev, "Failed to register type c port %d\n", ret); + return ret; + } + + typec_port_register_altmodes(ctx->typec.port, NULL, ctx, + ctx->typec.port_amode, + MAX_ALTMODE); + + return 0; +} + +static int anx7411_typec_check_connection(struct anx7411_data *ctx) +{ + int ret; + + ret = anx7411_reg_read(ctx->spi_client, FW_VER); + if (ret < 0) + return 0; /* No device attached in typec port */ + + /* Clear interrupt and alert status */ + anx7411_reg_write(ctx->spi_client, INT_STS, 0); + anx7411_reg_write(ctx->tcpc_client, ALERT_0, 0xFF); + anx7411_reg_write(ctx->tcpc_client, ALERT_1, 0xFF); + + anx7411_cc_status_detect(ctx); + anx7411_power_role_detect(ctx); + anx7411_data_role_detect(ctx); + anx7411_set_mux(ctx, SELECT_PIN_ASSIGMENT_C); + + anx7411_send_msg(ctx, TYPE_GET_DP_ALT_ENTER, NULL, 0); + anx7411_send_msg(ctx, TYPE_GET_DP_DISCOVER_MODES_INFO, NULL, 0); + + return 0; +} + +static int __maybe_unused anx7411_runtime_pm_suspend(struct device *dev) +{ + struct anx7411_data *ctx = dev_get_drvdata(dev); + + mutex_lock(&ctx->lock); + + anx7411_partner_unregister_altmode(ctx); + + if (ctx->typec.partner) + anx7411_unregister_partner(ctx); + + mutex_unlock(&ctx->lock); + + return 0; +} + +static int __maybe_unused anx7411_runtime_pm_resume(struct device *dev) +{ + struct anx7411_data *ctx = dev_get_drvdata(dev); + + mutex_lock(&ctx->lock); + /* Detect PD connection */ + anx7411_typec_check_connection(ctx); + + mutex_unlock(&ctx->lock); + + return 0; +} + +static const struct dev_pm_ops anx7411_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, + pm_runtime_force_resume) + SET_RUNTIME_PM_OPS(anx7411_runtime_pm_suspend, + anx7411_runtime_pm_resume, NULL) +}; + +static void anx7411_get_gpio_irq(struct anx7411_data *ctx) +{ + struct device *dev = &ctx->tcpc_client->dev; + + ctx->intp_gpiod = devm_gpiod_get_optional(dev, "interrupt", GPIOD_IN); + if (!ctx->intp_gpiod) { + dev_err(dev, "no interrupt gpio property\n"); + return; + } + + ctx->intp_irq = gpiod_to_irq(ctx->intp_gpiod); + dev_info(dev, "request gpio(%d) irq(%d)\n", + desc_to_gpio(ctx->intp_gpiod), ctx->intp_irq); + + if (!ctx->intp_irq) + dev_err(dev, "failed to get GPIO IRQ\n"); +} + +static const char *anx7411_psy_name_prefix = "anx7411-source-psy-"; + +static enum power_supply_usb_type anx7411_psy_usb_types[] = { + POWER_SUPPLY_USB_TYPE_C, + POWER_SUPPLY_USB_TYPE_PD, + POWER_SUPPLY_USB_TYPE_PD_PPS, +}; + +static enum power_supply_property anx7411_psy_props[] = { + POWER_SUPPLY_PROP_USB_TYPE, + POWER_SUPPLY_PROP_ONLINE, + POWER_SUPPLY_PROP_VOLTAGE_MIN, + POWER_SUPPLY_PROP_VOLTAGE_MAX, + POWER_SUPPLY_PROP_VOLTAGE_NOW, + POWER_SUPPLY_PROP_CURRENT_MAX, + POWER_SUPPLY_PROP_CURRENT_NOW, +}; + +static int anx7411_psy_set_prop(struct power_supply *psy, + enum power_supply_property psp, + const union power_supply_propval *val) +{ + struct anx7411_data *ctx = power_supply_get_drvdata(psy); + int ret = 0; + + if (psp == POWER_SUPPLY_PROP_ONLINE) + ctx->psy_online = val->intval; + else + ret = -EINVAL; + + power_supply_changed(ctx->psy); + return ret; +} + +static int anx7411_psy_prop_writeable(struct power_supply *psy, + enum power_supply_property psp) +{ + return psp == POWER_SUPPLY_PROP_ONLINE; +} + +static int anx7411_psy_get_prop(struct power_supply *psy, + enum power_supply_property psp, + union power_supply_propval *val) +{ + struct anx7411_data *ctx = power_supply_get_drvdata(psy); + int ret = 0; + + switch (psp) { + case POWER_SUPPLY_PROP_USB_TYPE: + val->intval = ctx->usb_type; + break; + case POWER_SUPPLY_PROP_ONLINE: + val->intval = ctx->psy_online; + break; + case POWER_SUPPLY_PROP_VOLTAGE_NOW: + case POWER_SUPPLY_PROP_VOLTAGE_MIN: + case POWER_SUPPLY_PROP_VOLTAGE_MAX: + val->intval = (ctx->psy_online) ? + ctx->typec.request_voltage * 1000 : 0; + break; + case POWER_SUPPLY_PROP_CURRENT_NOW: + case POWER_SUPPLY_PROP_CURRENT_MAX: + val->intval = (ctx->psy_online) ? + ctx->typec.request_current * 1000 : 0; + break; + default: + ret = -EINVAL; + break; + } + return ret; +} + +static int anx7411_psy_register(struct anx7411_data *ctx) +{ + struct power_supply_config psy_cfg = {}; + const char *port_dev_name = dev_name(ctx->dev); + size_t psy_name_len = strlen(anx7411_psy_name_prefix) + + strlen(port_dev_name) + 1; + char *psy_name; + struct power_supply_desc *psy_desc = &ctx->psy_desc; + + psy_cfg.drv_data = ctx; + psy_cfg.fwnode = dev_fwnode(ctx->dev); + psy_name = devm_kzalloc(ctx->dev, psy_name_len, GFP_KERNEL); + if (!psy_name) { + dev_warn(ctx->dev, "unable to alloc psy memory\n"); + return -ENOMEM; + } + + snprintf(psy_name, psy_name_len, "%s%s", anx7411_psy_name_prefix, + port_dev_name); + + psy_desc->name = psy_name; + psy_desc->type = POWER_SUPPLY_TYPE_USB; + psy_desc->usb_types = anx7411_psy_usb_types; + psy_desc->num_usb_types = ARRAY_SIZE(anx7411_psy_usb_types); + psy_desc->properties = anx7411_psy_props, + psy_desc->num_properties = ARRAY_SIZE(anx7411_psy_props), + + psy_desc->get_property = anx7411_psy_get_prop, + psy_desc->set_property = anx7411_psy_set_prop, + psy_desc->property_is_writeable = anx7411_psy_prop_writeable, + + ctx->usb_type = POWER_SUPPLY_USB_TYPE_C; + ctx->psy = devm_power_supply_register(ctx->dev, psy_desc, &psy_cfg); + + if (IS_ERR(ctx->psy)) + dev_warn(ctx->dev, "unable to register psy\n"); + + return PTR_ERR_OR_ZERO(ctx->psy); +} + +static int anx7411_i2c_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + struct anx7411_data *plat; + struct device *dev = &client->dev; + int ret; + + if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_I2C_BLOCK)) + return -ENODEV; + + plat = devm_kzalloc(dev, sizeof(*plat), GFP_KERNEL); + if (!plat) + return -ENOMEM; + + plat->tcpc_client = client; + i2c_set_clientdata(client, plat); + + mutex_init(&plat->lock); + + ret = anx7411_register_i2c_dummy_clients(plat, client); + if (ret) { + dev_err(dev, "fail to reserve I2C bus\n"); + return ret; + } + + ret = anx7411_typec_switch_probe(plat, dev); + if (ret) { + dev_err(dev, "fail to probe typec switch\n"); + goto free_i2c_dummy; + } + + ret = anx7411_typec_port_probe(plat, dev); + if (ret) { + dev_err(dev, "fail to probe typec property.\n"); + ret = -ENODEV; + goto free_typec_switch; + } + + plat->intp_irq = client->irq; + if (!client->irq) { + dev_warn(dev, "no default interrupt IRQ, probe GPIO interrupt"); + anx7411_get_gpio_irq(plat); + } + + if (!plat->intp_irq) { + dev_err(dev, "fail to get interrupt IRQ\n"); + goto free_typec_port; + } + + plat->dev = dev; + plat->psy_online = ANX7411_PSY_OFFLINE; + anx7411_psy_register(plat); + + if (plat->intp_irq) { + INIT_WORK(&plat->work, anx7411_work_func); + plat->workqueue = alloc_workqueue("anx7411_work", + WQ_FREEZABLE | + WQ_MEM_RECLAIM, + 1); + if (!plat->workqueue) { + dev_err(dev, "fail to create work queue\n"); + ret = -ENOMEM; + goto free_typec_port; + } + + ret = devm_request_threaded_irq(dev, plat->intp_irq, + NULL, anx7411_intr_isr, + IRQF_TRIGGER_FALLING | + IRQF_ONESHOT, + "anx7411-intp", plat); + if (ret) { + dev_err(dev, "fail to request irq\n"); + goto free_wq; + } + } + + anx7411_typec_check_connection(plat); + + pm_runtime_enable(dev); + + return 0; + +free_wq: + destroy_workqueue(plat->workqueue); + +free_typec_port: + typec_unregister_port(plat->typec.port); + anx7411_port_unregister_altmodes(plat->typec.port_amode); + +free_typec_switch: + anx7411_unregister_switch(plat); + anx7411_unregister_mux(plat); + +free_i2c_dummy: + i2c_unregister_device(plat->spi_client); + + return ret; +} + +static int anx7411_i2c_remove(struct i2c_client *client) +{ + struct anx7411_data *plat = i2c_get_clientdata(client); + + anx7411_partner_unregister_altmode(plat); + anx7411_unregister_partner(plat); + + if (plat->workqueue) + destroy_workqueue(plat->workqueue); + + if (plat->spi_client) + i2c_unregister_device(plat->spi_client); + + if (plat->typec.role_sw) + usb_role_switch_put(plat->typec.role_sw); + + anx7411_unregister_mux(plat); + + anx7411_unregister_switch(plat); + + if (plat->typec.port) + typec_unregister_port(plat->typec.port); + + anx7411_port_unregister_altmodes(plat->typec.port_amode); + + return 0; +} + +static const struct i2c_device_id anx7411_id[] = { + {"anx7411", 0}, + {} +}; + +MODULE_DEVICE_TABLE(i2c, anx7411_id); + +static const struct of_device_id anx_match_table[] = { + {.compatible = "analogix,anx7411",}, + {}, +}; + +static struct i2c_driver anx7411_driver = { + .driver = { + .name = "anx7411", + .of_match_table = anx_match_table, + .pm = &anx7411_pm_ops, + }, + .probe = anx7411_i2c_probe, + .remove = anx7411_i2c_remove, + + .id_table = anx7411_id, +}; + +module_i2c_driver(anx7411_driver); + +MODULE_DESCRIPTION("Anx7411 USB Type-C PD driver"); +MODULE_AUTHOR("Xin Ji <xji@analogixsemi.com>"); +MODULE_LICENSE("GPL v2"); +MODULE_VERSION("0.1.5"); diff --git a/drivers/usb/typec/anx7411.h b/drivers/usb/typec/anx7411.h new file mode 100644 index 000000000000..09ff80517a5c --- /dev/null +++ b/drivers/usb/typec/anx7411.h @@ -0,0 +1,265 @@ +/* SPDX-License-Identifier: GPL-2.0-only */ + +/* + * Copyright(c) 2022, Analogix Semiconductor. All rights reserved. + * + */ + +#ifndef __ANX7411_H__ +#define __ANX7411_H__ + +#define TCPC_ADDRESS1 0x58 +#define TCPC_ADDRESS2 0x56 +#define TCPC_ADDRESS3 0x54 +#define TCPC_ADDRESS4 0x52 +#define SPI_ADDRESS1 0x7e +#define SPI_ADDRESS2 0x6e +#define SPI_ADDRESS3 0x64 +#define SPI_ADDRESS4 0x62 + +struct anx7411_i2c_select { + u8 tcpc_address; + u8 spi_address; +}; + +#define VID_ANALOGIX 0x1F29 +#define PID_ANALOGIX 0x7411 + +/* TCPC register define */ + +#define ANALOG_CTRL_10 0xAA + +#define STATUS_LEN 2 +#define ALERT_0 0xCB +#define RECEIVED_MSG BIT(7) +#define SOFTWARE_INT BIT(6) +#define MSG_LEN 32 +#define HEADER_LEN 2 +#define MSG_HEADER 0x00 +#define MSG_TYPE 0x01 +#define MSG_RAWDATA 0x02 +#define MSG_LEN_MASK 0x1F + +#define ALERT_1 0xCC +#define INTP_POW_ON BIT(7) +#define INTP_POW_OFF BIT(6) + +#define VBUS_THRESHOLD_H 0xDD +#define VBUS_THRESHOLD_L 0xDE + +#define FW_CTRL_0 0xF0 +#define UNSTRUCT_VDM_EN BIT(0) +#define DELAY_200MS BIT(1) +#define VSAFE0 0 +#define VSAFE1 BIT(2) +#define VSAFE2 BIT(3) +#define VSAFE3 (BIT(2) | BIT(3)) +#define FRS_EN BIT(7) + +#define FW_PARAM 0xF1 +#define DONGLE_IOP BIT(0) + +#define FW_CTRL_2 0xF7 +#define SINK_CTRL_DIS_FLAG BIT(5) + +/* SPI register define */ +#define OCM_CTRL_0 0x6E +#define OCM_RESET BIT(6) + +#define MAX_VOLTAGE 0xAC +#define MAX_POWER 0xAD +#define MIN_POWER 0xAE + +#define REQUEST_VOLTAGE 0xAF +#define VOLTAGE_UNIT 100 /* mV per unit */ + +#define REQUEST_CURRENT 0xB1 +#define CURRENT_UNIT 50 /* mA per unit */ + +#define CMD_SEND_BUF 0xC0 +#define CMD_RECV_BUF 0xE0 + +#define REQ_VOL_20V_IN_100MV 0xC8 +#define REQ_CUR_2_25A_IN_50MA 0x2D +#define REQ_CUR_3_25A_IN_50MA 0x41 + +#define DEF_5V 5000 +#define DEF_1_5A 1500 + +#define LOBYTE(w) ((u8)(w) & 0xFF) +#define HIBYTE(w) ((u8)(((u16)(w) >> 8) & 0xFF)) + +enum anx7411_typec_message_type { + TYPE_SRC_CAP = 0x00, + TYPE_SNK_CAP = 0x01, + TYPE_SNK_IDENTITY = 0x02, + TYPE_SVID = 0x03, + TYPE_SET_SNK_DP_CAP = 0x08, + TYPE_PSWAP_REQ = 0x10, + TYPE_DSWAP_REQ = 0x11, + TYPE_VDM = 0x14, + TYPE_OBJ_REQ = 0x16, + TYPE_DP_ALT_ENTER = 0x19, + TYPE_DP_DISCOVER_MODES_INFO = 0x27, + TYPE_GET_DP_CONFIG = 0x29, + TYPE_DP_CONFIGURE = 0x2A, + TYPE_GET_DP_DISCOVER_MODES_INFO = 0x2E, + TYPE_GET_DP_ALT_ENTER = 0x2F, +}; + +#define FW_CTRL_1 0xB2 +#define AUTO_PD_EN BIT(1) +#define TRYSRC_EN BIT(2) +#define TRYSNK_EN BIT(3) +#define FORCE_SEND_RDO BIT(6) + +#define FW_VER 0xB4 +#define FW_SUBVER 0xB5 + +#define INT_MASK 0xB6 +#define INT_STS 0xB7 +#define OCM_BOOT_UP BIT(0) +#define OC_OV_EVENT BIT(1) +#define VCONN_CHANGE BIT(2) +#define VBUS_CHANGE BIT(3) +#define CC_STATUS_CHANGE BIT(4) +#define DATA_ROLE_CHANGE BIT(5) +#define PR_CONSUMER_GOT_POWER BIT(6) +#define HPD_STATUS_CHANGE BIT(7) + +#define SYSTEM_STSTUS 0xB8 +/* 0: SINK off; 1: SINK on */ +#define SINK_STATUS BIT(1) +/* 0: VCONN off; 1: VCONN on*/ +#define VCONN_STATUS BIT(2) +/* 0: vbus off; 1: vbus on*/ +#define VBUS_STATUS BIT(3) +/* 1: host; 0:device*/ +#define DATA_ROLE BIT(5) +/* 0: Chunking; 1: Unchunked*/ +#define SUPPORT_UNCHUNKING BIT(6) +/* 0: HPD low; 1: HPD high*/ +#define HPD_STATUS BIT(7) + +#define DATA_DFP 1 +#define DATA_UFP 2 +#define POWER_SOURCE 1 +#define POWER_SINK 2 + +#define CC_STATUS 0xB9 +#define CC1_RD BIT(0) +#define CC2_RD BIT(4) +#define CC1_RA BIT(1) +#define CC2_RA BIT(5) +#define CC1_RD BIT(0) +#define CC1_RP(cc) (((cc) >> 2) & 0x03) +#define CC2_RP(cc) (((cc) >> 6) & 0x03) + +#define PD_REV_INIT 0xBA + +#define PD_EXT_MSG_CTRL 0xBB +#define SRC_CAP_EXT_REPLY BIT(0) +#define MANUFACTURER_INFO_REPLY BIT(1) +#define BATTERY_STS_REPLY BIT(2) +#define BATTERY_CAP_REPLY BIT(3) +#define ALERT_REPLY BIT(4) +#define STATUS_REPLY BIT(5) +#define PPS_STATUS_REPLY BIT(6) +#define SNK_CAP_EXT_REPLY BIT(7) + +#define NO_CONNECT 0x00 +#define USB3_1_CONNECTED 0x01 +#define DP_ALT_4LANES 0x02 +#define USB3_1_DP_2LANES 0x03 +#define CC1_CONNECTED 0x01 +#define CC2_CONNECTED 0x02 +#define SELECT_PIN_ASSIGMENT_C 0x04 +#define SELECT_PIN_ASSIGMENT_D 0x08 +#define SELECT_PIN_ASSIGMENT_E 0x10 +#define SELECT_PIN_ASSIGMENT_U 0x00 +#define REDRIVER_ADDRESS 0x20 +#define REDRIVER_OFFSET 0x00 + +#define DP_SVID 0xFF01 +#define VDM_ACK 0x40 +#define VDM_CMD_RES 0x00 +#define VDM_CMD_DIS_ID 0x01 +#define VDM_CMD_DIS_SVID 0x02 +#define VDM_CMD_DIS_MOD 0x03 +#define VDM_CMD_ENTER_MODE 0x04 +#define VDM_CMD_EXIT_MODE 0x05 +#define VDM_CMD_ATTENTION 0x06 +#define VDM_CMD_GET_STS 0x10 +#define VDM_CMD_AND_ACK_MASK 0x5F + +#define MAX_ALTMODE 2 + +#define HAS_SOURCE_CAP BIT(0) +#define HAS_SINK_CAP BIT(1) +#define HAS_SINK_WATT BIT(2) + +enum anx7411_psy_state { + /* copy from drivers/usb/typec/tcpm */ + ANX7411_PSY_OFFLINE = 0, + ANX7411_PSY_FIXED_ONLINE, + + /* private */ + /* PD keep in, but disconnct power to bq25700, + * this state can be active when higher capacity adapter plug in, + * and change to ONLINE state when higher capacity adapter plug out + */ + ANX7411_PSY_HANG = 0xff, +}; + +struct typec_params { + int request_current; /* ma */ + int request_voltage; /* mv */ + int cc_connect; + int cc_orientation_valid; + int cc_status; + int data_role; + int power_role; + int vconn_role; + int dp_altmode_enter; + int cust_altmode_enter; + struct usb_role_switch *role_sw; + struct typec_port *port; + struct typec_partner *partner; + struct typec_mux_dev *typec_mux; + struct typec_switch_dev *typec_switch; + struct typec_altmode *amode[MAX_ALTMODE]; + struct typec_altmode *port_amode[MAX_ALTMODE]; + struct typec_displayport_data data; + int pin_assignment; + struct typec_capability caps; + u32 src_pdo[PDO_MAX_OBJECTS]; + u32 sink_pdo[PDO_MAX_OBJECTS]; + u8 caps_flags; + u8 src_pdo_nr; + u8 sink_pdo_nr; + u8 sink_watt; + u8 sink_voltage; +}; + +struct anx7411_data { + int fw_version; + int fw_subversion; + struct i2c_client *tcpc_client; + struct i2c_client *spi_client; + struct gpio_desc *intp_gpiod; + struct fwnode_handle *connector_fwnode; + struct typec_params typec; + int intp_irq; + struct work_struct work; + struct workqueue_struct *workqueue; + /* Lock for interrupt work queue */ + struct mutex lock; + + enum anx7411_psy_state psy_online; + enum power_supply_usb_type usb_type; + struct power_supply *psy; + struct power_supply_desc psy_desc; + struct device *dev; +}; + +#endif /* __ANX7411_H__ */
Add driver for analogix ANX7411 USB Type-C DRP port controller. Signed-off-by: Xin Ji <xji@analogixsemi.com> --- V9 -> V10 : Rebase on the latest code V6 -> V7 : Fix Heikki's comment Rebase on Greg's latest usb-next branch Move tcpci.h to include/linux/usb/ Remove double definition V5 -> V6 : Fix Heikki's comment V4 -> V5 : Fix Greg h-k comment, remove DEBUG define V3 -> V4 : Fix compiling waring V2 -> V3 : Add changelog history V1 -> V2 : Fix compiling warning issue --- drivers/usb/typec/Kconfig | 11 + drivers/usb/typec/Makefile | 1 + drivers/usb/typec/anx7411.c | 1327 +++++++++++++++++++++++++++++++++++ drivers/usb/typec/anx7411.h | 265 +++++++ 4 files changed, 1604 insertions(+) create mode 100644 drivers/usb/typec/anx7411.c create mode 100644 drivers/usb/typec/anx7411.h