Реализация математического алгоритма в программу

using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.Data;
using System.Drawing;
using System.Linq;
using System.Text;
using System.Windows.Forms;
 
namespace WindowsFormsApplication1
{
    public partial class Form1 : Form
    {
        
        public Form1()
        {
            InitializeComponent();
        }
 
        private void button1_Click(object sender, EventArgs e)
        {
            try
            {
                double E = Convert.ToDouble(textBox9.Text);
                double T2 = Convert.ToDouble(textBox1.Text);
                double Vh = Convert.ToDouble(textBox2.Text);
                double Kh = Convert.ToDouble(textBox3.Text);
                double M = Convert.ToDouble(textBox4.Text);
                double D1 = Convert.ToDouble(textBox5.Text);
                double P1 = Convert.ToDouble(textBox6.Text);
                double D2 = Convert.ToDouble(textBox7.Text);
                double P2 = Convert.ToDouble(textBox8.Text);
 
                //1. Определение координат первой точки
                double x1, y1;
                x1 = D1*Math.Sin(P1);
                y1 = D1*Math.Cos(P1);
                TextWriter("1. Определение координат 1й точки");
                TextWriter("X1 = D1*sinП1");
                TextWriter("Y 1 = D1*cos П1");
                TextWriter("x1 = " + x1.ToString() + "; y1 = " + y1.ToString());
 
                //2. Определение координат второй точки
                double x2, y2;
                x2 = D2*Math.Sin(P2);
                y2 = D2*Math.Cos(P2);
                TextWriter("2. Определение координат 2й точки");
                TextWriter("X2 = D2*sinП2");
                TextWriter("Н2 = D2*cosП2");
                TextWriter("x2 = " + x2.ToString() + "; y2 = " + y2.ToString());
 
                //3. Определение ∆t
                double deltaT = T2/60;
                TextWriter("3. Определение ∆t");
                TextWriter("∆t = (T2-T1)/60 = T2/60");    
                TextWriter("∆t = " + deltaT.ToString());
 
                //4. Составляющая вестора скорости Vн
                double deltaXvh = Vh*deltaT*Math.Sin(Kh);
                double deltaYvh = Vh * deltaT * Math.Cos(Kh);
                TextWriter("4. Составляющая вестора скорости Vн");
                TextWriter("∆Xvн = Vн*∆t*sinKн");
                TextWriter("∆Yvн = Vн*∆t*cosKн");
                TextWriter("∆Xvн = " + deltaXvh.ToString() + "; ∆Yvн = " + deltaYvh.ToString());
 
                //5. Точка начала вестора Vн
                double Xh = x1 - deltaXvh;
                double Yh = y1 - deltaYvh;
                TextWriter("5. Точка начала вестора Vн");
                TextWriter("Xн = X1 - ∆Xvн");
                TextWriter("Yн = Y1 - ∆Yvн");
                TextWriter("Xн = " + Xh.ToString() + "; Yн = " + Yh.ToString());
 
                //6. Длина ветора
                double Vh_2 = Math.Sqrt((Math.Pow(deltaXvh, 2)) + (Math.Pow(deltaYvh, 2)));
                TextWriter("6. Длина ветора");
                TextWriter("Vн = корень из ∆Xvн^2 + ∆Yvн^2");
                TextWriter("Vн = " + Vh_2.ToString());
 
                //7. Составляющая вектора скорости цели Vц
                double deltaXc = x2 - Xh;
                double deltaYc = y2 - Yh;
                double Vc = Math.Sqrt((Math.Pow(deltaXc, 2)) + (Math.Pow(deltaYc, 2)));
                TextWriter("7. Составляющая вектора скорости цели Vц");
                TextWriter("∆Xц = X2-Xн");
                TextWriter("∆Yц = Y2 – Yн");
                TextWriter("Vц = корень из ∆Xц^2 + ∆Yц^2");
                TextWriter("∆Xц = " + deltaXc.ToString() + "; ∆Yц = " + deltaYc.ToString() + "; Vц = " + Vc.ToString());
 
                //И так далее...
            }
            catch (Exception ex)
            {
                MessageBox.Show(ex.Message);
            }
        }
 
        private void TextWriter(string text)
        {
            string a = text + "\r\n" + richTextBox1.Text;
            richTextBox1.Text = a;
        }
    }
}