Add extended up B on modX and modY angles

Crane1195 · Aug 19, 2022 · a349261 · a349261
1 parent f6bb134
commit a349261
Showing 1 changed file with 16 additions and 4 deletions.
diff --git a/src/Logic/DAC.h b/src/Logic/DAC.h
@@ -177,8 +177,14 @@ outputStatus rectangleDAC(inputStatus *inputs, coordinates currentCoords, SOCD l
                 }
                 // Tilt angle
                 else {
-                    returnStatus.leftStickX += (positionX * currentCoords.modX_Diagonal.x);
-                    returnStatus.leftStickY += (positionY * currentCoords.modX_Diagonal.y);
+                    if (!inputs->b) {
+                        returnStatus.leftStickX += (positionX * currentCoords.modX_Diagonal.x);
+                        returnStatus.leftStickY += (positionY * currentCoords.modX_Diagonal.y);
+                    }
+                    else {
+                        returnStatus.leftStickX += (positionX * currentCoords.modX_Diagonal_B.x);
+                        returnStatus.leftStickY += (positionY * currentCoords.modX_Diagonal_B.y);
+                    }
                 }
             }
         }
@@ -255,8 +261,14 @@ outputStatus rectangleDAC(inputStatus *inputs, coordinates currentCoords, SOCD l
                 }
                 // Tilt angle
                 else {
-                    returnStatus.leftStickX += (positionX * currentCoords.modY_Diagonal.x);
-                    returnStatus.leftStickY += (positionY * currentCoords.modY_Diagonal.y);
+                    if (!inputs->b) {
+                        returnStatus.leftStickX += (positionX * currentCoords.modY_Diagonal.x);
+                        returnStatus.leftStickY += (positionY * currentCoords.modY_Diagonal.y);
+                    }
+                    else {
+                        returnStatus.leftStickX += (positionX * currentCoords.modY_Diagonal_B.x);
+                        returnStatus.leftStickY += (positionY * currentCoords.modY_Diagonal_B.y);
+                    }
                 }
             }
         }