Add Center Sensors

Implement Sensors to detect the center position
gagagu · Apr 21, 2023 · e1acf73 · e1acf73
1 parent de49247
commit e1acf73
Show file tree

Hide file tree

Showing 8 changed files with 75 additions and 14 deletions.
diff --git a/Arduino.ino b/Arduino.ino
@@ -29,6 +29,13 @@
 #define ADJ_ENDSWITCH_ROLL_RIGHT 3
 #define ADJ_BUTTON_CALIBRATION 4
 
+// If you use center sensor use 
+// RES_1 connector for Roll Roll Sensor
+// RES_2 connector for Pitch Sensor
+#if defined(LANGUAGE_EN)
+  #define ADJ_MIDDLESWITCH_ROLL 5
+  #define ADJ_MIDDLESWITCH_PITCH 6
+#endif
 
 // variables for Speed calculation
 byte roll_speed = 0;
@@ -209,6 +216,31 @@ void CheckCalibrationMode() {
 
     // dsiable motor
     DisableMotors();
+
+#if defined(LANGUAGE_EN)
+    // Print message to display for center position
+    LcdPrintCalibrationMiddleSensors();
+
+    // measure center by ir sensors
+    byte byteFlag=0;
+    while(byteFlag!= B00000011)
+    {
+      delay(1);
+      ReadMux();
+
+      // If Center Roll Sensor detects reset Roll counter
+      if((iSensorPinStates & (1 << ADJ_MIDDLESWITCH_ROLL))==0){
+        counterRoll.readAndReset(); 
+        byteFlag=byteFlag | B00000001;
+      }
+
+      // If Center Pitch Sensor detects reset Roll counter
+      if((iSensorPinStates & (1 << ADJ_MIDDLESWITCH_PITCH))==0){
+        counterPitch.readAndReset(); 
+        byteFlag=byteFlag | B00000010;
+      }
+    }
+#else
     // Print message to display for center position
     LcdPrintCalibrationMiddle();
 
@@ -217,10 +249,11 @@ void CheckCalibrationMode() {
       delay(1);
       ReadMux();
     }
-
     // reset counters to zero
     counterRoll.readAndReset();
     counterPitch.readAndReset();
+#endif    
+
 
     // small wait; not really needed but nicer in behavior
     delay(500);
@@ -377,6 +410,18 @@ void ReadMux() {
 
   }//for
 
+// only for censter sensors
+#if defined(LANGUAGE_EN)
+  // If Center Roll Sensor detects reset Roll counter
+  if((iSensorPinStates & (1 << ADJ_MIDDLESWITCH_ROLL))==0){
+    counterRoll.readAndReset(); 
+  }
+
+  // If Center Pitch Sensor detects reset Roll counter
+  if((iSensorPinStates & (1 << ADJ_MIDDLESWITCH_PITCH))==0){
+    counterPitch.readAndReset(); 
+  }
+#endif  
 }// ReadMux
 
 /******************************************

diff --git a/Arduino_FFB_Yoke.ino b/Arduino_FFB_Yoke.ino
@@ -1,7 +1,9 @@
 
 // Version 1.3.0
 
-#define languageEN          // Special thank to Lollo for the inspiration and code
+#define LANGUAGE_EN         // Special thank to Lollo for the inspiration and code
+#define USE_CENTER_SENSOR   // comment out when not using center sensor
+
 #define SERIAL_BAUD 115200  // Communication Speed
 
 
@@ -85,8 +87,8 @@ void setup() {
 void loop() {
   currentMillis = millis();                                           // number of milliseconds passed since the Arduino board began running the current program
 
+  ReadMux();                                                          // Read values of buttons and end switch sensors (except yoke axes)
   if (currentMillis >= nextJoystickMillis) {                          // do not run more frequently than these many milliseconds, the window system needs time to process
-    ReadMux();                                                        // Read values of buttons and end switch sensors (except yoke axes)
     CheckCalibrationMode();                                           // check if calibration button was pressed an do it
     UpdateJoystickButtons();                                          // set Joystick buttons
     Joystick.sendState();                                             // send joystick values to system

diff --git a/Cad/FreeCad/FFB_Yoke_1.3.FCStd → Cad/FreeCad/FFB_Yoke_1.3.5.FCStd b/Cad/FreeCad/FFB_Yoke_1.3.FCStd → Cad/FreeCad/FFB_Yoke_1.3.5.FCStd
diff --git a/Cad/FreeCad/IR_Senors_Encoder/IR_Sensor_Holder_Pitch_Center.FCStd b/Cad/FreeCad/IR_Senors_Encoder/IR_Sensor_Holder_Pitch_Center.FCStd
diff --git a/Cad/FreeCad/IR_Senors_Encoder/IR_Sensor_Holder_Roll_Center.FCStd b/Cad/FreeCad/IR_Senors_Encoder/IR_Sensor_Holder_Roll_Center.FCStd
diff --git a/Cad/FreeCad/IR_Senors_Encoder/IR_Sensor_Pin_Pitch_Center.FCStd b/Cad/FreeCad/IR_Senors_Encoder/IR_Sensor_Pin_Pitch_Center.FCStd
diff --git a/Cad/FreeCad/IR_Senors_Encoder/Yoke_Pipe_EndRing_Sensor.FCStd b/Cad/FreeCad/IR_Senors_Encoder/Yoke_Pipe_EndRing_Sensor.FCStd
diff --git a/LCD_EN.ino b/LCD_EN.ino
@@ -1,4 +1,4 @@
- #if defined(languageEN) // language englisch
+ #if defined(LANGUAGE_EN) // language englisch
 
 /******************************************
   Into
@@ -45,16 +45,30 @@ void LCDPrintDebugMode(){
   lcd.setCursor(0, 0);
   lcd.print(F("Debug Mode: On"));
 }
-/******************************************
-  show calibration middle
-*******************************************/
-void LcdPrintCalibrationMiddle(){
-  lcd.setCursor(0, 0);
-  lcd.print(F("Put all axes in the "));
-  lcd.print(F("middle position and "));
-  lcd.print(F("press the calibratib"));
-  lcd.print(F("ration button       "));
-}
+
+#if defined(LANGUAGE_EN)
+  /******************************************
+    show calibration middle
+  *******************************************/
+  void LcdPrintCalibrationMiddleSensors(){
+    lcd.setCursor(0, 0);
+    lcd.print(F("Put all axes from   "));
+    lcd.print(F("one end to the other"));
+    lcd.print(F("to detect the middle"));
+    lcd.print(F("by sensor           "));
+  }
+#else
+  /******************************************
+    show calibration middle
+  *******************************************/
+  void LcdPrintCalibrationMiddle(){
+    lcd.setCursor(0, 0);
+    lcd.print(F("Put all axes in the "));
+    lcd.print(F("middle position and "));
+    lcd.print(F("press the calibratib"));
+    lcd.print(F("ration button       "));
+  }
+#endif
 
 /******************************************
   show calibration start