InverseKinematics C# and Arduino code to calculate the servo angles required for selected foot position in a 3 degrees of freedom robot leg