From a6db57fcdbf791e1da9c9c5995722eec76f006cd Mon Sep 17 00:00:00 2001
From: GZod01 <gzod01@gzod01.fr>
Date: Sun, 7 Jan 2024 17:21:37 +0100
Subject: [PATCH] feat:ftc2024-holonom.java

---
 ftc2024-holonom.java | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/ftc2024-holonom.java b/ftc2024-holonom.java
index 8e09d56..7110d9f 100644
--- a/ftc2024-holonom.java
+++ b/ftc2024-holonom.java
@@ -91,7 +91,7 @@ public class Werobot_FTC2024 extends LinearOpMode {
                                 double joystick_angle = Math.atan2(joystick_vector[0],joystick_vector[1]);
                                 double cur_motor_angle = Math.atan2(cur_motor[0],cur_motor[1]);
                                 double diff_angle = joystick_angle - cur_motor_angle;
-				diff_angle+=Yaw;
+				diff_angle-=Yaw;
                                 motors_values[i] =  (cur_motor_norm*joystick_norm*Math.cos(diff_angle));
                                 motors_values[i] = (motors_values[i]+gamepad1.right_stick_x)/(Math.abs(gamepad1.right_stick_x)+1);
                                 motors_values[i]= motors_values[i]/Math.sqrt(2);