Rpm based comp power level f421

Author: AlkaMotors

Mcu/f051/Inc/comparator.h

@@ -14,7 +14,7 @@
 //#define COMP_PA4 0b1000101
 //#define COMP_PA5 0b1010101
 
-//// High speed comparator
+// High speed comparator
  #define COMP_PA0 0b1100001
  #define COMP_PA4 0b1000001
  #define COMP_PA5 0b1010001

Mcu/f051/Src/comparator.c

@@ -12,7 +12,6 @@
 COMP_TypeDef* active_COMP = COMP1;
 
 uint8_t getCompOutputLevel() { return LL_COMP_ReadOutputLevel(active_COMP); }
-uint8_t medium_speed_set;
 
 void maskPhaseInterrupts()
 {
@@ -36,12 +35,9 @@ void changeCompInput()
     }
 if((average_interval < 400)){
 COMP->CSR = COMP->CSR & ~(1<<2);
-
-medium_speed_set = 0;
 }
 if((average_interval > 600)){
 COMP->CSR  = COMP->CSR | 1<<2;
-medium_speed_set = 1;
 }
     if (rising) {
         EXTI->RTSR = 0x0;

Mcu/f421/Src/comparator.c

@@ -6,8 +6,8 @@
  */
 
 #include "comparator.h"
-
 #include "targets.h"
+#include "common.h"
 
 uint8_t getCompOutputLevel() { return CMP->ctrlsts_bit.cmpvalue; }
 
@@ -39,6 +39,14 @@ void changeCompInput()
 //        EXINT->polcfg1 |= (uint32_t)EXTI_LINE;
 //        EXINT->polcfg2 = 0;
 //    }
-		EXINT->polcfg1 = !rising << 21;
+    if((average_interval < 150)){ 
+        //set comp to high speed mode
+        CMP->ctrlsts = CMP->ctrlsts & ~(1<<2);
+    }
+    if((average_interval > 250)){
+        //set comp to medium speed mode
+        CMP->ctrlsts  = CMP->ctrlsts | 1<<2;
+    }
+	EXINT->polcfg1 = !rising << 21;
     EXINT->polcfg2 = rising << 21;
 }