Как найти пересекающиеся объекты?

void CDWGObjects::printCrossingPoints(void)
{
    std::list<CCrossingPoint*>::const_iterator myIter;
    for (
        myIter = DocVars.docData().DWGObjects.DifferentCrossingObjects.begin();
        myIter!= DocVars.docData().DWGObjects.DifferentCrossingObjects.end();
        myIter++)
    {
        acutPrintf(" Пересечение с %d:\n",(*myIter)->Data_Type);
        acutPrintf("   С (%f,%f,%f) на пикете %f\n", (*myIter)->x_Beg, (*myIter)->y_Beg, (*myIter)->z_Beg, (*myIter)->BegStation);
        acutPrintf("   По (%f,%f,%f) на пикете %f\n", (*myIter)->x_End, (*myIter)->y_End, (*myIter)->z_End, (*myIter)->EndStation);
    }
}
void CDWGObjects::findingCrossing(AcDbEntity* PipeEntity)
{
    //Итератор для примитивов пересекающихся с трубой
    std::list<CSurfaceObject*>::const_iterator ObjectsIter;
    AcDbEntity* ObjectEntity;
    //Ищем пересечения с поверхностными объектами
    for(
        ObjectsIter = this->SurfaceObjects.begin();
        ObjectsIter != this->SurfaceObjects.end();
        ObjectsIter++)
    {
        ObjectEntity = this->getEntitybyStrHandler((*ObjectsIter)->Handler);
        if (ObjectEntity)
        {
            AcGePoint3dArray IntersectionPoints;
            if(PipeEntity->intersectWith(ObjectEntity, AcDb::kOnBothOperands, IntersectionPoints) == Acad::eOk)
            {
                if (IntersectionPoints.length()>0)
                {
                    double x1, y1, z1, x2, y2, z2, piket1, piket2;
                    if ((*ObjectsIter)->Width_Type==1)
                    {
                        int i=0;
                        while (i<IntersectionPoints.length())
                        {
                            x1=IntersectionPoints[i][0];
                            y1=IntersectionPoints[i][1];
                            z1=IntersectionPoints[i][2];
                            piket1=0;
                            i++;
                            if (i==IntersectionPoints.length()){
                                CCrossingPoint* newCross=new CCrossingPoint(x1, y1, z1, piket1, x1, y1, z1, piket1, (*ObjectsIter)->BlockRef_ID, (*ObjectsIter)->Data_Type);
                                this->DifferentCrossingObjects.push_back(newCross);
                                acutPrintf("Возможна ошибочная ситуация при пересечении широким блоком %s", (*ObjectsIter)->BlockName);
                            } else {
                                x2=IntersectionPoints[i][0];
                                y2=IntersectionPoints[i][1];
                                z2=IntersectionPoints[i][2];
                                piket2=0;
                                i++;
                                CCrossingPoint* newCross=new CCrossingPoint(x1, y1, z1, piket1, x2, y2, z2, piket2, (*ObjectsIter)->BlockRef_ID, (*ObjectsIter)->Data_Type);
                                this->DifferentCrossingObjects.push_back(newCross);
                            }
                        }
                    } else {
                        acutPrintf("Тонкие пересечения с %s:\n",(*ObjectsIter)->BlockName);
                        for (int i=0; i<IntersectionPoints.length(); i++)
                        {
                            x1=IntersectionPoints[i][0];
                            y1=IntersectionPoints[i][1];
                            z1=IntersectionPoints[i][2];
                            acutPrintf("    (%f,%f,%f)\n", x1, y1, z1);
                            piket1=0;
                            CCrossingPoint* newCross=new CCrossingPoint(x1, y1, z1, piket1, x1, y1, z1, piket1, (*ObjectsIter)->BlockRef_ID, (*ObjectsIter)->Data_Type);
                            this->DifferentCrossingObjects.push_back(newCross);
                        }
                    }
                }
                ObjectEntity->close();
            }
        }
    }
}