From c71392fdefb823801cdde6b985092b8485fe3243 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Micha=C5=82=20Kope=C4=87?= <michal.kopec@3mdeb.com>
Date: Thu, 26 Sep 2024 16:01:29 +0200
Subject: [PATCH] common/usbpd/tps65987.c: add basic event handling
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

Signed-off-by: Michał Kopeć <michal.kopec@3mdeb.com>
---
 src/board/system76/common/usbpd/tps65987.c | 39 ++++++++++++++++++++++
 1 file changed, 39 insertions(+)

diff --git a/src/board/system76/common/usbpd/tps65987.c b/src/board/system76/common/usbpd/tps65987.c
index 8b769b254..be8257f0a 100644
--- a/src/board/system76/common/usbpd/tps65987.c
+++ b/src/board/system76/common/usbpd/tps65987.c
@@ -17,9 +17,17 @@
 #define REG_MODE 0x03
 #define REG_CMD1 0x08
 #define REG_DATA1 0x09
+#define REG_INT_EVENT_1 0x14
+#define REG_INT_EVENT_2 0x15
+#define REG_INT_CLEAR_1 0x18
+#define REG_INT_CLEAR_2 0x19
 #define REG_GLOBAL_CONFIG 0x27
 #define REG_ACTIVE_CONTRACT_PDO 0x34
 
+#ifndef HAVE_PD_IRQ
+#define HAVE_PD_IRQ 0
+#endif
+
 enum {
     // PDO is empty
     USBPD_ERR_PDO_ZERO = 0x1000,
@@ -197,6 +205,31 @@ static void usbpd_set_multiport_policy(void) {
     DEBUG("USBPD multiport policy set RES = %ld\n", res);
 }
 
+static void usbpd_clear_event() {
+    int16_t res;
+    uint8_t reg[12] = { 0 };
+
+    DEBUG("USBPD IRQ\n");
+
+    res = i2c_get(&I2C_USBPD, PORT_A_ADDRESS, REG_INT_EVENT_1, reg, sizeof(reg));
+    if (res < 0)
+        return;
+
+    res = i2c_set(&I2C_USBPD, PORT_A_ADDRESS, REG_INT_CLEAR_1, reg, sizeof(reg));
+    if (res < 0)
+        return;
+
+#ifdef USBPD_DUAL_PORT
+    res = i2c_get(&I2C_USBPD, PORT_B_ADDRESS, REG_INT_EVENT_1, reg, sizeof(reg));
+    if (res < 0)
+        return;
+
+    res = i2c_set(&I2C_USBPD, PORT_B_ADDRESS, REG_INT_CLEAR_1, reg, sizeof(reg));
+    if (res < 0)
+        return;
+#endif
+}
+
 void usbpd_event(void) {
     bool update = false;
     int16_t res;
@@ -290,6 +323,12 @@ void usbpd_event(void) {
             power_peci_limit(true);
         }
     }
+
+#if HAVE_PD_IRQ
+    /* For now, all we do is clear all events */
+    if (!gpio_get(&PD_IRQ))
+        usbpd_clear_event();
+#endif
 }
 
 void usbpd_init(void) {