Implement value setting based on desired pulse result

laneboysrc · Mar 1, 2014 · 4bdffa4 · 4bdffa4
1 parent 5848827
commit 4bdffa4
Showing 1 changed file with 33 additions and 11 deletions.
diff --git a/hk310-filter.py b/hk310-filter.py
@@ -16,13 +16,30 @@
 import sys
 import time
 
-val1 = 0x24a
-val2 = 0x205
-val3 = 0xf3
-
-new_ch3 = val1
+values = [
+    0xa0,
+    0x80,
+    0x40,
+    0x20,
+    0x10,
+    0x08,
+    0x04,
+    0x02,
+    0x01,
+    0x02,
+    0x04,
+    0x08,
+    0x20,
+    0x40,
+    0x80,
+]
+
+
+new_ch3 = values[0]
 disableLoop = 0
 
+cur_value = 0
+
 
 def crc16_ccitt(crc, byte):
     """ Add a byte to the CRC16-CCITT checksum.
@@ -40,6 +57,8 @@ def crc16_ccitt(crc, byte):
 
 def hk310_filter(port):
     global new_ch3
+    global cur_value
+    global values
 
     try:
         s = serial.Serial(port, 19200)
@@ -202,12 +221,15 @@ def hk310_filter(port):
             else:
                 count = 0;
                 if not disableLoop:
-                    if new_ch3 == val1:
-                        new_ch3 = val2
-                    elif new_ch3 == val2:
-                        new_ch3 = val3
-                    else:
-                        new_ch3 = val1
+                    cur_value = cur_value + 1
+                    if cur_value == len(values):
+                        cur_value = 0
+
+                    rx_desired = values[cur_value] << 4
+                    if rx_desired >= 0x700:
+                        rx_desired += 2     # Above 0x700 add 2 for better stability! 
+                    rx = (2719 - rx_desired)
+                    new_ch3 = rx  * 16 / 17
 
         elif state == STATE_SKIP:
             skip = skip - 1