using System;

public class Program

{

    public static void Main()

    {

        double A = 1.2; //The out of balance weight

        double B = 1.0; // the test weight eg 1 oz.

        double angle;

        angle = 35; //the angle between the out of balance weight and the first weight position

​

        double M1 = Amplitude(A,B,radian(angle + 0  )); //Measurement1

        double M2 = Amplitude(A,B,radian(angle + 120)); //Measurement2

        double M3 = Amplitude(A,B,radian(angle + 240)); //Measurement3

        Console.WriteLine("out of balance weight = " + A.ToString() + ", test weight = " + B.ToString() +", angle = " + angle.ToString() +"\n" );

        Console.WriteLine("measurment   one: " + Math.Round(M1,3).ToString() + "\n");

        Console.WriteLine("measurment   two: " + Math.Round(M2,3).ToString() + "\n");

        Console.WriteLine("measurment three: " + Math.Round(M3,3).ToString() + "\n");

        double error = double.MaxValue;

        double AnswerA=0;

        double AnswerB=0;

        double AnswerAngle=0;

        for (angle = 0; angle < 360; angle +=1)

        {

            for (B = 0; B < 2; B += 0.01)

            {

                for (A = 0; A < 2; A += 0.01)

                {

                    double M1dash = Amplitude(A,B,radian(angle + 0  ));

                    double M2dash = Amplitude(A,B,radian(angle + 120));

                    double M3dash = Amplitude(A,B,radian(angle + 240));

                    double RMSofErrors = Math.Sqrt( ((M1-M1dash)*(M1-M1dash) + (M2-M2dash)*(M2-M2dash) + (M3-M3dash)*(M3-M3dash))/3.0 ); //RMS of errors

                    if (RMSofErrors < error)

                    {

                        error = RMSofErrors;

                        AnswerA=A;

                        AnswerB=B;  // We know B (the test weight) so validate this answer: B here must match the test weight. possible to get the two reversed  

                        AnswerAngle=angle;

                    }

                }

            }

        }

        Console.WriteLine("A = " + AnswerA.ToString() + ", B = " + AnswerB.ToString() +", angle = " + AnswerAngle.ToString() );

    }

    public static double radian(double degrees)

    {

        degrees = degrees % 360.0;

        double result =  degrees/180.0*Math.PI;

        return result;

    }       

    /*

    Amplitude() is the result adding two sinewaves of the same frequency but with amplitudes A and B separated by a phase angle angle 

    */

    public static double Amplitude(double A, double B, double angle )

    {

        return Math.Sqrt(A*A + B*B +2.0*A*B*Math.Cos(angle) );

    }

}

/*

out of balance weight = 1.2, test weight = 1, angle = 35

​

measurement   one: 2.099

​

measurement   two: 0.515

​

measurement three: 1.628

​

Given the above measurements we calculate : out of balance weight = 1.2, test weight = 1, angle = 35

*/