[WIP] app/fan: Add tach init

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

Author: crawfxrd

src/app/main/fan.c

@@ -5,6 +5,7 @@
 #include <common/debug.h>
 #include <common/macro.h>
 #include <drivers/dgpu/dgpu.h>
+#include <ec/gpio.h>
 #include <ec/pwm.h>
 
 #if CONFIG_PLATFORM_INTEL
@@ -299,3 +300,49 @@ enum FanMode fan_get_mode(void) {
 void fan_set_mode(enum FanMode mode) {
     fan_mode = mode;
 }
+
+// TODO: Per-board
+#define NR_TACHS 2
+
+// TODO: Per-board
+enum TachCh board_tachs[NR_TACHS] = {
+    TACH_CH_0A,
+    TACH_CH_1A,
+};
+
+void fan_tach_init(void) {
+    for (uint8_t i = 0; i < NR_TACHS; i++) {
+        // XXX: Should init be responsible for setting GPIO to ALT for TACH function?
+        switch (board_tachs[i]) {
+        case TACH_CH_0B:
+            // GPJ2
+            GCR5 |= TACH0BEN;
+            TSWCTLR |= T0CHSEL;
+            break;
+
+        case TACH_CH_1B:
+            // GPJ3
+            GCR5 |= TACH1BEN;
+            TSWCTLR |= T1CHSEL;
+            break;
+
+        case TACH_CH_2A:
+            // GPJ0
+            GCR2 |= TACH2AEN;
+            // `A` channel is default
+            break;
+
+#if CONFIG_EC_ITE_IT5570E || CONFIG_EC_ITE_IT5571E
+        case TACH_CH_2B:
+            // GPJ1
+            GCR15 |= TACH2BEN;
+            TSWCTLR2 |= T2CHSEL;
+            break;
+#endif
+
+        default:
+            // T0A/T1A always available
+            break;
+        }
+    }
+}

src/app/main/include/app/fan.h

@@ -39,6 +39,7 @@ extern uint8_t fan2_pwm_actual;
 extern uint8_t fan2_pwm_target;
 extern uint16_t fan2_rpm;
 
+void fan_tach_init(void);
 void fan_reset(void);
 void fan_update_duty(void);
 void fan_update_target(void);

src/app/main/main.c

@@ -83,7 +83,10 @@ void init(void) {
     peci_init();
 #endif
     pmc_init();
+
+    fan_tach_init(); // Configure TACHs before enabling PWM
     pwm_init();
+
     smbus_init();
     smfi_init();
     usbpd_init();

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

@@ -79,6 +79,20 @@ volatile uint8_t __xdata __at(0x184F) TSWCTLR2;
 volatile uint8_t __xdata __at(0x185A) PWMLCCR;
 #endif
 
+enum TachCh {
+    // `A` channels are always available.
+    TACH_CH_0A = 0,
+    TACH_CH_1A,
+    // `B` and `2` channels must be configured and enabled.
+    TACH_CH_0B,
+    TACH_CH_1B,
+    TACH_CH_2A,
+#if CONFIG_EC_ITE_IT5570E || CONFIG_EC_ITE_IT5571E
+    TACH_CH_2B,
+#endif
+    NR_TACH_CHS,
+};
+
 void pwm_init(void);
 
 #endif // _EC_PWM_H

src/ec/ite/pwm.c

@@ -4,9 +4,6 @@
 #include <common/macro.h>
 
 void pwm_init(void) {
-    // Set T0CHSEL to TACH0A and T1CHSEL to TACH1A
-    TSWCTLR = 0;
-
     // Disable PWM
     ZTIER = 0;