Программа бильярд(соударение мячей) C#

[Kehab]

Народ здраствуйте. так вот никак не могу написать код чтобы шары отталкивались друг от друга нужна ваша помощь. Вот функция которую я составил по описанию на сайте http://billiard-bsv.narod.ru/ класс ball:
v - ед. вектор скорости (только координаты умноженые на 1000 потому что сохранён в типе Point)
(x, y) - координаты шара
l - скорость

 
private void clash(ref ball b1, ref ball b2)
        {
            double AB = Math.Sqrt((b2.x - b1.x) * (b2.x - b1.x) + (b2.y - b1.y) * (b2.y - b1.y));
            double m = 0.97;
            double a;
            double b;
            double xx1 = 0;
            double xy1 = 0;
            double xx2 = 0;
            double xy2 = 0;
            if (b1.l > 0)
            {
                a = Math.Acos(((double)(b2.x - b1.x) / (double)h));
                if (b2.y <= b1.y)
                    a *= (-1);
                b = b1.l * Math.Acos(b1.v.X / 1000);
                if (b1.v.Y <= 0)
                    b = b * (-1);
                b = b - a;
                xx1 = Math.Cos(b) * Math.Cos(a);
                xy1 = Math.Cos(b) * Math.Sin(a);
            }
            if (b2.l > 0)
            {
                a = Math.Acos((b1.x - b2.x) / h);
                if ((b1.y - b2.y) <= 0)
                    a = a * (-1);
                b = b2.l * Math.Acos(b2.v.X / 1000);
                if (b2.v.Y <= 0)
                    b = b * (-1);
                b = b - a;
                xx2 = Math.Cos(b) * Math.Cos(a);
                xy2 = Math.Cos(b) * Math.Sin(a);
            }


            double dx = ((((double)b1.v.X * b1.l / 1000) - (2 * xx1)) + xx2) * m;
            double dy = ((((double)b1.v.Y * b1.l / 1000) - (2 * xy1)) + xy2) * m;
            b1.l = (float)Math.Sqrt((dx * dx) + (dy * dy));
            b1.v.X = (int)(dx * 1000 / b1.l);
            b1.v.Y = (int)(dy * 1000 / b1.l);
            
            dx = ((((double)b2.v.X * b2.l / 1000) - (2 * xx2)) + xx1) * m;
            dy = ((((double)b2.v.Y * b2.l / 1000) - (2 * xy2)) + xy1) * m;
            b2.l = (float)Math.Sqrt((dx * dx) + (dy * dy));
            b2.v.X = (int)(dx * 1000 / b2.l);
            b2.v.Y = (int)(dy * 1000 / b2.l);
         }