} // Набор отрезков
public BSPNode()
{
//this.PolygonSet = null;
// this.indexofNode = 0;
this.left = null;
this.right = null;
}
public BSPNode(BSPNode getNode)
{
this.PolygonSet = getNode.PolygonSet;
this.Tree = getNode.Tree;
this.right = getNode.right;
this.left = getNode.left;
}
} // Построение дерева
public void Draw(BSPNode getNode, Point POV)
{
BSPNode x = getNode.Tree.rootnode;
double[] divline = geturav(x.PolygonSet[0].Point1, x.PolygonSet[0].Point2);
double Temp1 = divline[0] * POV.X + divline[1] * POV.Y + divline[2]; // A*x+B*y+C временная переменная для удобства, для точки 1 отрезка
if ((x.right == null) && (x.left == null))
{
Console.WriteLine(x.PolygonSet[0]);
} // Выводим те, которые видно
else if (Temp1 >= 0)
{
Draw(x.left, POV);
Console.WriteLine(x.PolygonSet[0]); // Выводим те, которые видно
Draw(x.right, POV);
}
else if (Temp1 < 0)
{
Draw(x.right, POV);
Console.WriteLine(x.PolygonSet[0]); // Выводим те, которые видно
Draw(x.left, POV);
}
}
} // Пока это не нужно
public BSPTree(List <BSPTreePolygon> PolygonSet) // Для создания дерева нам необзодим набор отрезков
{
BSPNode root = new BSPNode(PolygonSet); // Отрезки заполнились
rootnode = root;
// root.CreateBSPTree(root);
}
static void Main(string[] args)
{
string FileName = VVodFileName();
//VVodFileName();
string[] coordpov = VVodCoordPOV();
Point Pov = new Point(Convert.ToDouble(coordpov[0]), Convert.ToDouble(coordpov[1]));
//BSPTreePoly[1]
//List <BSPTreePolygon> BSPTreePolygon = getcoords(FileName);
BSPTreePolygon[] BSPTreePolygon = getcoords(FileName);
var Polylist = BSPTreePolygon.Cast <BSPTreePolygon>().ToList(); // Делаем из массива список; Тут все ок
BSPNode pp = new BSPNode(Polylist); //Инициализируем списком отрезков
//BSPTree T1 = new BSPTree(Polylist);
BSPNode op = pp.CreateBSPTree(pp);
op.Draw(op, Pov);
// BSPTree T1 = new BSPTree(BSPTreePolygon[1]);
}
//public void CreateBSPTree(BSPNode thisNode) { // thisNode - текущий узел дерева
// This class represents a node of a BSP tree. We construct a BSP tree recursively by keeping a reference to a root node and adding to each node a left and/or right son.
// There is no empty node, a leaf is a node that doesn't have any son.
public BSPNode CreateBSPTree(BSPNode getNode)
{
if (getNode.PolygonSet == null)
{
return(null); // Если подали пустой список отрезков
}
BSPNode thisNode = new BSPNode(getNode);
//thisNode.PolygonSet = PolySet;
if (thisNode.Tree == null)
{
BSPTree Tree1 = new BSPTree(thisNode);
thisNode.Tree = Tree1;
}
//BSPNode Node = new BSPNode();
//indexofNode++; // Увеличим номер
// right = new BSPNode();
thisNode.right = new BSPNode(thisNode.Tree); // указываем на дерево, которому принадлежат узлы
thisNode.left = new BSPNode(thisNode.Tree);
thisNode.right.PolygonSet = new List <BSPTreePolygon>();
thisNode.left.PolygonSet = new List <BSPTreePolygon>();
int n = thisNode.PolygonSet.Count; // Сколько отрезков в этом узле
BSPTreePolygon Div = thisNode.PolygonSet[n - 1]; // (индекс начинается с 0) Берем последний отрезок из списка и делаем его разделителем (на данный момент выбор оптимального разделителя не преследуется)
//if (thisNode.Tree == null) { BSPTree Tree = new BSPTree(thisNode); /*thisNode.parent = null;*/ } // Если дерева еще не существует, то создаем его и делаем корнем текущий Node
double[] divline = geturav(Div.Point1, Div.Point2); // получаем коэффициенты уравнения прямой (по двум её точкам)
for (int i = 0; i < n - 1; i++) // До n-1 т.к. элемент n уже взят как разделитель и помещается в текущий узел !!!!!!!!!! либо от 1 до n-1 либо от 0 до n, тогда нет ошибки
{
double Temp1 = divline[0] * thisNode.PolygonSet[i].Point1.X + divline[1] * thisNode.PolygonSet[i].Point1.Y + divline[2]; // A*x+B*y+C временная переменная для удобства, для точки 1 отрезка
double Temp2 = divline[0] * thisNode.PolygonSet[i].Point2.X + divline[1] * thisNode.PolygonSet[i].Point2.Y + divline[2]; // аналогично, но для второй точки отрезка
Temp1 = Math.Round(Temp1, 2, MidpointRounding.AwayFromZero); // Округление
Temp2 = Math.Round(Temp2, 2, MidpointRounding.AwayFromZero); // Округление
if (((Temp1 > 0) && (Temp2 >= 0)) || ((Temp1 >= 0) && (Temp2 > 0))) // Если A*x+B*y+C>=0 для обоих точек т.е. отрезок сверху(справа) от разделяющей прямой
{
Console.WriteLine("Были в 1");
//BSPNodeBSPNode right = new BSPNode(Tree); // Создаем узел справа
BSPTreePolygon r1 = new BSPTreePolygon();
r1 = thisNode.PolygonSet[i]; // Чтобы не менялся мб везде добавить
if (thisNode.right.PolygonSet != null)
{
thisNode.right.PolygonSet.Add(r1);
//Console.WriteLine(Temp1 + " " + Temp2 + " Кол-во right: " + thisNode.right.PolygonSet.Count + " Кол-во left: " + thisNode.left.PolygonSet.Count+" i: "+i);
}
else
{
thisNode.right.SetNode(r1);
}
//thisNode.right.AddNode(thisNode.PolygonSet[i]); // Добавляем этот отрезок в RightChild (front)
}
if ((Temp1 < 0) && (Temp2 < 0)) // Если A*x+B*y+C<0 для обоих точек т.е. отрезок снизу(слева) от разделяющей прямой
{
//thisNode.left.AddNode(thisNode.PolygonSet[i]); // Добавляем этот отрезок в LeftChild (back)
Console.WriteLine("Были в 2");
BSPTreePolygon l11 = new BSPTreePolygon();
l11 = thisNode.PolygonSet[i]; // Чтобы не менялся мб везде добавить
if (thisNode.left.PolygonSet != null)
{
thisNode.left.PolygonSet.Add(l11);
}
else
{
thisNode.left.SetNode(l11);
}
// Console.WriteLine(Temp1 + " " + Temp2 + " Кол-во right: " + thisNode.right.PolygonSet.Count + " Кол-во left: " + thisNode.left.PolygonSet.Count + " i: " + i);
}
if ((Temp1 >= 0) && (Temp2 < 0)) // Отрезок пересекается разделяющей прямой
{
Console.WriteLine("Были в 3");
Point DivPoint = Intersection(Div.Point1, Div.Point2, thisNode.PolygonSet[i].Point1, thisNode.PolygonSet[i].Point2); // Получаем пресечение отрезка и разделяющей прямой(заданной двумя точками)
BSPTreePolygon l21 = new BSPTreePolygon();
l21.Point1 = thisNode.PolygonSet[i].Point1;
l21.Point2 = DivPoint; // Чтобы не изменялся результат
//Point Temp = thisNode.PolygonSet[i].Point2; // Сохраним, чтобы не потерять
// thisNode.PolygonSet[i].Point2 = DivPoint; // Заменим вторую точку отрезка на точку пересечения
//thisNode.right.AddNode(thisNode.PolygonSet[i]); // Добавляем отрезок (PolygonSet[i].Point1, Divpoint) в RightChild (front)
if (thisNode.right.PolygonSet != null)
{
thisNode.right.PolygonSet.Add(l21);
}
else
{
thisNode.right.SetNode(l21);
}
//thisNode.PolygonSet[i].Point2 = Temp; // Вернули исходное значние точки 2
//Temp = thisNode.PolygonSet[i].Point1; // Сохраним первую точку
//thisNode.PolygonSet[i].Point1 = DivPoint; // Заменим первую точку отрезка на точку пересечения
//thisNode.left.AddNode(thisNode.PolygonSet[i]);// Добавляем отрезок (Divpoint, PolygonSet[i].Point2) в LeftChild (back)
l21.Point2 = thisNode.PolygonSet[i].Point2;
l21.Point1 = DivPoint; // Чтобы не изменялся результат
if (thisNode.left.PolygonSet != null)
{
thisNode.left.PolygonSet.Add(l21);
}
else
{
thisNode.left.SetNode(l21);
}
//thisNode.PolygonSet[i].Point1 = Temp; // Вернули исходный вид PolygonSet[i], хз зачем
// Console.WriteLine(Temp1 + " " + Temp2 + " Кол-во right: " + thisNode.right.PolygonSet.Count + " Кол-во left: " + thisNode.left.PolygonSet.Count + " i: " + i);
}
if ((Temp1 < 0) && (Temp2 >= 0)) // Отрезок пересекается разделяющей прямой
{
Console.WriteLine("Были в 4");
Point DivPoint = Intersection(Div.Point1, Div.Point2, thisNode.PolygonSet[i].Point1, thisNode.PolygonSet[i].Point2); // Получаем пресечение отрезка и разделяющей прямой(заданной двумя точками)
//Point Temp = thisNode.PolygonSet[i].Point2; // Сохраним, чтобы не потерять
//thisNode.PolygonSet[i].Point2 = DivPoint; // Заменим вторую точку отрезка на точку пересечения
BSPTreePolygon l1 = new BSPTreePolygon();
l1.Point1 = thisNode.PolygonSet[i].Point1;
l1.Point2 = DivPoint; // Чтобы не изменялся результат
//thisNode.left.AddNode(thisNode.PolygonSet[i]); // Добавляем отрезок (PolygonSet[i].Point1, Divpoint) в LeftChild (back)
if (thisNode.left.PolygonSet != null)
{
thisNode.left.PolygonSet.Add(l1);
}
else
{
thisNode.left.SetNode(l1);
}
BSPTreePolygon l2 = new BSPTreePolygon();
l2.Point1 = DivPoint;
l2.Point2 = thisNode.PolygonSet[i].Point2;
//thisNode.PolygonSet[i].Point2 = Temp; // Вернули исходное значние точки 2
//Temp = thisNode.PolygonSet[i].Point1; // Сохраним первую точку
//thisNode.PolygonSet[i].Point1 = DivPoint; // Заменим первую точку отрезка на точку пересечения
//thisNode.right.AddNode(thisNode.PolygonSet[i]);// Добавляем отрезок (Divpoint, PolygonSet[i].Point2) в RightChild (front)
if (thisNode.right.PolygonSet != null)
{
thisNode.right.PolygonSet.Add(l2);
}
else
{
thisNode.right.SetNode(l2);
}
//thisNode.PolygonSet[i].Point1 = Temp; // Вернули исходный вид PolygonSet[i], хз зачем
//Console.WriteLine(Temp1 + " " + Temp2 + " Кол-во right: " + thisNode.right.PolygonSet.Count + " Кол-во left: " + thisNode.left.PolygonSet.Count + " i: " + i);
}
Console.WriteLine(Temp1 + " " + Temp2 + " Кол-во right:" + thisNode.right.PolygonSet.Count + " Кол-во left:" + thisNode.left.PolygonSet.Count + " i:" + i + " n:" + n);
}
Console.WriteLine("_________________________________________________________________________");
//BSPNode Right = new BSPNode(thisNode.Tree, thisNode.right.PolygonSet); // Создаем узел справа // Добавить parent мб // это лишнее
//BSPNode Left = new BSPNode(thisNode.Tree, thisNode.left.PolygonSet); // Создаем узел слева
// List<BSPTreePolygon> SecondList = new List<BSPTreePolygon>(thisNode.PolygonSet); // Нам не нужна ссылка на объект
// thisNode.PolygonSet.Clear();
// thisNode.SetNode(SecondList[n-1]);// = thisNode.PolygonSet[n - 1]; // Оставляем в этом узле отрезок, который был разделителем, делаем это в конце, т.к. удаляет набор отрезков у узла
// if (thisNode.Tree.rootnode.PolygonSet.Count > 1) thisNode.Tree.rootnode.SetNode(SecondList[n - 1]); // thisNode.Tree.rootnode.PolygonSet.AddRange(SecondList); На первом проходе кладем в корень последний отрезок
/*if (thisNode.Tree == null) {
* BSPTree Tree = new BSPTree(thisNode);
* thisNode.Tree = Tree;
* } */
/* thisNode.Tree.rootnode = new BSPNode (thisNode);
* if (thisNode.Tree.rootnode.right.PolygonSet.Count > 1) // Если у правого потомка больше 1 отрезка, необходимо их разделить
* {
* CreateBSPTree(thisNode.Tree.rootnode.right);
* }
* if (thisNode.Tree.rootnode.left.PolygonSet.Count > 1)
* {
* CreateBSPTree(thisNode.Tree.rootnode.left);
* } */
if (thisNode.right.PolygonSet.Count > 1) // Если у правого потомка больше 1 отрезка, необходимо их разделить
{
CreateBSPTree(thisNode.right);
}
if (thisNode.left.PolygonSet.Count > 1)
{
CreateBSPTree(thisNode.left);
}
// CreateBSPTree(thisNode.Tree.rootnode.PolygonSet); // Корень этого дерева
return(thisNode);
} // Построение дерева
public BSPNode(List <BSPTreePolygon> PolygonSet)
{
this.PolygonSet = PolygonSet;
this.left = null;
this.right = null;
}
public BSPTree(BSPNode root)
{
rootnode = root;
} // Пока это не нужно