ec/ite: Add tach init

Add initial SoC support for boards to configure tachs.

Signed-off-by: Tim Crawford <tcrawford@system76.com>

Author: crawfxrd

src/ec/ite/include/ec/pwm.h

@@ -79,6 +79,17 @@ volatile uint8_t __xdata __at(0x184F) TSWCTLR2;
 volatile uint8_t __xdata __at(0x185A) PWMLCCR;
 #endif
 
+enum TachCh {
+    TACH_CH_0A = 0, // GPD6
+    TACH_CH_1A, // GPD7
+    TACH_CH_0B, // GPJ2
+    TACH_CH_1B, // GPJ3
+    TACH_CH_2A, // GPJ0
+#if CONFIG_EC_ITE_IT5570E || CONFIG_EC_ITE_IT5571E
+    TACH_CH_2B, // GPJ1
+#endif
+};
+
 void pwm_init(void);
 
 #endif // _EC_PWM_H

src/ec/ite/pwm.c

@@ -2,10 +2,59 @@
 
 #include <ec/pwm.h>
 #include <common/macro.h>
+#include <ec/gpio.h>
+
+// TODO: Define per-board
+// All boards use T0A/T1A, so just declare it here for now based on FAN2_PWM
+#ifdef FAN2_PWM
+#define NR_TACHS 2
+#else
+#define NR_TACHS 1
+#endif
+
+const enum TachCh board_tachs[NR_TACHS] = {
+    TACH_CH_0A,
+#ifdef FAN2_PWM
+    TACH_CH_1A,
+#endif
+};
+
+static void pwm_tach_init(void) {
+    for (uint8_t i = 0; i < NR_TACHS; i++) {
+        switch (board_tachs[i]) {
+        case TACH_CH_0A:
+        case TACH_CH_1A:
+            // T0A/T1A always available
+            // CHSEL default is `A` (0) at init.
+            break;
+
+        case TACH_CH_0B:
+            GCR5 |= TACH0BEN;
+            TSWCTLR |= T0CHSEL;
+            break;
+
+        case TACH_CH_1B:
+            GCR5 |= TACH1BEN;
+            TSWCTLR |= T1CHSEL;
+            break;
+
+        case TACH_CH_2A:
+            GCR2 |= TACH2AEN;
+            // CHSEL default is `A` (0) at init.
+            break;
+
+#if CONFIG_EC_ITE_IT5570E || CONFIG_EC_ITE_IT5571E
+        case TACH_CH_2B:
+            GCR15 |= TACH2BEN;
+            TSWCTLR2 |= T2CHSEL;
+            break;
+#endif
+        }
+    }
+}
 
 void pwm_init(void) {
-    // Set T0CHSEL to TACH0A and T1CHSEL to TACH1A
-    TSWCTLR = 0;
+    pwm_tach_init();
 
     // Disable PWM
     ZTIER = 0;