1 files changed, 14 insertions, 0 deletions
diff --git a/laser-tag software/main.c b/laser-tag software/main.c
index 9f6b52c..da99cbd 100755
--- a/laser-tag software/main.c
+++ b/laser-tag software/main.c
@@ -169,6 +169,12 @@ void lptmr_call_back(void)
         PIT_DRV_StopTimer(0, 0);
         DAC_DRV_Output(0, 0);
     }
+
+    // AGC decay
+    if (g_cmpDacConf.dacValue > 0) {
+        g_cmpDacConf.dacValue--;
+        CMP_DRV_ConfigDacChn(0, &g_cmpDacConf);
+    }
 }
 
 
@@ -181,6 +187,14 @@ void CMP0_IRQHandler(void)
     if (CMP_DRV_GetFlag(0, kCmpFlagOfCoutFalling)) {
         CMP_DRV_ClearFlag(0, kCmpFlagOfCoutFalling);
     }
+
+    // AGC rise
+    if (CMP_DRV_GetOutputLogic(0)) {
+        if (g_cmpDacConf.dacValue < 63) {
+            g_cmpDacConf.dacValue++;
+            CMP_DRV_ConfigDacChn(0, &g_cmpDacConf);
+        }
+    }
 }
 
 /*!