@@ -64,6 +64,17 @@ config TYPEC_ANX7411
If you choose to build this driver as a dynamically linked module, the
module will be called anx7411.ko.
+config TYPEC_ANX7688
+ tristate "Analogix ANX7688 Type-C DRP Port controller and mux driver"
+ depends on I2C
+ depends on USB_ROLE_SWITCH
+ help
+ Say Y or M here if your system has Analogix ANX7688 Type-C Bridge
+ controller driver.
+
+ If you choose to build this driver as a dynamically linked module, the
+ module will be called anx7688.ko.
+
config TYPEC_RT1719
tristate "Richtek RT1719 Sink Only Type-C controller driver"
depends on USB_ROLE_SWITCH || !USB_ROLE_SWITCH
@@ -7,6 +7,7 @@ obj-$(CONFIG_TYPEC_TCPM) += tcpm/
obj-$(CONFIG_TYPEC_UCSI) += ucsi/
obj-$(CONFIG_TYPEC_TPS6598X) += tipd/
obj-$(CONFIG_TYPEC_ANX7411) += anx7411.o
+obj-$(CONFIG_TYPEC_ANX7688) += anx7688.o
obj-$(CONFIG_TYPEC_HD3SS3220) += hd3ss3220.o
obj-$(CONFIG_TYPEC_STUSB160X) += stusb160x.o
obj-$(CONFIG_TYPEC_RT1719) += rt1719.o
new file mode 100644
@@ -0,0 +1,1927 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * ANX7688 USB-C HDMI bridge/PD driver
+ *
+ * Warning, this driver is somewhat PinePhone specific.
+ *
+ * How this works:
+ * - this driver allows to program firmware into ANX7688 EEPROM, and
+ * initialize it
+ * - it then communicates with the firmware running on the OCM (on-chip
+ * microcontroller)
+ * - it detects whether there is cable plugged in or not and powers
+ * up or down the ANX7688 based on that
+ * - when the cable is connected the firmware on the OCM will handle
+ * the detection of the nature of the device on the other end
+ * of the USB-C cable
+ * - this driver then communicates with the USB phy to let it swap
+ * data roles accordingly
+ * - it also enables VBUS and VCONN regulators as appropriate
+ * - USB phy driver (Allwinner) needs to know whether to switch to
+ * device or host mode, or whether to turn off
+ * - when the firmware detects SRC.1.5A or SRC.3.0A via CC pins
+ * or something else via PD, it notifies this driver via software
+ * interrupt and this driver will determine how to update the TypeC
+ * port status and what input current limit is appropriate
+ * - input current limit determination happens 500ms after cable
+ * insertion or hard reset (delay is necessary to determine whether
+ * the remote end is PD capable or not)
+ * - this driver tells to the PMIC driver that the input current limit
+ * needs to be changed
+ * - this driver also monitors PMIC status and re-sets the input current
+ * limit if it changes for some reason (due to PMIC internal decision
+ * making) (this is disabled for now)
+ *
+ * ANX7688 FW behavior as observed:
+ *
+ * - DO NOT SET MORE THAN 1 SINK CAPABILITY! Firmware will ignore what
+ * you set and send hardcoded PDO_BATT 5-21V 30W message!
+ *
+ * Product brief:
+ * https://www.analogix.com/en/system/files/AA-002281-PB-6-ANX7688_Product_Brief_0.pdf
+ * Development notes:
+ * https://xnux.eu/devices/feature/anx7688.html
+ */
+
+#include <linux/debugfs.h>
+#include <linux/delay.h>
+#include <linux/extcon-provider.h>
+#include <linux/firmware.h>
+#include <linux/gpio/consumer.h>
+#include <linux/i2c.h>
+#include <linux/interrupt.h>
+#include <linux/irqreturn.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/of_irq.h>
+#include <linux/power_supply.h>
+#include <linux/regulator/consumer.h>
+#include <linux/usb/pd.h>
+#include <linux/usb/role.h>
+#include <linux/usb/typec.h>
+
+/* firmware regs */
+
+#define ANX7688_REG_VBUS_OFF_DELAY_TIME 0x22
+#define ANX7688_REG_FEATURE_CTRL 0x27
+#define ANX7688_REG_EEPROM_LOAD_STATUS1 0x11
+#define ANX7688_REG_EEPROM_LOAD_STATUS0 0x12
+#define ANX7688_REG_FW_VERSION1 0x15
+#define ANX7688_REG_FW_VERSION0 0x16
+
+#define ANX7688_EEPROM_FW_LOADED 0x01
+
+#define ANX7688_REG_STATUS_INT_MASK 0x17
+#define ANX7688_REG_STATUS_INT 0x28
+#define ANX7688_IRQS_RECEIVED_MSG BIT(0)
+#define ANX7688_IRQS_RECEIVED_ACK BIT(1)
+#define ANX7688_IRQS_VCONN_CHANGE BIT(2)
+#define ANX7688_IRQS_VBUS_CHANGE BIT(3)
+#define ANX7688_IRQS_CC_STATUS_CHANGE BIT(4)
+#define ANX7688_IRQS_DATA_ROLE_CHANGE BIT(5)
+
+#define ANX7688_REG_STATUS 0x29
+#define ANX7688_VCONN_STATUS BIT(2) /* 0 = off 1 = on */
+#define ANX7688_VBUS_STATUS BIT(3) /* 0 = off 1 = on */
+#define ANX7688_DATA_ROLE_STATUS BIT(5) /* 0 = device 1 = host */
+
+#define ANX7688_REG_CC_STATUS 0x2a
+#define ANX7688_REG_TRY_UFP_TIMER 0x23
+#define ANX7688_REG_TIME_CTRL 0x24
+
+#define ANX7688_REG_MAX_VOLTAGE 0x1b
+#define ANX7688_REG_MAX_POWER 0x1c
+#define ANX7688_REG_MIN_POWER 0x1d
+#define ANX7688_REG_MAX_VOLTAGE_STATUS 0x1e
+#define ANX7688_REG_MAX_POWER_STATUS 0x1f
+
+#define ANX7688_SOFT_INT_MASK 0x7f
+
+/* tcpc regs */
+
+#define ANX7688_TCPC_REG_VENDOR_ID0 0x00
+#define ANX7688_TCPC_REG_VENDOR_ID1 0x01
+#define ANX7688_TCPC_REG_ALERT0 0x10
+#define ANX7688_TCPC_REG_ALERT1 0x11
+#define ANX7688_TCPC_REG_ALERT_MASK0 0x12
+#define ANX7688_TCPC_REG_ALERT_MASK1 0x13
+#define ANX7688_TCPC_REG_INTERFACE_SEND 0x30
+#define ANX7688_TCPC_REG_INTERFACE_RECV 0x51
+
+/* hw regs */
+
+#define ANX7688_REG_IRQ_EXT_SOURCE0 0x3e
+#define ANX7688_REG_IRQ_EXT_SOURCE1 0x4e
+#define ANX7688_REG_IRQ_EXT_SOURCE2 0x4f
+#define ANX7688_REG_IRQ_EXT_MASK0 0x3b
+#define ANX7688_REG_IRQ_EXT_MASK1 0x3c
+#define ANX7688_REG_IRQ_EXT_MASK2 0x3d
+#define ANX7688_REG_IRQ_SOURCE0 0x54
+#define ANX7688_REG_IRQ_SOURCE1 0x55
+#define ANX7688_REG_IRQ_SOURCE2 0x56
+#define ANX7688_REG_IRQ_MASK0 0x57
+#define ANX7688_REG_IRQ_MASK1 0x58
+#define ANX7688_REG_IRQ_MASK2 0x59
+
+#define ANX7688_IRQ2_SOFT_INT BIT(2)
+
+#define ANX7688_REG_USBC_RESET_CTRL 0x05
+#define ANX7688_USBC_RESET_CTRL_OCM_RESET BIT(4)
+
+/* ocm messages */
+
+#define ANX7688_OCM_MSG_PWR_SRC_CAP 0x00
+#define ANX7688_OCM_MSG_PWR_SNK_CAP 0x01
+#define ANX7688_OCM_MSG_DP_SNK_IDENTITY 0x02
+#define ANX7688_OCM_MSG_SVID 0x03
+#define ANX7688_OCM_MSG_GET_DP_SNK_CAP 0x04
+#define ANX7688_OCM_MSG_ACCEPT 0x05
+#define ANX7688_OCM_MSG_REJECT 0x06
+#define ANX7688_OCM_MSG_PSWAP_REQ 0x10
+#define ANX7688_OCM_MSG_DSWAP_REQ 0x11
+#define ANX7688_OCM_MSG_GOTO_MIN_REQ 0x12
+#define ANX7688_OCM_MSG_VCONN_SWAP_REQ 0x13
+#define ANX7688_OCM_MSG_VDM 0x14
+#define ANX7688_OCM_MSG_DP_SNK_CFG 0x15
+#define ANX7688_OCM_MSG_PWR_OBJ_REQ 0x16
+#define ANX7688_OCM_MSG_PD_STATUS_REQ 0x17
+#define ANX7688_OCM_MSG_DP_ALT_ENTER 0x19
+#define ANX7688_OCM_MSG_DP_ALT_EXIT 0x1a
+#define ANX7688_OCM_MSG_GET_SNK_CAP 0x1b
+#define ANX7688_OCM_MSG_RESPONSE_TO_REQ 0xf0
+#define ANX7688_OCM_MSG_SOFT_RST 0xf1
+#define ANX7688_OCM_MSG_HARD_RST 0xf2
+#define ANX7688_OCM_MSG_RESTART 0xf3
+
+static const char * const anx7688_supply_names[] = {
+ "avdd33",
+ "avdd18",
+ "dvdd18",
+ "avdd10",
+ "dvdd10",
+ "i2c",
+ "hdmi-vt",
+
+ "vconn", // power for VCONN1/VCONN2 switches
+ "vbus", // vbus power
+};
+
+#define ANX7688_NUM_SUPPLIES ARRAY_SIZE(anx7688_supply_names)
+#define ANX7688_NUM_ALWAYS_ON_SUPPLIES (ANX7688_NUM_SUPPLIES - 1)
+
+#define ANX7688_I2C_INDEX (ANX7688_NUM_SUPPLIES - 4)
+#define ANX7688_VCONN_INDEX (ANX7688_NUM_SUPPLIES - 2)
+#define ANX7688_VBUS_INDEX (ANX7688_NUM_SUPPLIES - 1)
+
+enum {
+ ANX7688_F_POWERED,
+ ANX7688_F_CONNECTED,
+ ANX7688_F_FW_FAILED,
+ ANX7688_F_PWRSUPPLY_CHANGE,
+ ANX7688_F_CURRENT_UPDATE,
+};
+
+struct anx7688 {
+ struct device *dev;
+ struct i2c_client *client;
+ struct i2c_client *client_tcpc;
+ struct regulator_bulk_data supplies[ANX7688_NUM_SUPPLIES];
+ struct power_supply *vbus_in_supply;
+ struct notifier_block vbus_in_nb;
+ int input_current_limit; // mA
+ struct gpio_desc *gpio_enable;
+ struct gpio_desc *gpio_reset;
+ struct gpio_desc *gpio_cabledet;
+
+ uint32_t src_caps[8];
+ unsigned int n_src_caps;
+
+ uint32_t snk_caps[8];
+ unsigned int n_snk_caps;
+
+ unsigned long flags[1];
+
+ struct delayed_work work;
+ struct timer_list work_timer;
+
+ struct mutex lock;
+ bool vbus_on, vconn_on;
+ bool pd_capable;
+ int pd_current_limit; // mA
+ ktime_t current_update_deadline;
+
+ struct typec_port *port;
+ struct typec_partner *partner;
+ struct usb_pd_identity partner_identity;
+ struct usb_role_switch *role_sw;
+ int pwr_role, data_role;
+
+ struct dentry *debug_root;
+
+ /* for debug */
+ int last_status;
+ int last_cc_status;
+ int last_dp_state;
+ int last_bc_result;
+
+ /* for HDMI HPD */
+ struct extcon_dev *extcon;
+ int last_extcon_state;
+};
+
+static const unsigned int anx7688_extcon_cable[] = {
+ EXTCON_DISP_HDMI,
+ EXTCON_NONE,
+};
+
+static int anx7688_reg_read(struct anx7688 *anx7688, u8 reg_addr)
+{
+ int ret;
+
+ ret = i2c_smbus_read_byte_data(anx7688->client, reg_addr);
+ if (ret < 0)
+ dev_err(anx7688->dev, "i2c read failed at 0x%x (%d)\n",
+ reg_addr, ret);
+
+ return ret;
+}
+
+static int anx7688_reg_write(struct anx7688 *anx7688, u8 reg_addr, u8 value)
+{
+ int ret;
+
+ ret = i2c_smbus_write_byte_data(anx7688->client, reg_addr, value);
+ if (ret < 0)
+ dev_err(anx7688->dev, "i2c write failed at 0x%x (%d)\n",
+ reg_addr, ret);
+
+ return ret;
+}
+
+static int anx7688_reg_update_bits(struct anx7688 *anx7688, u8 reg_addr,
+ u8 mask, u8 value)
+{
+ int ret;
+
+ ret = anx7688_reg_read(anx7688, reg_addr);
+ if (ret < 0)
+ return ret;
+
+ ret &= ~mask;
+ ret |= value;
+
+ return anx7688_reg_write(anx7688, reg_addr, ret);
+}
+
+static int anx7688_tcpc_reg_read(struct anx7688 *anx7688, u8 reg_addr)
+{
+ int ret;
+
+ ret = i2c_smbus_read_byte_data(anx7688->client_tcpc, reg_addr);
+ if (ret < 0)
+ dev_err(anx7688->dev, "tcpc i2c read failed at 0x%x (%d)\n",
+ reg_addr, ret);
+
+ return ret;
+}
+
+static int anx7688_tcpc_reg_write(struct anx7688 *anx7688, u8 reg_addr, u8 value)
+{
+ int ret;
+
+ ret = i2c_smbus_write_byte_data(anx7688->client_tcpc, reg_addr, value);
+ if (ret < 0)
+ dev_err(anx7688->dev, "tcpc i2c write failed at 0x%x (%d)\n",
+ reg_addr, ret);
+
+ return ret;
+}
+
+static void anx7688_power_enable(struct anx7688 *anx7688)
+{
+ gpiod_set_value(anx7688->gpio_reset, 1);
+ gpiod_set_value(anx7688->gpio_enable, 1);
+
+ /* wait for power to stabilize and release reset */
+ msleep(10);
+ gpiod_set_value(anx7688->gpio_reset, 0);
+ udelay(2);
+
+ dev_dbg(anx7688->dev, "power enabled\n");
+
+ set_bit(ANX7688_F_POWERED, anx7688->flags);
+}
+
+static void anx7688_power_disable(struct anx7688 *anx7688)
+{
+ gpiod_set_value(anx7688->gpio_reset, 1);
+ msleep(5);
+ gpiod_set_value(anx7688->gpio_enable, 0);
+
+ dev_dbg(anx7688->dev, "power disabled\n");
+
+ clear_bit(ANX7688_F_POWERED, anx7688->flags);
+}
+
+static int anx7688_send_ocm_message(struct anx7688 *anx7688, int cmd,
+ const u8 *data, int data_len)
+{
+ int ret = 0, i;
+ u8 pkt[32];
+
+ if (data_len > sizeof(pkt) - 3) {
+ dev_dbg(anx7688->dev,
+ "invalid ocm message length cmd=0x%02x len=%d\n",
+ cmd, data_len);
+ return -EINVAL;
+ }
+
+ // prepare pd packet
+ pkt[0] = data_len + 1;
+ pkt[1] = cmd;
+ if (data_len > 0)
+ memcpy(pkt + 2, data, data_len);
+ pkt[2 + data_len] = 0;
+ for (i = 0; i < data_len + 2; i++)
+ pkt[data_len + 2] -= pkt[i];
+
+ dev_dbg(anx7688->dev, "send pd packet cmd=0x%02x %*ph\n",
+ cmd, data_len + 3, pkt);
+
+ ret = anx7688_tcpc_reg_read(anx7688, ANX7688_TCPC_REG_INTERFACE_SEND);
+ if (ret) {
+ dev_err(anx7688->dev,
+ "failed to send pd packet (tx buffer full)\n");
+ return -EBUSY;
+ }
+
+ ret = i2c_smbus_write_i2c_block_data(anx7688->client_tcpc,
+ ANX7688_TCPC_REG_INTERFACE_SEND,
+ data_len + 3, pkt);
+ if (ret < 0)
+ dev_err(anx7688->dev,
+ "failed to send pd packet (err=%d)\n", ret);
+
+ // wait until the message is processed (30ms max)
+ for (i = 0; i < 300; i++) {
+ ret = anx7688_tcpc_reg_read(anx7688, ANX7688_TCPC_REG_INTERFACE_SEND);
+ if (ret <= 0)
+ return ret;
+
+ udelay(100);
+ }
+
+ dev_err(anx7688->dev, "timeout waiting for the message queue flush\n");
+ return -ETIMEDOUT;
+}
+
+static int anx7688_connect(struct anx7688 *anx7688)
+{
+ struct typec_partner_desc desc = {};
+ int ret, i;
+ u8 fw[2];
+ const u8 dp_snk_identity[16] = {
+ 0x00, 0x00, 0x00, 0xec, /* id header */
+ 0x00, 0x00, 0x00, 0x00, /* cert stat */
+ 0x00, 0x00, 0x00, 0x00, /* product type */
+ 0x39, 0x00, 0x00, 0x51 /* alt mode adapter */
+ };
+ const u8 svid[4] = {
+ 0x00, 0x00, 0x01, 0xff,
+ };
+ u32 caps[8];
+
+ dev_dbg(anx7688->dev, "cable inserted\n");
+
+ anx7688->last_status = -1;
+ anx7688->last_cc_status = -1;
+ anx7688->last_dp_state = -1;
+
+ msleep(10);
+ anx7688_power_enable(anx7688);
+
+ ret = regulator_enable(anx7688->supplies[ANX7688_VCONN_INDEX].consumer);
+ if (ret) {
+ dev_err(anx7688->dev, "failed to enable vconn\n");
+ goto err_poweroff;
+ }
+ anx7688->vconn_on = true;
+
+ /* wait till the firmware is loaded (typically ~30ms) */
+ for (i = 0; i < 100; i++) {
+ ret = anx7688_reg_read(anx7688, ANX7688_REG_EEPROM_LOAD_STATUS0);
+
+ if (ret >= 0 && (ret & ANX7688_EEPROM_FW_LOADED) == ANX7688_EEPROM_FW_LOADED) {
+ dev_dbg(anx7688->dev, "eeprom0 = 0x%02x\n", ret);
+ dev_info(anx7688->dev, "fw loaded after %d ms\n", i * 10);
+ goto fw_loaded;
+ }
+
+ msleep(5);
+ }
+
+ set_bit(ANX7688_F_FW_FAILED, anx7688->flags);
+ dev_err(anx7688->dev, "boot firmware load failed (you may need to flash FW to anx7688 first)\n");
+ ret = -ETIMEDOUT;
+ goto err_vconoff;
+
+fw_loaded:
+ ret = i2c_smbus_read_i2c_block_data(anx7688->client,
+ ANX7688_REG_FW_VERSION1, 2, fw);
+ if (ret < 0) {
+ dev_err(anx7688->dev, "failed to read firmware version\n");
+ goto err_vconoff;
+ }
+
+ dev_info(anx7688->dev, "OCM firmware loaded (version 0x%04x)\n",
+ fw[1] | fw[0] << 8);
+
+ /* Unmask interrupts */
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_STATUS_INT, 0);
+ if (ret)
+ goto err_vconoff;
+
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_STATUS_INT_MASK, ~ANX7688_SOFT_INT_MASK);
+ if (ret)
+ goto err_vconoff;
+
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_IRQ_EXT_SOURCE2, 0xff);
+ if (ret)
+ goto err_vconoff;
+
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_IRQ_EXT_MASK2, (u8)~ANX7688_IRQ2_SOFT_INT);
+ if (ret)
+ goto err_vconoff;
+
+ /* time to turn off vbus after cc disconnect (unit is 4 ms) */
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_VBUS_OFF_DELAY_TIME, 100 / 4);
+ if (ret)
+ goto err_vconoff;
+
+ /* 300ms (unit is 2 ms) */
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_TRY_UFP_TIMER, 300 / 2);
+ if (ret)
+ goto err_vconoff;
+
+ /* maximum voltage in 100 mV units */
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_MAX_VOLTAGE, 50); /* 5 V */
+ if (ret)
+ goto err_vconoff;
+
+ /* min/max power in 500 mW units */
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_MAX_POWER, 15 * 2); /* 15 W */
+ if (ret)
+ goto err_vconoff;
+
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_MIN_POWER, 1); /* 0.5 W */
+ if (ret)
+ goto err_vconoff;
+
+ /* auto_pd, try.src, try.sink, goto safe 5V */
+ ret = anx7688_reg_write(anx7688, ANX7688_REG_FEATURE_CTRL, 0x1e & ~BIT(2)); // disable try_src
+ if (ret)
+ goto err_vconoff;
+
+ for (i = 0; i < anx7688->n_src_caps; i++)
+ caps[i] = cpu_to_le32(anx7688->src_caps[i]);
+ ret = anx7688_send_ocm_message(anx7688, ANX7688_OCM_MSG_PWR_SRC_CAP,
+ (u8 *)&caps, 4 * anx7688->n_src_caps);
+ if (ret)
+ goto err_vconoff;
+
+ for (i = 0; i < anx7688->n_snk_caps; i++)
+ caps[i] = cpu_to_le32(anx7688->snk_caps[i]);
+ ret = anx7688_send_ocm_message(anx7688, ANX7688_OCM_MSG_PWR_SNK_CAP,
+ (u8 *)&caps, 4 * anx7688->n_snk_caps);
+ if (ret)
+ goto err_vconoff;
+
+ /* Send DP SNK identity */
+ ret = anx7688_send_ocm_message(anx7688, ANX7688_OCM_MSG_DP_SNK_IDENTITY,
+ dp_snk_identity, sizeof(dp_snk_identity));
+ if (ret)
+ goto err_vconoff;
+
+ ret = anx7688_send_ocm_message(anx7688, ANX7688_OCM_MSG_SVID,
+ svid, sizeof(svid));
+ if (ret)
+ goto err_vconoff;
+
+ dev_dbg(anx7688->dev, "OCM configuration completed\n");
+
+ desc.accessory = TYPEC_ACCESSORY_NONE;
+
+ typec_unregister_partner(anx7688->partner);
+
+ anx7688->partner = typec_register_partner(anx7688->port, &desc);
+ if (IS_ERR(anx7688->partner)) {
+ ret = PTR_ERR(anx7688->partner);
+ goto err_vconoff;
+ }
+
+ // after this deadline passes we'll check if device is pd_capable and
+ // set up the current limit accordingly
+ anx7688->current_update_deadline = ktime_add_ms(ktime_get(), 3000);
+
+ set_bit(ANX7688_F_CONNECTED, anx7688->flags);
+ return 0;
+
+err_vconoff:
+ regulator_disable(anx7688->supplies[ANX7688_VCONN_INDEX].consumer);
+ anx7688->vconn_on = false;
+err_poweroff:
+ anx7688_power_disable(anx7688);
+ dev_err(anx7688->dev, "OCM configuration failed\n");
+ return ret;
+}
+
+static void anx7688_set_hdmi_hpd(struct anx7688 *anx7688, int state)
+{
+ if (!anx7688->extcon)
+ return;
+
+ if (anx7688->last_extcon_state != state) {
+ extcon_set_state_sync(anx7688->extcon, EXTCON_DISP_HDMI, state);
+ anx7688->last_extcon_state = state;
+ }
+}
+
+static void anx7688_disconnect(struct anx7688 *anx7688)
+{
+ union power_supply_propval val = {0,};
+ struct device *dev = anx7688->dev;
+ int ret;
+
+ dev_dbg(dev, "cable removed\n");
+
+ anx7688->current_update_deadline = 0;
+
+ anx7688_set_hdmi_hpd(anx7688, 0);
+
+ if (anx7688->vconn_on) {
+ regulator_disable(anx7688->supplies[ANX7688_VCONN_INDEX].consumer);
+ anx7688->vconn_on = false;
+ }
+
+ if (anx7688->vbus_on) {
+ regulator_disable(anx7688->supplies[ANX7688_VBUS_INDEX].consumer);
+ anx7688->vbus_on = false;
+ }
+
+ anx7688_power_disable(anx7688);
+
+ anx7688->pd_capable = false;
+
+ typec_unregister_partner(anx7688->partner);
+ anx7688->partner = NULL;
+
+ anx7688->pwr_role = TYPEC_SINK;
+ anx7688->data_role = TYPEC_DEVICE;
+ typec_set_pwr_role(anx7688->port, anx7688->pwr_role);
+ typec_set_data_role(anx7688->port, anx7688->data_role);
+ typec_set_pwr_opmode(anx7688->port, TYPEC_PWR_MODE_USB);
+ typec_set_vconn_role(anx7688->port, TYPEC_SINK);
+
+ usb_role_switch_set_role(anx7688->role_sw, USB_ROLE_NONE);
+
+ val.intval = 500 * 1000;
+ dev_dbg(dev, "setting vbus_in current limit to %d mA\n", val.intval);
+ ret = power_supply_set_property(anx7688->vbus_in_supply,
+ POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
+ &val);
+ if (ret)
+ dev_err(dev, "failed to set vbus_in current to %d mA\n",
+ val.intval / 1000);
+
+ val.intval = 0;
+ dev_dbg(dev, "disabling vbus_in power path\n");
+ ret = power_supply_set_property(anx7688->vbus_in_supply,
+ POWER_SUPPLY_PROP_ONLINE,
+ &val);
+ if (ret)
+ dev_err(dev, "failed to offline vbus_in\n");
+
+ dev_dbg(dev, "enabling USB BC 1.2 detection\n");
+
+ clear_bit(ANX7688_F_CONNECTED, anx7688->flags);
+}
+
+static void anx7688_handle_cable_change(struct anx7688 *anx7688)
+{
+ int cabledet;
+ bool connected;
+
+ connected = test_bit(ANX7688_F_CONNECTED, anx7688->flags);
+ cabledet = gpiod_get_value(anx7688->gpio_cabledet);
+
+ if (cabledet && !connected)
+ anx7688_connect(anx7688);
+ else if (!cabledet && connected)
+ anx7688_disconnect(anx7688);
+}
+
+static irqreturn_t anx7688_irq_plug_handler(int irq, void *data)
+{
+ struct anx7688 *anx7688 = data;
+
+ dev_dbg(anx7688->dev, "plug irq (cd=%d)\n",
+ gpiod_get_value(anx7688->gpio_cabledet));
+
+ /*
+ * After each cabledet change the scheduled work timer is reset
+ * to fire in ~10ms. So the work is done only after the cabledet
+ * is stable for ~10ms.
+ */
+ schedule_delayed_work(&anx7688->work, msecs_to_jiffies(10));
+
+ return IRQ_HANDLED;
+}
+
+enum {
+ CMD_SUCCESS,
+ CMD_REJECT,
+ CMD_FAIL,
+ CMD_BUSY,
+};
+
+static const char * const anx7688_cmd_statuses[] = {
+ "SUCCESS",
+ "REJECT",
+ "FAIL",
+ "BUSY",
+};
+
+static int anx7688_handle_pd_message_response(struct anx7688 *anx7688,
+ u8 to_cmd, u8 resp)
+{
+ const char *status = resp <= CMD_BUSY ? anx7688_cmd_statuses[resp] : "UNKNOWN";
+
+ switch (to_cmd) {
+ case ANX7688_OCM_MSG_PSWAP_REQ:
+ dev_info(anx7688->dev, "received response to PSWAP_REQ (%s)\n", status);
+ break;
+
+ case ANX7688_OCM_MSG_DSWAP_REQ:
+ dev_info(anx7688->dev, "received response to DSWAP_REQ (%s)\n", status);
+ break;
+
+ case ANX7688_OCM_MSG_VCONN_SWAP_REQ:
+ dev_info(anx7688->dev, "received response to VCONN_SWAP_REQ (%s)\n", status);
+ break;
+
+ case ANX7688_OCM_MSG_PWR_OBJ_REQ:
+ dev_info(anx7688->dev, "received response to PWR_OBJ_REQ (%s)\n", status);
+ break;
+
+ case ANX7688_OCM_MSG_VDM:
+ dev_info(anx7688->dev, "received response to VDM (%s)\n", status);
+ break;
+
+ case ANX7688_OCM_MSG_GOTO_MIN_REQ:
+ dev_info(anx7688->dev, "received response to GOTO_MIN_REQ (%s)\n", status);
+ break;
+
+ case ANX7688_OCM_MSG_GET_SNK_CAP:
+ dev_info(anx7688->dev, "received response to GET_SNK_CAP (%s)\n", status);
+ break;
+
+ default:
+ dev_info(anx7688->dev, "received response to unknown request (%s)\n", status);
+ break;
+ }
+
+ return 0;
+}
+
+static int anx7688_handle_pd_message(struct anx7688 *anx7688,
+ u8 cmd, u8 *msg, unsigned int len)
+{
+ struct device *dev = anx7688->dev;
+ union power_supply_propval psy_val = {0,};
+ uint32_t *pdos = (uint32_t *)msg;
+ int ret, i, rdo_max_v, rdo_max_p;
+ uint32_t pdo, rdo;
+
+ switch (cmd) {
+ case ANX7688_OCM_MSG_PWR_SRC_CAP:
+ dev_info(anx7688->dev, "received SRC_CAP\n");
+
+ if (len % 4 != 0) {
+ dev_warn(anx7688->dev, "received invalid sized PDO array\n");
+ break;
+ }
+
+ /* the partner is PD capable */
+ anx7688->pd_capable = true;
+
+ for (i = 0; i < len / 4; i++) {
+ pdo = le32_to_cpu(pdos[i]);
+
+ if (pdo_type(pdo) == PDO_TYPE_FIXED) {
+ unsigned int voltage = pdo_fixed_voltage(pdo);
+ unsigned int max_curr = pdo_max_current(pdo);
+
+ dev_info(anx7688->dev, "SRC_CAP PDO_FIXED (%umV %umA)\n", voltage, max_curr);
+ } else if (pdo_type(pdo) == PDO_TYPE_BATT) {
+ unsigned int min_volt = pdo_min_voltage(pdo);
+ unsigned int max_volt = pdo_max_voltage(pdo);
+ unsigned int max_pow = pdo_max_power(pdo);
+
+ dev_info(anx7688->dev, "SRC_CAP PDO_BATT (%umV-%umV %umW)\n", min_volt, max_volt, max_pow);
+ } else if (pdo_type(pdo) == PDO_TYPE_VAR) {
+ unsigned int min_volt = pdo_min_voltage(pdo);
+ unsigned int max_volt = pdo_max_voltage(pdo);
+ unsigned int max_curr = pdo_max_current(pdo);
+
+ dev_info(anx7688->dev, "SRC_CAP PDO_VAR (%umV-%umV %umA)\n", min_volt, max_volt, max_curr);
+ } else {
+ dev_info(anx7688->dev, "SRC_CAP PDO_APDO (0x%08X)\n", pdo);
+ }
+ }
+
+ /* when auto_pd mode is enabled, the FW has already set
+ * RDO_MAX_VOLTAGE and RDO_MAX_POWER for the RDO it sent to the
+ * partner based on the received SOURCE_CAPs. This does not
+ * mean, the request was acked, but we can't do better here than
+ * calculate the current_limit to set later and hope for the best.
+ */
+ rdo_max_v = anx7688_reg_read(anx7688, ANX7688_REG_MAX_VOLTAGE_STATUS);
+ if (rdo_max_v < 0)
+ return rdo_max_v;
+ if (rdo_max_v == 0)
+ return -EINVAL;
+
+ rdo_max_p = anx7688_reg_read(anx7688, ANX7688_REG_MAX_POWER_STATUS);
+ if (rdo_max_p < 0)
+ return rdo_max_p;
+
+ anx7688->pd_current_limit = rdo_max_p * 5000 / rdo_max_v;
+
+ dev_dbg(anx7688->dev, "RDO max voltage = %dmV, max power = %dmW, PD current limit = %dmA\n",
+ rdo_max_v * 100, rdo_max_p * 500, anx7688->pd_current_limit);
+
+ // update current limit sooner, now that we have PD negotiation result
+ anx7688->current_update_deadline = ktime_add_ms(ktime_get(), 500);
+ break;
+
+ case ANX7688_OCM_MSG_PWR_SNK_CAP:
+ dev_info(anx7688->dev, "received SNK_CAP\n");
+
+ if (len % 4 != 0) {
+ dev_warn(anx7688->dev, "received invalid sized PDO array\n");
+ break;
+ }
+
+ for (i = 0; i < len / 4; i++) {
+ pdo = le32_to_cpu(pdos[i]);
+
+ if (pdo_type(pdo) == PDO_TYPE_FIXED) {
+ unsigned int voltage = pdo_fixed_voltage(pdo);
+ unsigned int max_curr = pdo_max_current(pdo);
+
+ dev_info(anx7688->dev, "SNK_CAP PDO_FIXED (%umV %umA)\n", voltage, max_curr);
+ } else if (pdo_type(pdo) == PDO_TYPE_BATT) {
+ unsigned int min_volt = pdo_min_voltage(pdo);
+ unsigned int max_volt = pdo_max_voltage(pdo);
+ unsigned int max_pow = pdo_max_power(pdo);
+
+ dev_info(anx7688->dev, "SNK_CAP PDO_BATT (%umV-%umV %umW)\n", min_volt, max_volt, max_pow);
+ } else if (pdo_type(pdo) == PDO_TYPE_VAR) {
+ unsigned int min_volt = pdo_min_voltage(pdo);
+ unsigned int max_volt = pdo_max_voltage(pdo);
+ unsigned int max_curr = pdo_max_current(pdo);
+
+ dev_info(anx7688->dev, "SNK_CAP PDO_VAR (%umV-%umV %umA)\n", min_volt, max_volt, max_curr);
+ } else {
+ dev_info(anx7688->dev, "SNK_CAP PDO_APDO (0x%08X)\n", pdo);
+ }
+ }
+
+ break;
+
+ case ANX7688_OCM_MSG_PWR_OBJ_REQ:
+ dev_info(anx7688->dev, "received PWR_OBJ_REQ\n");
+
+ anx7688->pd_capable = true;
+
+ if (len != 4) {
+ dev_warn(anx7688->dev, "received invalid sized RDO\n");
+ break;
+ }
+
+ rdo = le32_to_cpu(pdos[0]);
+
+ if (rdo_index(rdo) >= 1 && rdo_index(rdo) <= anx7688->n_src_caps) {
+ unsigned int rdo_op_curr = rdo_op_current(rdo);
+ unsigned int rdo_max_curr = rdo_max_current(rdo);
+ unsigned int rdo_idx = rdo_index(rdo) - 1;
+ unsigned int pdo_volt, pdo_max_curr;
+
+ pdo = anx7688->src_caps[rdo_idx];
+ pdo_volt = pdo_fixed_voltage(pdo);
+ pdo_max_curr = pdo_max_current(pdo);
+
+ dev_info(anx7688->dev, "RDO (idx=%d op=%umA max=%umA)\n",
+ rdo_idx, rdo_op_curr, rdo_max_curr);
+
+ dev_info(anx7688->dev, "PDO_FIXED (%umV %umA)\n",
+ pdo_volt, pdo_max_curr);
+
+ // We could check the req and respond with accept/reject
+ // but we're using auto_pd feature, so the FW will do
+ // this for us
+ } else {
+ dev_info(anx7688->dev, "PWR_OBJ RDO index out of range (RDO = 0x%08X)\n", rdo);
+ }
+
+ break;
+
+ case ANX7688_OCM_MSG_ACCEPT:
+ dev_info(anx7688->dev, "received ACCEPT\n");
+ break;
+
+ case ANX7688_OCM_MSG_REJECT:
+ dev_info(anx7688->dev, "received REJECT\n");
+ break;
+
+ case ANX7688_OCM_MSG_RESPONSE_TO_REQ:
+ if (len < 2) {
+ dev_warn(anx7688->dev, "received short RESPONSE_TO_REQ\n");
+ break;
+ }
+
+ anx7688_handle_pd_message_response(anx7688, msg[0], msg[1]);
+ break;
+
+ case ANX7688_OCM_MSG_SOFT_RST:
+ dev_info(anx7688->dev, "received SOFT_RST\n");
+ break;
+
+ case ANX7688_OCM_MSG_HARD_RST:
+ if (anx7688->pd_capable) {
+ dev_info(anx7688->dev, "received HARD_RST\n");
+
+ // stop drawing power from VBUS
+ psy_val.intval = 0;
+ dev_dbg(dev, "disabling vbus_in power path\n");
+ ret = power_supply_set_property(anx7688->vbus_in_supply,
+ POWER_SUPPLY_PROP_ONLINE,
+ &psy_val);
+ if (ret)
+ dev_err(anx7688->dev, "failed to offline vbus_in\n");
+
+ // wait till the dust settles
+ anx7688->current_update_deadline = ktime_add_ms(ktime_get(), 3000);
+ } else {
+ dev_dbg(anx7688->dev, "received HARD_RST, idiot firmware is bored\n");
+ }
+
+ break;
+
+ case ANX7688_OCM_MSG_RESTART:
+ dev_info(anx7688->dev, "received RESTART\n");
+ break;
+
+ case ANX7688_OCM_MSG_PSWAP_REQ:
+ dev_info(anx7688->dev, "received PSWAP_REQ\n");
+ break;
+
+ case ANX7688_OCM_MSG_DSWAP_REQ:
+ dev_info(anx7688->dev, "received DSWAP_REQ\n");
+ break;
+
+ case ANX7688_OCM_MSG_VCONN_SWAP_REQ:
+ dev_info(anx7688->dev, "received VCONN_SWAP_REQ\n");
+ break;
+
+ case ANX7688_OCM_MSG_DP_ALT_ENTER:
+ dev_info(anx7688->dev, "received DP_ALT_ENTER\n");
+ break;
+
+ case ANX7688_OCM_MSG_DP_ALT_EXIT:
+ dev_info(anx7688->dev, "received DP_ALT_EXIT\n");
+ break;
+
+ case ANX7688_OCM_MSG_DP_SNK_IDENTITY:
+ dev_info(anx7688->dev, "received DP_SNK_IDENTITY\n");
+ break;
+
+ case ANX7688_OCM_MSG_SVID:
+ dev_info(anx7688->dev, "received SVID\n");
+ break;
+
+ case ANX7688_OCM_MSG_VDM:
+ dev_info(anx7688->dev, "received VDM\n");
+ break;
+
+ case ANX7688_OCM_MSG_GOTO_MIN_REQ:
+ dev_info(anx7688->dev, "received GOTO_MIN_REQ\n");
+ break;
+
+ case ANX7688_OCM_MSG_PD_STATUS_REQ:
+ dev_info(anx7688->dev, "received PD_STATUS_REQ\n");
+ break;
+
+ case ANX7688_OCM_MSG_GET_DP_SNK_CAP:
+ dev_info(anx7688->dev, "received GET_DP_SNK_CAP\n");
+ break;
+
+ case ANX7688_OCM_MSG_DP_SNK_CFG:
+ dev_info(anx7688->dev, "received DP_SNK_CFG\n");
+ break;
+
+ default:
+ dev_info(anx7688->dev, "received unknown message 0x%02x\n", cmd);
+ break;
+ }
+
+ return 0;
+}
+
+static int anx7688_receive_msg(struct anx7688 *anx7688)
+{
+ u8 pkt[32], checksum = 0;
+ int i, ret;
+
+ ret = i2c_smbus_read_i2c_block_data(anx7688->client_tcpc,
+ ANX7688_TCPC_REG_INTERFACE_RECV,
+ 32, pkt);
+ if (ret < 0) {
+ dev_err(anx7688->dev, "failed to read pd msg\n");
+ return ret;
+ }
+
+ ret = anx7688_tcpc_reg_write(anx7688, ANX7688_TCPC_REG_INTERFACE_RECV, 0);
+ if (ret)
+ dev_warn(anx7688->dev, "failed to clear recv FIFO\n");
+
+ if (pkt[0] == 0 || pkt[0] > sizeof(pkt) - 2) {
+ dev_err(anx7688->dev, "received invalid pd message: %*ph\n",
+ (int)sizeof(pkt), pkt);
+ return -EINVAL;
+ }
+
+ dev_dbg(anx7688->dev, "recv ocm message cmd=0x%02x %*ph\n",
+ pkt[1], pkt[0] + 2, pkt);
+
+ for (i = 0; i < pkt[0] + 2; i++)
+ checksum += pkt[i];
+
+ if (checksum != 0) {
+ dev_err(anx7688->dev, "bad checksum on received message\n");
+ return -EINVAL;
+ }
+
+ anx7688_handle_pd_message(anx7688, pkt[1], pkt + 2, pkt[0] - 1);
+ return 0;
+}
+
+static const char *anx7688_cc_status_string(unsigned int v)
+{
+ switch (v) {
+ case 0: return "SRC.Open";
+ case 1: return "SRC.Rd";
+ case 2: return "SRC.Ra";
+ case 4: return "SNK.Default";
+ case 8: return "SNK.Power1.5";
+ case 12: return "SNK.Power3.0";
+ default: return "UNK";
+ }
+}
+
+static int anx7688_update_status(struct anx7688 *anx7688)
+{
+ struct device *dev = anx7688->dev;
+ bool vbus_on, vconn_on, dr_dfp;
+ int status, cc_status, dp_state, dp_substate, ret;
+
+ status = anx7688_reg_read(anx7688, ANX7688_REG_STATUS);
+ if (status < 0)
+ return status;
+
+ cc_status = anx7688_reg_read(anx7688, ANX7688_REG_CC_STATUS);
+ if (cc_status < 0)
+ return cc_status;
+
+ dp_state = anx7688_tcpc_reg_read(anx7688, 0x87);
+ if (dp_state < 0)
+ return dp_state;
+
+ dp_substate = anx7688_tcpc_reg_read(anx7688, 0x88);
+ if (dp_substate < 0)
+ return dp_substate;
+
+ anx7688_set_hdmi_hpd(anx7688, dp_state >= 3);
+
+ dp_state = (dp_state << 8) | dp_substate;
+
+ if (anx7688->last_status == -1 || anx7688->last_status != status) {
+ anx7688->last_status = status;
+ dev_dbg(dev, "status changed to 0x%02x\n", status);
+ }
+
+ if (anx7688->last_cc_status == -1 || anx7688->last_cc_status != cc_status) {
+ anx7688->last_cc_status = cc_status;
+ dev_dbg(dev, "cc_status changed to CC1 = %s CC2 = %s\n",
+ anx7688_cc_status_string(cc_status & 0xf),
+ anx7688_cc_status_string((cc_status >> 4) & 0xf));
+ }
+
+ if (anx7688->last_dp_state == -1 || anx7688->last_dp_state != dp_state) {
+ anx7688->last_dp_state = dp_state;
+ dev_dbg(dev, "DP state changed to 0x%04x\n", dp_state);
+ }
+
+ vbus_on = !!(status & ANX7688_VBUS_STATUS);
+ vconn_on = !!(status & ANX7688_VCONN_STATUS);
+ dr_dfp = !!(status & ANX7688_DATA_ROLE_STATUS);
+
+ if (anx7688->vbus_on != vbus_on) {
+ dev_dbg(anx7688->dev, "POWER role change to %s\n",
+ vbus_on ? "SOURCE" : "SINK");
+
+ if (vbus_on) {
+ ret = regulator_enable(anx7688->supplies[ANX7688_VBUS_INDEX].consumer);
+ if (ret) {
+ dev_err(anx7688->dev, "failed to enable vbus\n");
+ return ret;
+ }
+ } else {
+ ret = regulator_disable(anx7688->supplies[ANX7688_VBUS_INDEX].consumer);
+ if (ret) {
+ dev_err(anx7688->dev, "failed to disable vbus\n");
+ return ret;
+ }
+ }
+
+ anx7688->pwr_role = vbus_on ? TYPEC_SOURCE : TYPEC_SINK;
+ typec_set_pwr_role(anx7688->port, anx7688->pwr_role);
+ anx7688->vbus_on = vbus_on;
+ }
+
+ if (anx7688->vconn_on != vconn_on) {
+ dev_dbg(anx7688->dev, "VCONN role change to %s\n",
+ vconn_on ? "SOURCE" : "SINK");
+
+ if (vconn_on) {
+ ret = regulator_enable(anx7688->supplies[ANX7688_VCONN_INDEX].consumer);
+ if (ret) {
+ dev_err(anx7688->dev, "failed to enable vconn\n");
+ return ret;
+ }
+ } else {
+ ret = regulator_disable(anx7688->supplies[ANX7688_VCONN_INDEX].consumer);
+ if (ret) {
+ dev_err(anx7688->dev, "failed to disable vconn\n");
+ return ret;
+ }
+ }
+
+ typec_set_vconn_role(anx7688->port, vconn_on ? TYPEC_SOURCE : TYPEC_SINK);
+ anx7688->vconn_on = vconn_on;
+ }
+
+ anx7688->data_role = dr_dfp ? TYPEC_HOST : TYPEC_DEVICE;
+ typec_set_data_role(anx7688->port, anx7688->data_role);
+
+ if (usb_role_switch_get_role(anx7688->role_sw) !=
+ (dr_dfp ? USB_ROLE_HOST : USB_ROLE_DEVICE)) {
+ dev_dbg(anx7688->dev, "DATA role change requested to %s\n",
+ dr_dfp ? "DFP" : "UFP");
+
+ ret = usb_role_switch_set_role(anx7688->role_sw,
+ dr_dfp ? USB_ROLE_HOST : USB_ROLE_DEVICE);
+ if (ret)
+ return ret;
+ }
+
+ return 0;
+}
+
+static irqreturn_t anx7688_irq_status_handler(int irq, void *data)
+{
+ struct anx7688 *anx7688 = data;
+ struct device *dev = anx7688->dev;
+ int tcpc_status, ext2_status, soft_status;
+
+ mutex_lock(&anx7688->lock);
+
+ if (!test_bit(ANX7688_F_CONNECTED, anx7688->flags)) {
+ dev_dbg(dev, "spurious status irq\n");
+ /*
+ * anx chip should be disabled and power off, nothing
+ * more to do
+ */
+ goto out_unlock;
+ }
+
+ // clear tcpc interrupt
+ tcpc_status = anx7688_tcpc_reg_read(anx7688, ANX7688_TCPC_REG_ALERT0);
+ if (tcpc_status > 0)
+ anx7688_tcpc_reg_write(anx7688, ANX7688_TCPC_REG_ALERT0, tcpc_status);
+
+ ext2_status = anx7688_reg_read(anx7688, ANX7688_REG_IRQ_EXT_SOURCE2);
+ if (ext2_status & ANX7688_IRQ2_SOFT_INT) {
+ soft_status = anx7688_reg_read(anx7688, ANX7688_REG_STATUS_INT);
+ anx7688_reg_write(anx7688, ANX7688_REG_STATUS_INT, 0);
+
+ if (soft_status > 0) {
+ soft_status &= ANX7688_SOFT_INT_MASK;
+
+ if (soft_status & ANX7688_IRQS_RECEIVED_MSG)
+ anx7688_receive_msg(anx7688);
+
+ if (soft_status & (ANX7688_IRQS_CC_STATUS_CHANGE |
+ ANX7688_IRQS_VBUS_CHANGE |
+ ANX7688_IRQS_VCONN_CHANGE |
+ ANX7688_IRQS_DATA_ROLE_CHANGE)) {
+ anx7688_update_status(anx7688);
+ }
+ }
+
+ anx7688_reg_write(anx7688, ANX7688_REG_IRQ_EXT_SOURCE2, ANX7688_IRQ2_SOFT_INT);
+ }
+
+out_unlock:
+ mutex_unlock(&anx7688->lock);
+
+ return IRQ_HANDLED;
+}
+
+static int anx7688_dr_set(struct typec_port *port, enum typec_data_role role)
+{
+ struct anx7688 *anx7688 = typec_get_drvdata(port);
+ int ret = 0;
+
+ dev_info(anx7688->dev, "data role set %d\n", role);
+
+ if (anx7688->data_role != role) {
+ mutex_lock(&anx7688->lock);
+ ret = anx7688_send_ocm_message(anx7688, ANX7688_OCM_MSG_DSWAP_REQ, 0, 0);
+ mutex_unlock(&anx7688->lock);
+ }
+
+ return ret;
+}
+
+static int anx7688_pr_set(struct typec_port *port, enum typec_role role)
+{
+ struct anx7688 *anx7688 = typec_get_drvdata(port);
+ int ret = 0;
+
+ dev_info(anx7688->dev, "power role set %d\n", role);
+
+ if (anx7688->pwr_role != role) {
+ mutex_lock(&anx7688->lock);
+ ret = anx7688_send_ocm_message(anx7688, ANX7688_OCM_MSG_PSWAP_REQ, 0, 0);
+ mutex_unlock(&anx7688->lock);
+ }
+
+ return ret;
+}
+
+/*
+ * Calls to the EEPROM functions need to be taken under the anx7688 lock.
+ */
+static int anx7688_eeprom_set_address(struct anx7688 *anx7688, u16 addr)
+{
+ int ret;
+
+ ret = anx7688_reg_write(anx7688, 0xe0, (addr >> 8) & 0xff);
+ if (ret < 0)
+ return ret;
+
+ return anx7688_reg_write(anx7688, 0xe1, addr & 0xff);
+}
+
+static int anx7688_eeprom_wait_done(struct anx7688 *anx7688)
+{
+ ktime_t timeout;
+ int ret;
+
+ // wait for read to be done
+ timeout = ktime_add_us(ktime_get(), 50000);
+ while (true) {
+ ret = anx7688_reg_read(anx7688, 0xe2);
+ if (ret < 0)
+ return ret;
+
+ if (ret & BIT(3))
+ return 0;
+
+ if (ktime_after(ktime_get(), timeout)) {
+ dev_err(anx7688->dev, "timeout waiting for eeprom\n");
+ return -ETIMEDOUT;
+ }
+ }
+}
+
+/* wait for internal FSM of EEPROM to be in a state ready for
+ * programming/reading
+ */
+static int anx7688_eeprom_wait_ready(struct anx7688 *anx7688)
+{
+ ktime_t timeout;
+ int ret;
+
+ // wait until eeprom is ready
+ timeout = ktime_add_us(ktime_get(), 1000000);
+ while (true) {
+ ret = anx7688_reg_read(anx7688, 0x7f);
+ if (ret < 0)
+ return ret;
+
+ if ((ret & 0x0f) == 7)
+ return 0;
+
+ if (ktime_after(ktime_get(), timeout)) {
+ dev_err(anx7688->dev, "timeout waiting for eeprom to initialize\n");
+ return -ETIMEDOUT;
+ }
+
+ msleep(5);
+ }
+}
+
+static int anx7688_eeprom_read(struct anx7688 *anx7688, unsigned int addr, u8 buf[16])
+{
+ int ret;
+
+ ret = anx7688_eeprom_set_address(anx7688, addr);
+ if (ret)
+ return ret;
+
+ // initiate read
+ ret = anx7688_reg_write(anx7688, 0xe2, 0x06);
+ if (ret < 0)
+ return ret;
+
+ ret = anx7688_eeprom_wait_done(anx7688);
+ if (ret)
+ return ret;
+
+ ret = i2c_smbus_read_i2c_block_data(anx7688->client, 0xd0, 16, buf);
+ if (ret < 0) {
+ dev_err(anx7688->dev,
+ "failed to read eeprom data (err=%d)\n", ret);
+ return ret;
+ }
+
+ return 0;
+}
+
+static const struct typec_operations anx7688_typec_ops = {
+ .dr_set = anx7688_dr_set,
+ .pr_set = anx7688_pr_set,
+};
+
+/*
+ * This function has to work when the ANX7688 is active, and when
+ * it is powered down. It power cycles the chip and asserts the OCM
+ * reset, to prevent OCM FW interfering with EEPROM reading.
+ *
+ * After reading EEPROM, the reconnection is scheduled.
+ */
+static int anx7688_firmware_show(struct seq_file *s, void *data)
+{
+ struct anx7688 *anx7688 = s->private;
+ unsigned int addr;
+ u8 buf[16];
+ int ret;
+
+ mutex_lock(&anx7688->lock);
+
+ if (test_bit(ANX7688_F_CONNECTED, anx7688->flags))
+ anx7688_disconnect(anx7688);
+
+ msleep(20);
+
+ anx7688_power_enable(anx7688);
+
+ ret = anx7688_reg_update_bits(anx7688, ANX7688_REG_USBC_RESET_CTRL,
+ ANX7688_USBC_RESET_CTRL_OCM_RESET,
+ ANX7688_USBC_RESET_CTRL_OCM_RESET);
+ if (ret < 0)
+ goto out_powerdown;
+
+ ret = anx7688_eeprom_wait_ready(anx7688);
+ if (ret)
+ goto out_powerdown;
+
+ msleep(10);
+
+ for (addr = 0x10; addr < 0x10000; addr += 16) {
+ // set address
+ ret = anx7688_eeprom_read(anx7688, addr, buf);
+ if (ret < 0)
+ goto out_powerdown;
+
+ seq_write(s, buf, sizeof(buf));
+ }
+
+out_powerdown:
+ anx7688_power_disable(anx7688);
+ schedule_delayed_work(&anx7688->work, 0);
+ mutex_unlock(&anx7688->lock);
+
+ return ret;
+}
+DEFINE_SHOW_ATTRIBUTE(anx7688_firmware);
+
+static int anx7688_regs_show(struct seq_file *s, void *data)
+{
+ struct anx7688 *anx7688 = s->private;
+ u8 buf[16];
+ unsigned int i, addr;
+ int ret = -ENODEV;
+
+ mutex_lock(&anx7688->lock);
+
+ if (!test_bit(ANX7688_F_POWERED, anx7688->flags))
+ goto out_unlock;
+
+ for (addr = 0; addr < 256; addr += 16) {
+ ret = i2c_smbus_read_i2c_block_data(anx7688->client, addr,
+ sizeof(buf), buf);
+ if (ret < 0) {
+ dev_err(anx7688->dev,
+ "failed to read registers (err=%d)\n", ret);
+ goto out_unlock;
+ }
+
+ for (i = 0; i < 16; i++)
+ seq_printf(s, "50%02x: %02x\n", addr + i, buf[i]);
+ }
+
+ for (addr = 0; addr < 256; addr += 16) {
+ ret = i2c_smbus_read_i2c_block_data(anx7688->client_tcpc, addr,
+ sizeof(buf), buf);
+ if (ret < 0) {
+ dev_err(anx7688->dev,
+ "failed to read registers (err=%d)\n", ret);
+ goto out_unlock;
+ }
+
+ for (i = 0; i < 16; i++)
+ seq_printf(s, "58%02x: %02x\n", addr + i, buf[i]);
+ }
+
+out_unlock:
+ mutex_unlock(&anx7688->lock);
+
+ return ret;
+}
+DEFINE_SHOW_ATTRIBUTE(anx7688_regs);
+
+static int anx7688_status_show(struct seq_file *s, void *data)
+{
+ struct anx7688 *anx7688 = s->private;
+
+ mutex_lock(&anx7688->lock);
+
+ seq_puts(s, "not much\n");
+
+ mutex_unlock(&anx7688->lock);
+
+ return 0;
+}
+DEFINE_SHOW_ATTRIBUTE(anx7688_status);
+
+/*
+ * This is just a 1s watchdog checking the state if cabledet pin.
+ */
+static void anx7688_cabledet_timer_fn(struct timer_list *t)
+{
+ struct anx7688 *anx7688 = from_timer(anx7688, t, work_timer);
+
+ schedule_delayed_work(&anx7688->work, 0);
+ mod_timer(t, jiffies + msecs_to_jiffies(1000));
+}
+
+static void anx7688_handle_vbus_in_notify(struct anx7688 *anx7688)
+{
+ union power_supply_propval psy_val = {0,};
+ struct device *dev = anx7688->dev;
+ int ret;
+
+ ret = power_supply_get_property(anx7688->vbus_in_supply,
+ POWER_SUPPLY_PROP_USB_TYPE,
+ &psy_val);
+ if (ret) {
+ dev_err(dev, "failed to get USB BC1.2 result\n");
+ return;
+ }
+
+ if (anx7688->last_bc_result == psy_val.intval)
+ return;
+
+ anx7688->last_bc_result = psy_val.intval;
+
+ switch (psy_val.intval) {
+ case POWER_SUPPLY_USB_TYPE_DCP:
+ case POWER_SUPPLY_USB_TYPE_CDP:
+ dev_dbg(dev, "BC 1.2 result: DCP or CDP\n");
+ break;
+ case POWER_SUPPLY_USB_TYPE_SDP:
+ default:
+ dev_dbg(dev, "BC 1.2 result: SDP\n");
+ break;
+ }
+}
+
+static int anx7688_cc_status(unsigned int v)
+{
+ switch (v) {
+ case 0: return -1;
+ case 1: return -1;
+ case 2: return -1;
+ case 4: return TYPEC_PWR_MODE_USB;
+ case 8: return TYPEC_PWR_MODE_1_5A;
+ case 12: return TYPEC_PWR_MODE_3_0A;
+ default: return -1;
+ }
+}
+
+static const char *anx7688_get_power_mode_name(enum typec_pwr_opmode mode)
+{
+ switch (mode) {
+ case TYPEC_PWR_MODE_USB: return "USB";
+ case TYPEC_PWR_MODE_1_5A: return "1.5A";
+ case TYPEC_PWR_MODE_3_0A: return "3.0A";
+ case TYPEC_PWR_MODE_PD: return "PD";
+ default: return "Unknown";
+ }
+}
+
+/*
+ * This is called after 500ms after connection when the PD contract should have
+ * been negotiated. We should inspect CC pins or PD status here and decide what
+ * input current limit to set.
+ */
+static void anx7688_handle_current_update(struct anx7688 *anx7688)
+{
+ unsigned int cc_status = anx7688->last_cc_status;
+ union power_supply_propval val = {0,};
+ struct device *dev = anx7688->dev;
+ int pwr_mode, ret, current_limit = 0;
+
+ if (anx7688->pd_capable) {
+ pwr_mode = TYPEC_PWR_MODE_PD;
+ } else if (cc_status < 0) {
+ pwr_mode = TYPEC_PWR_MODE_USB;
+ } else {
+ pwr_mode = anx7688_cc_status(cc_status & 0xf);
+ if (pwr_mode < 0)
+ pwr_mode = anx7688_cc_status((cc_status >> 4) & 0xf);
+ if (pwr_mode < 0)
+ pwr_mode = TYPEC_PWR_MODE_USB;
+ }
+
+ if (pwr_mode == TYPEC_PWR_MODE_1_5A)
+ current_limit = 1500;
+ else if (pwr_mode == TYPEC_PWR_MODE_3_0A)
+ current_limit = 3000;
+ else if (pwr_mode == TYPEC_PWR_MODE_PD)
+ current_limit = anx7688->pd_current_limit;
+
+ anx7688->input_current_limit = current_limit;
+
+ dev_info(anx7688->dev, "updating power mode to %s, current limit %dmA (0 => BC1.2)\n",
+ anx7688_get_power_mode_name(pwr_mode), current_limit);
+
+ if (current_limit) {
+ /*
+ * Disable BC1.2 detection, because we'll be setting
+ * a current limit determined by USB-PD
+ */
+ dev_dbg(dev, "disabling USB BC 1.2 detection\n");
+
+ val.intval = current_limit * 1000;
+ dev_dbg(dev, "setting vbus_in current limit to %d mA\n", current_limit);
+ ret = power_supply_set_property(anx7688->vbus_in_supply,
+ POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
+ &val);
+ if (ret)
+ dev_err(dev, "failed to set vbus_in current to %d mA\n",
+ current_limit);
+ }
+ /*
+ * else use the result of BC1.2 detection performed by PMIC.
+ */
+
+ /* Turn on VBUS power path inside PMIC. */
+ val.intval = 1;
+ dev_dbg(dev, "enabling vbus_in power path\n");
+ ret = power_supply_set_property(anx7688->vbus_in_supply,
+ POWER_SUPPLY_PROP_ONLINE,
+ &val);
+ if (ret)
+ dev_err(anx7688->dev, "failed to enable vbus_in\n");
+
+ typec_set_pwr_opmode(anx7688->port, pwr_mode);
+}
+
+static int anx7688_vbus_in_notify(struct notifier_block *nb,
+ unsigned long val, void *v)
+{
+ struct anx7688 *anx7688 = container_of(nb, struct anx7688, vbus_in_nb);
+ struct power_supply *psy = v;
+
+ /* atomic context */
+ if (val == PSY_EVENT_PROP_CHANGED && psy == anx7688->vbus_in_supply) {
+ set_bit(ANX7688_F_PWRSUPPLY_CHANGE, anx7688->flags);
+ schedule_delayed_work(&anx7688->work, 0);
+ }
+
+ return NOTIFY_OK;
+}
+
+static void anx7688_work(struct work_struct *work)
+{
+ struct anx7688 *anx7688 = container_of(work, struct anx7688, work.work);
+
+ if (test_bit(ANX7688_F_FW_FAILED, anx7688->flags))
+ return;
+
+ mutex_lock(&anx7688->lock);
+
+ if (test_and_clear_bit(ANX7688_F_PWRSUPPLY_CHANGE, anx7688->flags))
+ anx7688_handle_vbus_in_notify(anx7688);
+
+ anx7688_handle_cable_change(anx7688);
+
+ if (test_bit(ANX7688_F_CONNECTED, anx7688->flags)) {
+ /*
+ * We check status periodically outside of interrupt, just to
+ * be sure we didn't miss any status interrupts
+ */
+ anx7688_update_status(anx7688);
+
+ if (anx7688->current_update_deadline &&
+ ktime_after(ktime_get(), anx7688->current_update_deadline)) {
+ anx7688->current_update_deadline = 0;
+ anx7688_handle_current_update(anx7688);
+ }
+ }
+
+ mutex_unlock(&anx7688->lock);
+}
+
+static int anx7688_parse_connector(struct device *dev, struct anx7688 *anx7688, struct typec_capability *cap)
+{
+ struct fwnode_handle *fwnode;
+ const char *buf;
+ int ret;
+
+ 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)
+ return -EINVAL;
+
+ anx7688->n_src_caps = min_t(u8, ret, ARRAY_SIZE(anx7688->src_caps));
+ ret = fwnode_property_read_u32_array(fwnode, "source-pdos",
+ anx7688->src_caps,
+ anx7688->n_src_caps);
+ if (ret < 0) {
+ dev_err(dev, "source cap validate failed: %d\n", ret);
+ return -EINVAL;
+ }
+
+ ret = fwnode_property_count_u32(fwnode, "sink-pdos");
+ if (ret <= 0)
+ return -EINVAL;
+
+ anx7688->n_snk_caps = min_t(u8, ret, ARRAY_SIZE(anx7688->snk_caps));
+ ret = fwnode_property_read_u32_array(fwnode, "sink-pdos",
+ anx7688->snk_caps,
+ anx7688->n_snk_caps);
+ if (ret < 0) {
+ dev_err(dev, "sink cap validate failed: %d\n", ret);
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+static int anx7688_i2c_probe(struct i2c_client *client)
+{
+ struct anx7688 *anx7688;
+ struct device *dev = &client->dev;
+ struct typec_capability typec_cap = { };
+ int i, vid_h, vid_l;
+ int irq_cabledet;
+ int ret = 0;
+
+ anx7688 = devm_kzalloc(dev, sizeof(*anx7688), GFP_KERNEL);
+ if (!anx7688)
+ return -ENOMEM;
+
+ i2c_set_clientdata(client, anx7688);
+ anx7688->client = client;
+ anx7688->dev = &client->dev;
+ mutex_init(&anx7688->lock);
+ INIT_DELAYED_WORK(&anx7688->work, anx7688_work);
+ anx7688->last_extcon_state = -1;
+
+ ret = anx7688_parse_connector(dev, anx7688, &typec_cap);
+ if (ret < 0) {
+ dev_err(dev, "failed to parse connector from DT\n");
+ return ret;
+ }
+
+ for (i = 0; i < ANX7688_NUM_SUPPLIES; i++)
+ anx7688->supplies[i].supply = anx7688_supply_names[i];
+ ret = devm_regulator_bulk_get(dev, ANX7688_NUM_SUPPLIES,
+ anx7688->supplies);
+ if (ret)
+ return ret;
+
+ anx7688->vbus_in_supply =
+ devm_power_supply_get_by_phandle(dev, "vbus-in-supply");
+ if (IS_ERR(anx7688->vbus_in_supply)) {
+ dev_err(dev, "Couldn't get the VBUS power supply\n");
+ return PTR_ERR(anx7688->vbus_in_supply);
+ }
+
+ if (!anx7688->vbus_in_supply)
+ return -EPROBE_DEFER;
+
+ anx7688->gpio_enable = devm_gpiod_get(dev, "enable", GPIOD_OUT_LOW);
+ if (IS_ERR(anx7688->gpio_enable)) {
+ dev_err(dev, "Could not get enable gpio\n");
+ return PTR_ERR(anx7688->gpio_enable);
+ }
+
+ anx7688->gpio_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
+ if (IS_ERR(anx7688->gpio_reset)) {
+ dev_err(dev, "Could not get reset gpio\n");
+ return PTR_ERR(anx7688->gpio_reset);
+ }
+
+ anx7688->gpio_cabledet = devm_gpiod_get(dev, "cabledet", GPIOD_IN);
+ if (IS_ERR(anx7688->gpio_cabledet)) {
+ dev_err(dev, "Could not get cabledet gpio\n");
+ return PTR_ERR(anx7688->gpio_cabledet);
+ }
+
+ irq_cabledet = gpiod_to_irq(anx7688->gpio_cabledet);
+ if (irq_cabledet < 0) {
+ dev_err(dev, "Could not get cabledet irq\n");
+ return irq_cabledet;
+ }
+
+ // Initialize extcon device
+ anx7688->extcon = devm_extcon_dev_allocate(dev, anx7688_extcon_cable);
+ if (IS_ERR(anx7688->extcon))
+ return -ENOMEM;
+
+ ret = devm_extcon_dev_register(dev, anx7688->extcon);
+ if (ret) {
+ dev_err(dev, "failed to register extcon device\n");
+ return ret;
+ }
+
+ // Register the TCPC i2c interface as second interface (0x58)
+ anx7688->client_tcpc = i2c_new_dummy_device(client->adapter, 0x2c);
+ if (IS_ERR(anx7688->client_tcpc)) {
+ dev_err(dev, "Could not register tcpc i2c client\n");
+ return PTR_ERR(anx7688->client_tcpc);
+ }
+ i2c_set_clientdata(anx7688->client_tcpc, anx7688);
+
+ // powerup and probe the ANX chip
+
+ ret = regulator_bulk_enable(ANX7688_NUM_ALWAYS_ON_SUPPLIES,
+ anx7688->supplies);
+ if (ret) {
+ dev_err(dev, "Could not enable regulators\n");
+ goto err_dummy_dev;
+ }
+
+ msleep(10);
+
+ anx7688_power_enable(anx7688);
+
+ vid_l = anx7688_tcpc_reg_read(anx7688, ANX7688_TCPC_REG_VENDOR_ID0);
+ vid_h = anx7688_tcpc_reg_read(anx7688, ANX7688_TCPC_REG_VENDOR_ID1);
+ if (vid_l < 0 || vid_h < 0) {
+ ret = vid_l < 0 ? vid_l : vid_h;
+ anx7688_power_disable(anx7688);
+ goto err_disable_reg;
+ }
+
+ dev_info(dev, "Vendor id 0x%04x\n", vid_l | vid_h << 8);
+
+ anx7688_power_disable(anx7688);
+
+ anx7688->role_sw = usb_role_switch_get(dev);
+ if (IS_ERR(anx7688->role_sw)) {
+ dev_err(dev, "Could not get role switch\n");
+ ret = PTR_ERR(anx7688->role_sw);
+ goto err_disable_reg;
+ }
+
+ // setup a typec port device
+ typec_cap.revision = USB_TYPEC_REV_1_2;
+ typec_cap.pd_revision = 0x200;
+ ret = -EINVAL;
+ if (typec_cap.type != TYPEC_PORT_DRP)
+ goto err_disable_reg;
+ if (typec_cap.data != TYPEC_PORT_DRD)
+ goto err_disable_reg;
+ typec_cap.driver_data = anx7688;
+ typec_cap.ops = &anx7688_typec_ops;
+
+ anx7688->port = typec_register_port(dev, &typec_cap);
+ if (IS_ERR(anx7688->port)) {
+ dev_err(dev, "Could not register type-c port\n");
+ ret = PTR_ERR(anx7688->port);
+ goto err_role_sw;
+ }
+
+ anx7688->pwr_role = TYPEC_SINK;
+ anx7688->data_role = TYPEC_DEVICE;
+ typec_set_pwr_role(anx7688->port, anx7688->pwr_role);
+ typec_set_data_role(anx7688->port, anx7688->data_role);
+ typec_set_pwr_opmode(anx7688->port, TYPEC_PWR_MODE_USB);
+ typec_set_vconn_role(anx7688->port, TYPEC_SINK);
+
+ // make sure BC1.2 detection in PMIC is enabled
+ anx7688->last_bc_result = -1;
+
+ dev_dbg(dev, "enabling USB BC 1.2 detection\n");
+
+ ret = devm_request_irq(dev, irq_cabledet, anx7688_irq_plug_handler,
+ IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
+ "anx7688-cabledet", anx7688);
+ if (ret < 0) {
+ dev_err(dev, "Could not request cabledet irq (%d)\n", ret);
+ goto err_cport;
+ }
+
+ ret = devm_request_threaded_irq(dev, client->irq,
+ NULL, anx7688_irq_status_handler,
+ IRQF_ONESHOT, NULL, anx7688);
+ if (ret < 0) {
+ dev_err(dev, "Could not request irq (%d)\n", ret);
+ goto err_cport;
+ }
+
+ anx7688->vbus_in_nb.notifier_call = anx7688_vbus_in_notify;
+ anx7688->vbus_in_nb.priority = 0;
+ ret = power_supply_reg_notifier(&anx7688->vbus_in_nb);
+ if (ret)
+ goto err_cport;
+
+ anx7688->debug_root = debugfs_create_dir("anx7688", NULL);
+ debugfs_create_file("firmware", 0444, anx7688->debug_root, anx7688,
+ &anx7688_firmware_fops);
+ debugfs_create_file("regs", 0444, anx7688->debug_root, anx7688,
+ &anx7688_regs_fops);
+ debugfs_create_file("status", 0444, anx7688->debug_root, anx7688,
+ &anx7688_status_fops);
+
+ schedule_delayed_work(&anx7688->work, msecs_to_jiffies(10));
+
+ timer_setup(&anx7688->work_timer, anx7688_cabledet_timer_fn, 0);
+ mod_timer(&anx7688->work_timer, jiffies + msecs_to_jiffies(1000));
+ return 0;
+
+err_cport:
+ typec_unregister_port(anx7688->port);
+err_role_sw:
+ usb_role_switch_put(anx7688->role_sw);
+err_disable_reg:
+ regulator_bulk_disable(ANX7688_NUM_ALWAYS_ON_SUPPLIES, anx7688->supplies);
+err_dummy_dev:
+ i2c_unregister_device(anx7688->client_tcpc);
+ return ret;
+}
+
+static void anx7688_i2c_remove(struct i2c_client *client)
+{
+ struct anx7688 *anx7688 = i2c_get_clientdata(client);
+
+ mutex_lock(&anx7688->lock);
+
+ power_supply_unreg_notifier(&anx7688->vbus_in_nb);
+
+ del_timer_sync(&anx7688->work_timer);
+
+ cancel_delayed_work_sync(&anx7688->work);
+
+ if (test_bit(ANX7688_F_CONNECTED, anx7688->flags))
+ anx7688_disconnect(anx7688);
+
+ typec_unregister_partner(anx7688->partner);
+ typec_unregister_port(anx7688->port);
+ usb_role_switch_put(anx7688->role_sw);
+
+ regulator_bulk_disable(ANX7688_NUM_ALWAYS_ON_SUPPLIES, anx7688->supplies);
+ i2c_unregister_device(anx7688->client_tcpc);
+
+ debugfs_remove(anx7688->debug_root);
+
+ mutex_unlock(&anx7688->lock);
+}
+
+static int __maybe_unused anx7688_suspend(struct device *dev)
+{
+ struct anx7688 *anx7688 = i2c_get_clientdata(to_i2c_client(dev));
+
+ del_timer_sync(&anx7688->work_timer);
+ cancel_delayed_work_sync(&anx7688->work);
+
+ regulator_disable(anx7688->supplies[ANX7688_I2C_INDEX].consumer);
+
+ return 0;
+}
+
+static int __maybe_unused anx7688_resume(struct device *dev)
+{
+ struct anx7688 *anx7688 = i2c_get_clientdata(to_i2c_client(dev));
+ int ret;
+
+ ret = regulator_enable(anx7688->supplies[ANX7688_I2C_INDEX].consumer);
+ if (ret)
+ dev_warn(anx7688->dev,
+ "failed to enable I2C regulator (%d)\n", ret);
+
+ // check status right after resume, since it could have changed during
+ // sleep
+ schedule_delayed_work(&anx7688->work, msecs_to_jiffies(50));
+ mod_timer(&anx7688->work_timer, jiffies + msecs_to_jiffies(1000));
+
+ return 0;
+}
+
+static const struct dev_pm_ops anx7688_pm_ops = {
+ SET_SYSTEM_SLEEP_PM_OPS(anx7688_suspend, anx7688_resume)
+};
+
+static const struct i2c_device_id anx7688_ids[] = {
+ { "anx7688", 0 },
+ { }
+};
+MODULE_DEVICE_TABLE(i2c, anx7688_ids);
+
+static const struct of_device_id anx7688_of_match_table[] = {
+ { .compatible = "analogix,anx7688" },
+ { },
+};
+MODULE_DEVICE_TABLE(of, anx7688_of_match_table);
+
+static struct i2c_driver anx7688_driver = {
+ .driver = {
+ .name = "anx7688",
+ .of_match_table = anx7688_of_match_table,
+ .pm = &anx7688_pm_ops,
+ },
+ .probe = anx7688_i2c_probe,
+ .remove = anx7688_i2c_remove,
+ .id_table = anx7688_ids,
+};
+
+module_i2c_driver(anx7688_driver);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Martijn Braam <martijn@brixit.nl>");
+MODULE_AUTHOR("Ondrej Jirman <megi@xff.cz>");
+MODULE_DESCRIPTION("Analogix ANX7688 USB-C DisplayPort bridge");