public static void Main()
var a1 = -45*(MathF.PI/180);
var initialHeightEstimate = x1*s1 + y1 * c1;
Console.WriteLine($"Angle (rad) : {a1}- Cos:{c1} Sin:{s1} Height Estimate:{initialHeightEstimate}");
var a2 = (90-45)*(MathF.PI/180);
Console.WriteLine(Math.Clamp(2,1,2));