From 0ba701e5188385f2dff7d545228a636fbc07b958 Mon Sep 17 00:00:00 2001
From: Dario Sassi <dario.s@egaltech.com>
Date: Tue, 9 Apr 2019 06:54:02 +0000
Subject: [PATCH] OmagCUT : - modifica per ventose con rotazione a step
 allineate al meglio con il lato lungo del pezzo.

---
 VacuumCups.vb | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/VacuumCups.vb b/VacuumCups.vb
index 4fe6609..f72fcef 100644
--- a/VacuumCups.vb
+++ b/VacuumCups.vb
@@ -368,6 +368,13 @@ Module VacuumCups
       Dim vAngRot As New List(Of Double)
       ' Se asse rotante ventosa a step
       If GetVacRotAxisSteps(vAngRot) Then
+         ' Ordino secondo distanza angolare crescente da direzione di allineamento (modulo 180 deg)
+         Dim dRotRefDeg As Double = dRotAngDeg
+         vAngRot.Sort(Function(P, Q)
+                         Dim dDiffP = Math.Abs(( P - dRotRefDeg) Mod 180)
+                         Dim dDiffQ = Math.Abs(( Q - dRotRefDeg) Mod 180)
+                         Return ( dDiffP - dDiffQ)
+                      End Function)
          ' Annullo la rotazione di allineamento
          dRotAngDeg = 0
       ' altrimenti in continuo