PMBus: implement the READ_FAN_SPEED_n cmds

main_fw/src/i2c_impl.c

@@ -32,6 +32,7 @@ extern uint16_t temps_lin[3];
 extern uint16_t volts_lin[3];
 extern uint16_t currs_lin[3];
 extern uint16_t powrs_lin[3];
+extern uint16_t frpms_lin[3];
 
 extern uint32_t secondary_fw_start;
 
@@ -43,6 +44,9 @@ static cmd_t cmds_cmds[] = (cmd_t[]){
         {0x8D,  2,                       (uint8_t *)&temps_lin[0], (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},
         {0x8E,  2,                       (uint8_t *)&temps_lin[1], (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},
         {0x8F,  2,                       (uint8_t *)&temps_lin[2], (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},
+        {0x90,  2,                       (uint8_t *)&frpms_lin[0], (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},
+        {0x91,  2,                       (uint8_t *)&frpms_lin[1], (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},
+        {0x92,  2,                       (uint8_t *)&frpms_lin[2], (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},
         {0x96,  2,                       (uint8_t *)&curpage_powr, &accpowr, (fp_t)NULL, (fp_t)NULL},
         {0x99, -(int8_t)sizeof(MFR_ID),  (uint8_t *)&MFR_ID,   (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},
         {0x9A, -(int8_t)sizeof(MFR_MDL), (uint8_t *)&MFR_MDL,  (fp_t)NULL, (fp_t)NULL, (fp_t)NULL},

main_fw/src/main.c

@@ -13,6 +13,7 @@ uint16_t temps_lin[3];
 uint16_t volts_lin[3];
 uint16_t currs_lin[3];
 uint16_t powrs_lin[3];
+uint16_t frpms_lin[3];
 
 uint16_t total_pwm_clocks_1 = 1000*PWM_CC;
 uint16_t total_pwm_clocks_2 = 1000*PWM_CC;
@@ -31,13 +32,8 @@ uint16_t goal_pwm_duty1000_3 = FAN_LOW;
 
 uint16_t iter;
 
-uint16_t tacho1_cnt;
-uint16_t tacho2_cnt;
-uint16_t tacho3_cnt;
-
-uint16_t tacho1_rpm;
-uint16_t tacho2_rpm;
-uint16_t tacho3_rpm;
+uint16_t tacho_cnt[3];
+uint16_t tacho_rpm[3];
 
 int16_t sign(uint16_t x)
 {
@@ -51,14 +47,17 @@ int16_t sign(uint16_t x)
 void update_rpm()
 {
         // 2 sensor periods = 1 revolution
-        tacho1_rpm = 30*tacho1_cnt;
-        tacho1_cnt = 0;
+        tacho_rpm[0] = 30*tacho_cnt[0];
+        tacho_cnt[0] = 0;
+        frpms_lin[0] = float_to_linear(tacho_rpm[0]);
 
-        tacho2_rpm = 30*tacho2_cnt;
-        tacho2_cnt = 0;
+        tacho_rpm[1] = 30*tacho_cnt[1];
+        tacho_cnt[1] = 0;
+        frpms_lin[1] = float_to_linear(tacho_rpm[1]);
 
-        tacho3_rpm = 30*tacho3_cnt;
-        tacho3_cnt = 0;
+        tacho_rpm[2] = 30*tacho_cnt[2];
+        tacho_cnt[2] = 0;
+        frpms_lin[2] = float_to_linear(tacho_rpm[2]);
 }
 
 void update_pwm()
@@ -138,17 +137,17 @@ static void mytimercallback(const struct timer_task *const timer_task)
 
 static void inc_tacho1(void)
 {
-        ++tacho1_cnt;
+        ++tacho_cnt[0];
 }
 
 static void inc_tacho2(void)
 {
-        ++tacho2_cnt;
+        ++tacho_cnt[1];
 }
 
 static void inc_tacho3(void)
 {
-        ++tacho3_cnt;
+        ++tacho_cnt[2];
 }
 
 struct timer_task mytask;