diff --git a/OSCCollar/OSCCollar.cs b/OSCCollar/OSCCollar.cs index e226de1..1af65f4 100644 --- a/OSCCollar/OSCCollar.cs +++ b/OSCCollar/OSCCollar.cs @@ -42,7 +42,6 @@ public class OSCCollar this.GPS3 = new(radius * 0.866, radius / 2); this.CalibrationX = calibrationX; this.CalibrationY = calibrationY; - this.GPSConstantA = 2 * GPS2.X - 2 * GPS1.X; this.GPSConstantB = 2 * GPS2.Y - 2 * GPS1.Y; this.GPSConstantC = Math.Pow(GPS1.X, 2) + Math.Pow(GPS2.X, 2) - Math.Pow(GPS1.Y, 2) + Math.Pow(GPS2.Y, 2); @@ -56,6 +55,7 @@ public class OSCCollar Console.WriteLine($"GPS 1 x: {GPS1.X} y: {GPS1.Y}"); Console.WriteLine($"GPS 2 x: {GPS2.X} y: {GPS2.Y}"); Console.WriteLine($"GPS 3 x: {GPS3.X} y: {GPS3.Y}"); + Console.WriteLine($"Radius of each receiver (sphere): {radius * 2}"); } this.Server = new OscServer(portReceive); @@ -117,6 +117,7 @@ public class OSCCollar Console.WriteLine(debugValue); } + #region Handle OSC-Messages private void AllowMovingHandle(OscMessageValues messageValues) { this._allowMoving = messageValues.ReadBooleanElement(0); @@ -141,6 +142,7 @@ public class OSCCollar { this._leashStretch = messageValues.ReadFloatElement(0); } + #endregion private void CalculatePositionFromGPS() {