From b32b904f0984ada6d1da14f5b2ea8a04cc627cae Mon Sep 17 00:00:00 2001
From: Alessandro Abrami <alessandro.abrami@elettra.eu>
Date: Mon, 12 Aug 2024 11:22:13 +0200
Subject: [PATCH] 2024/08/12: tkt22322 implementato disattivabile via prop.

---
 src/EpuFG.cpp | 18 ++++++++++++++++++
 1 file changed, 18 insertions(+)

diff --git a/src/EpuFG.cpp b/src/EpuFG.cpp
index 331afb0..3c79ba0 100644
--- a/src/EpuFG.cpp
+++ b/src/EpuFG.cpp
@@ -665,11 +665,29 @@ void EpuFG::write_Phases(Tango::WAttribute &attr)
                                         (const char *)"Wrong number of vales",
                                         (const char *)"Wrong number of vales",
                                         (const char *)"EpuFG::write_Phases()");
+	Tango::DevDouble R = w_val[0];
+	Tango::DevDouble P = w_val[1];
+	Tango::DevDouble J = w_val[2];
+
+	if (tkt22322_enable){
+		if (R >= 0.0 ) {
+			P = -fabs(P);
+			J = -fabs(J);
+		} else {
+			P = fabs(P);
+			J = fabs(J);
+		}
+	}
 
 	vector<double> pos(3);
+/*
 	pos[0] = w_val[0] + w_val[1];
 	pos[1] = w_val[1] + w_val[2];
 	pos[2] = w_val[0] + w_val[2];
+*/
+	pos[0] = R + P;
+	pos[1] = P + J;
+	pos[2] = R + J;
 
 	vector<string> ph(3);
 	ph[0] = "ROW";
-- 
GitLab