Diff: main.cpp

Revision:

14:d084ea982238

Parent:

12:a9d894e37936

--- a/main.cpp	Sun Sep 02 04:43:00 2018 +0000
+++ b/main.cpp	Sun Nov 10 02:45:05 2019 +0000
@@ -24,6 +24,8 @@
 #include "hormone.h"
 #include "PowerMon.h"
 
+#define INITCONFIG 3 // 0-default, 1-flat, 2-small, 3-big roughtness
+
 Serial pc(USBTX, USBRX);                 // Serial Port
 Timer timer1;
 Thread thread1;         
@@ -56,28 +58,37 @@
 // home variable
 int initCheck = 0;
 float waittime = 0.001 ;
-int round = 25;
+int round = 8;
 
 //  pm variable
 int iterPM = 0;
 float sumOfPower = 0.0, Energy = 0.0;
     
 // interface wt hormone variable
-/*
-// config flat //
-float upDeg = 45.00;
-float downDeg = 95.00;
-*/
+#if(INITCONFIG == 0)
+    // default config //
+    float upDeg = 45.00;
+    float downDeg = 90.00;
+#endif
+    
+#if(INITCONFIG == 1)
+    // config flat //
+    float upDeg = 45.00;
+    float downDeg = 95.00;
+#endif
+    
+#if(INITCONFIG == 2)
+    // config small //
+    float upDeg = 60.00;
+    float downDeg = 100.00;
+#endif
 
-// config small //
-float upDeg = 60.00;
-float downDeg = 100.00;
+#if(INITCONFIG == 3)
+    // config big //
+    float upDeg = 75.00;
+    float downDeg = 90.00;
+#endif
 
-/*
-// config big //
-float upDeg = 75.00;
-float downDeg = 90.00;
-*/
 // servo motor variable
 float pos_down_start = 1400.00;
 float pos_up_start = 1000.00;