From 25e098b9bed34fbe2742bf13e9d0f12295079479 Mon Sep 17 00:00:00 2001
From: GZod01 <gzod01@gzod01.fr>
Date: Sun, 14 Jan 2024 16:26:49 +0100
Subject: [PATCH] hellloworld

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

diff --git a/ftc2024-holonom.java b/ftc2024-holonom.java
index 529be21..171fb06 100644
--- a/ftc2024-holonom.java
+++ b/ftc2024-holonom.java
@@ -109,7 +109,7 @@ public class Werobot_FTC2024 extends LinearOpMode {
                                 int[] cur_motor = motors_angles[i];
                                 double cur_motor_norm = Math.pow(((Math.pow(cur_motor[0],2))+(Math.pow(cur_motor[1],2))),(1.0/2.0));
                                 double joystick_angle = Math.atan2(joystick_vector[0],joystick_vector[1]);
-                                double cur_motor_angle = Math.atan2(cur_motor[0],cur_motor[1]);
+                                double cur_motor_angle = Math.atan2(cur_motor[0],cur_motor[1])+(Math.PI/4);
                                 double diff_angle = joystick_angle - cur_motor_angle;
 				if (mode=="normal"){
 					diff_angle-=Yaw;