Vector Angle

IMyCockpit  Cockpit_Builder;
        IMyTextSurface CockpitLCD;
        // IMyMotorStator Rotor_Main;
        IMyMotorStator Rotor_Cockpit;
        IMyPistonBase  Piston_09;
        IMyInteriorLight Light_01;

        public Program()
        {
            // Rotor_Main = GridTerminalSystem.GetBlockWithName("Терц_Кран_Ротор_База") as IMyMotorStator;
            Rotor_Cockpit = GridTerminalSystem.GetBlockWithName("Терц_Кран_Ротор_Кокпит") as IMyMotorStator;
            Cockpit_Builder = GridTerminalSystem.GetBlockWithName("Терц_Кран_Кокпит_Паяльный") as IMyCockpit;
            CockpitLCD = Cockpit_Builder.GetSurface(0) as IMyTextSurface;
           // Piston_01 = GridTerminalSystem.GetBlockWithName("Терц_Кран_Поршень_Горизонт_01") as IMyPistonBase;
            Piston_09 = GridTerminalSystem.GetBlockWithName("Терц_Кран_Поршень_Горизонт_09") as IMyPistonBase;
            Light_01 = GridTerminalSystem.GetBlockWithName("Терц_Кран_Лампа_01") as IMyInteriorLight;


            Runtime.UpdateFrequency = UpdateFrequency.Update10;
        }

        public void Main(string argument)
        {
            Vector3 Cockpit_Position = Cockpit_Builder.CubeGrid.GetPosition();
            //Vector3 Rotor_Main_Position = Rotor_Main.CubeGrid.GetPosition();
            Vector3 Rotor_Cockpit_Position = Rotor_Cockpit.CubeGrid.GetPosition();
            Vector3 Light_Position = Light_01.CubeGrid.GetPosition();
            Vector3 Piston_09_Position = Piston_09.CubeGrid.GetPosition();
            Vector2 Bilder_Vector_X, Bilder_Vector_Offset_X;
            Bilder_Vector_X.X = Piston_09_Position.Y - Light_Position.Y;
            Bilder_Vector_X.Y = Piston_09_Position.Z - Light_Position.Z;
            Bilder_Vector_Offset_X.X = Cockpit_Position.Y - Rotor_Cockpit_Position.Y;
            Bilder_Vector_Offset_X.Y = Cockpit_Position.Z - Rotor_Cockpit_Position.Z;
            float Cockpit_Offset;
            Cockpit_Offset = (float)Math.Acos(((Bilder_Vector_X.X * Bilder_Vector_Offset_X.X)+(Bilder_Vector_X.Y * Bilder_Vector_Offset_X.Y)) / (Math.Sqrt((Bilder_Vector_X.X* Bilder_Vector_X.X)+(Bilder_Vector_X.Y * Bilder_Vector_X.Y)) * Math.Sqrt((Bilder_Vector_Offset_X.X * Bilder_Vector_Offset_X.X) + (Bilder_Vector_Offset_X.Y * Bilder_Vector_Offset_X.Y))));

            //CockpitLCD.WriteText("Лампа: "+ "\n"+"X:"+ Light_Position.X.ToString()+"\n"+ "Y:" + Light_Position.Y.ToString() + "\n" + "Z:" + Light_Position.Z.ToString() + "\n"+
            //   "Поршень_09: " + "\n" + "X:" + Piston_09_Position.X.ToString() + "\n" + "Y:" + Piston_09_Position.Y.ToString() + "\n" + "Z:" + Piston_09_Position.Z.ToString() + "\n", false);

            CockpitLCD.WriteText("Угол стрелы: " + Cockpit_Offset.ToString() +"\n", false);

        }