khanat-opennel-code/code/ryzom/client/src/precipitation_clip_grid.cpp
acemtp@users.sourceforge.net d5c601ffa5 initial version
2010-05-06 02:08:41 +02:00

744 lines
22 KiB
C++

// Ryzom - MMORPG Framework <http://dev.ryzom.com/projects/ryzom/>
// Copyright (C) 2010 Winch Gate Property Limited
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU Affero General Public License as
// published by the Free Software Foundation, either version 3 of the
// License, or (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU Affero General Public License for more details.
//
// You should have received a copy of the GNU Affero General Public License
// along with this program. If not, see <http://www.gnu.org/licenses/>.
#include "stdpch.h"
// TMP TMP
#include "nel/pacs/u_global_retriever.h"
#include "nel/pacs/u_global_position.h"
#include "nel/3d/u_driver.h"
#include "nel/3d/u_visual_collision_manager.h"
#include "nel/misc/matrix.h"
#include "nel/misc/hierarchical_timer.h"
#include "nel/misc/system_info.h"
#include "precipitation_clip_grid.h"
#include <algorithm>
using namespace NLMISC;
using namespace NL3D;
//CHeightGrid HeightGrid;
extern UVisualCollisionManager *CollisionManager;
/////////////////
// CHeightGrid //
/////////////////
/*
//***********************************************************************************
void CHeightGrid::tileAdded(const CTileAddedInfo &infos)
{
// insert in point grid
_TileInfos[infos.TileID] = infos;
CVector2f corners[3];
corners[0].set(infos.Corners[0].x, infos.Corners[0].y);
corners[1].set(infos.Corners[1].x, infos.Corners[1].y);
corners[2].set(infos.Corners[2].x, infos.Corners[2].y);
addTri(corners, infos.Center.z);
corners[0].set(infos.Corners[0].x, infos.Corners[0].y);
corners[1].set(infos.Corners[2].x, infos.Corners[2].y);
corners[2].set(infos.Corners[3].x, infos.Corners[3].y);
addTri(corners, infos.Center.z);
}
//***********************************************************************************
void CHeightGrid::tileRemoved(uint64 id)
{
CHashMap<uint64, CTileAddedInfo>::iterator it = _TileInfos.find(id);
nlassert(it != _TileInfos.end());
CVector2f corners[3];
const CTileAddedInfo &infos = it->second;
corners[0].set(infos.Corners[0].x, infos.Corners[0].y);
corners[1].set(infos.Corners[1].x, infos.Corners[1].y);
corners[2].set(infos.Corners[2].x, infos.Corners[2].y);
removeTri(corners, infos.Center.z);
corners[0].set(infos.Corners[0].x, infos.Corners[0].y);
corners[1].set(infos.Corners[2].x, infos.Corners[2].y);
corners[2].set(infos.Corners[3].x, infos.Corners[3].y);
removeTri(corners, infos.Center.z);
}
//***********************************************************************************
void CHeightGrid::addTri(const CVector2f corners[3], float z)
{
_Tri.Vertices.resize(3);
_Tri.Vertices[0] = corners[0];
_Tri.Vertices[1] = corners[1];
_Tri.Vertices[2] = corners[2];
sint minY;
_Tri.computeBorders(_Rasters, minY);
if (_Rasters.empty()) return;
sint numRasters = _Rasters.size();
CHeightGridWrapped::CGridElem ge;
ge.Z = z;
for(sint y = 0; y < numRasters; ++y)
{
ge.Y = y + minY;
const CPolygon2D::TRaster &r = _Rasters[y];
for (ge.X = r.first; ge.X <= r.second; ++ge.X)
{
_ZGridWrapped.insert(ge);
if (ge.X >= _PosX && ge.X < _PosX + (sint) _GridSize &&
ge.Y >= _PosY && ge.Y < _PosY + (sint) _GridSize
)
{
_ZGrid(ge.X - _PosX, ge.Y - _PosY) = std::max(z, _ZGrid(ge.X - _PosX, ge.Y - _PosY));
}
}
}
}
//***********************************************************************************
void CHeightGrid::removeTri(const CVector2f corners[3], float z)
{
_Tri.Vertices.resize(3);
_Tri.Vertices[0] = corners[0];
_Tri.Vertices[1] = corners[1];
_Tri.Vertices[2] = corners[2];
sint minY;
_Tri.computeBorders(_Rasters, minY);
if (_Rasters.empty()) return;
sint numRasters = _Rasters.size();
CHeightGridWrapped::CGridElem ge;
ge.Z = z;
for(sint y = 0; y < numRasters; ++y)
{
ge.Y = y + minY;
const CPolygon2D::TRaster &r = _Rasters[y];
for (ge.X = r.first; ge.X <= r.second; ++ge.X)
{
_ZGridWrapped.remove(ge);
}
}
}
//***********************************************************************************
CHeightGrid::CHeightGrid()
{
_CellSize = 0.f;
_GridSize = 0;
_MinZ = HEIGHT_GRID_MIN_Z;
_PosX = 0;
_PosY = 0;
_SizeMask = 0;
_InvCellSize = 1.f;
updateBBox();
}
//***********************************************************************************
void CHeightGrid::init(float cellSize, uint heightGridSize, uint wrappedHeightGridSize, float minZ)
{
nlassert(cellSize > 0.f);
nlassert(heightGridSize > 0);
nlassert(NLMISC::isPowerOf2(heightGridSize));
nlassert(NLMISC::isPowerOf2(wrappedHeightGridSize));
_ZGrid.init(heightGridSize, heightGridSize, minZ);
_ZGridWrapped.init(wrappedHeightGridSize, cellSize);
_MinZ = minZ;
_CellSize = cellSize;
_GridSize = heightGridSize;
_InvCellSize = 1.f / _CellSize;
updateBBox();
}
//***********************************************************************************
void CHeightGrid::updateBBox()
{
_BBox.setMinMax(CVector(_PosX * _CellSize, _PosY * _CellSize, _MinZ),
CVector((_PosX + _GridSize) * _CellSize, (_PosY + _GridSize) * _CellSize, -_MinZ));
}
//***********************************************************************************
void CHeightGrid::update(const CVector &newPos)
{
if (_CellSize == 0.f) return;
sint newX = (sint) floorf(newPos.x / _CellSize) - (_GridSize >> 1);
sint newY = (sint) floorf(newPos.y / _CellSize) - (_GridSize >> 1);
if (newX == _PosX && newY == _PosY) return;
// compute displacement of the grid
sint offsetX = _PosX - newX;
sint offsetY = _PosY - newY;
// compute parts of the grid that have been discarded
_ZGrid.getDiscardRects(offsetX, offsetY, _UpdateRects);
for(uint k = 0; k < _UpdateRects.size(); ++k)
{
discardRect(_UpdateRects[k]);
}
_ZGrid.move(offsetX, offsetY);
updateBBox();
// compute parts of the grid that must be updated
_ZGrid.getUpdateRects(offsetX, offsetY, _UpdateRects);
_PosX = newX;
_PosY = newY;
for(uint k = 0; k < _UpdateRects.size(); ++k)
{
updateRect(_UpdateRects[k]);
}
}
//***********************************************************************************
void CHeightGrid::addCollisionMesh(const UVisualCollisionManager::CMeshInstanceColInfo &colMesh)
{
const std::vector<CVector> &vertices = colMesh.Mesh.getVertices();
_CurrMeshVertices.resize(vertices.size());
std::vector<CVector>::const_iterator src, srcEnd;
std::vector<CVector>::iterator dest;
srcEnd = _CurrMeshVertices.end();
dest = _CurrMeshVertices.begin();
// transform vertices in world
for (src = vertices.begin(); src != srcEnd; ++ src)
{
*dest = *colMesh.WorldMatrix * *src;
++ dest;
}
std::vector<uint16> tris = colMesh.Mesh.getTriangles();
uint triSize = tris.size();
uint currVert = 0;
// Insert tri in the grid
// Because of low resolution, only a few tri will actually be inserted
while (currVert != triSize)
{
const CVector &v0 = _CurrMeshVertices[tris[currVert]];
const CVector &v1 = _CurrMeshVertices[tris[currVert + 1]];
const CVector &v2 = _CurrMeshVertices[tris[currVert + 2]];
// project corners in 2D
CVector2f corners[3];
corners[0].set(v0.x, v0.y);
corners[1].set(v1.x, v1.y);
corners[2].set(v2.x, v2.y);
addTri(corners, maxof(v0.z, v1.z, v2.z));
currVert += 3;
}
_Meshs[colMesh.ID] = colMesh;
}
//***********************************************************************************
void CHeightGrid::removeCollisionMesh(uint id)
{
TColMeshMap::iterator it = _Meshs.find(id);
if (it == _Meshs.end()) return;
const std::vector<CVector> &vertices = it->second.Mesh.getVertices();
_CurrMeshVertices.resize(vertices.size());
std::vector<CVector>::const_iterator src, srcEnd;
std::vector<CVector>::iterator dest;
srcEnd = vertices.end();
dest = _CurrMeshVertices.begin();
// transform vertices in world
const CMatrix &worldMat = *(it->second.WorldMatrix);
for (src = vertices.begin(); src != srcEnd; ++ src)
{
*dest = worldMat * *src;
++ dest;
}
std::vector<uint16> tris = it->second.Mesh.getTriangles();
uint triSize = tris.size();
uint currVert = 0;
while (currVert != triSize)
{
const CVector v0 = _CurrMeshVertices[tris[currVert]];
const CVector v1 = _CurrMeshVertices[tris[currVert + 1]];
const CVector v2 = _CurrMeshVertices[tris[currVert + 2]];
// project corners in 2D
CVector2f corners[3];
corners[0].set(v0.x, v0.y);
corners[1].set(v1.x, v1.y);
corners[2].set(v2.x, v2.y);
removeTri(corners, maxof(v0.z, v1.z, v2.z));
currVert += 3;
}
_Meshs.erase(it);
}
//***********************************************************************************
void CHeightGrid::updateRect(const NLMISC::CRect &rect)
{
// add incoming meshs into the quad grid
CAABBox bbox;
bbox.setMinMax(CVector(rect.X * _CellSize, rect.Y * _CellSize, _MinZ), CVector((rect.X + rect.Width) * _CellSize, (rect.Y + rect.Height) * _CellSize, - _MinZ));
CollisionManager->getMeshs(bbox, _UpdateMeshs);
for(uint k = 0; k < _UpdateMeshs.size(); ++k)
{
if (_Meshs.count(_UpdateMeshs[k].ID) == 0)
{
// not already inserted
addCollisionMesh(_UpdateMeshs[k]);
}
}
// Update height grid from the values in the quad grid
for (uint y = (uint) rect.Y; y < (uint) (rect.Y + rect.Height); ++y)
{
for (uint x = (uint) rect.X; x < (uint) (rect.X + rect.Width); ++x)
{
updateCell(x, y);
}
}
}
//***********************************************************************************
void CHeightGrid::discardRect(const CRect &rect)
{
// remove meshs that are totally out of the grid
CAABBox bbox;
bbox.setMinMax(CVector(rect.X * _CellSize, rect.Y * _CellSize, _MinZ), CVector((rect.X + rect.Width) * _CellSize, (rect.Y + rect.Width) * _CellSize, - _MinZ));
CollisionManager->getMeshs(bbox, _UpdateMeshs);
for(uint k = 0; k < _UpdateMeshs.size(); ++k)
{
if (!_UpdateMeshs[k].WorldBBox->intersect(_BBox))
{
removeCollisionMesh(_UpdateMeshs[k].ID); // remove mesh (no-op if already removed)
}
}
}
//***********************************************************************************
void CHeightGrid::updateCell(sint px, sint py)
{
sint worldX = px + _PosX;
sint worldY = py + _PosY;
float z = _MinZ;
const CHeightGridWrapped::TGridElemList &pl = _ZGridWrapped.getGridElemList(worldX, worldY);
for(CHeightGridWrapped::TGridElemList::const_iterator it = pl.begin(); it != pl.end(); ++it)
{
const CHeightGridWrapped::CGridElem &ge = *it;
if (ge.X == worldX && ge.Y == worldY)
{
z = std::max(z, ge.Z);
}
}
_ZGrid(px, py) = z;
}
//***********************************************************************************
void CHeightGrid::display(NL3D::UDriver &drv) const
{
extern UCamera MainCam;
drv.setModelMatrix(CMatrix::Identity);
drv.setViewMatrix(MainCam.getMatrix().inverted());
drv.setFrustum(MainCam.getFrustum());
UMaterial m = drv.createMaterial();
m.initUnlit();
m.setColor(CRGBA::Red);
for (sint y = _PosY; y < (sint) (_PosY + _GridSize - 1); ++y)
{
for (sint x = _PosX; x < (sint) (_PosX + _GridSize - 1); ++x)
{
float z0 = _ZGrid(x - _PosX, y - _PosY);
float z1 = _ZGrid(x + 1 - _PosX, y - _PosY);
float z2 = _ZGrid(x + 1 - _PosX, y + 1 - _PosY);
float z3 = _ZGrid(x - _PosX, y + 1 - _PosY);
//
CVector pos[4];
CVector pos0 = gridCoordToWorld(x, y) + z0 * CVector::K;
CVector pos1 = gridCoordToWorld(x + 1, y) + z1 * CVector::K;
CVector pos2 = gridCoordToWorld(x + 1, y + 1) + z2 * CVector::K;
CVector pos3 = gridCoordToWorld(x, y + 1) + z3 * CVector::K;
drv.drawLine(CLine(pos0, pos1), m);
drv.drawLine(CLine(pos1, pos2), m);
drv.drawLine(CLine(pos2, pos3), m);
drv.drawLine(CLine(pos3, pos0), m);
}
}
m.setColor(CRGBA::Green);
// draw dots of the point grid
//for (sint y = 0; y < (sint) _PointGrid.getSize(); ++y)
//{
// for (sint x = 0; x < (sint) _PointGrid.getSize(); ++x)
// {
// const CPointGrid::TPointList &pl = _PointGrid.getPointList(x ,y);
// for(CPointGrid::TPointList::const_iterator it = pl.begin(); it != pl.end(); ++it)
// {
// drv.drawLine(CLine(*it, *it + CVector::K), m);
// }
// }
//}
drv.deleteMaterial(m);
// info : check max size of vectors
nlwarning("Max list length = %d", (int) _ZGridWrapped.getListMaxLength());
}
////////////////
// CPointGrid //
////////////////
//*********************************************************************************
CHeightGridWrapped::CHeightGridWrapped()
{
_CellSize = 0.f;
_SizeMask = 0;
_InvCellSize = 1.f;
}
//*********************************************************************************
uint CHeightGridWrapped::getListMaxLength() const
{
uint sizeMax = 0;
for(CArray2D<TGridElemList>::const_iterator it = _Grid.begin(); it != _Grid.end(); ++it)
{
sizeMax = std::max(sizeMax, (uint) it->size());
}
return sizeMax;
}
//*********************************************************************************
void CHeightGridWrapped::init(uint size, float cellSize)
{
nlassert(cellSize > 0.f)
nlassert(NLMISC::isPowerOf2(size));
uint sizePower= NLMISC::getPowerOf2(size);
_SizeMask = (1 << sizePower) - 1;
_CellSize = cellSize;
_InvCellSize = 1.f / _CellSize;
_Grid.init(size, size);
}
*/
//=====================================================================
CPrecipitationClipGrid::CPrecipitationClipGrid()
{
clear();
touch();
}
//=====================================================================
void CPrecipitationClipGrid::initGrid(uint size, float gridEltSizeX, float gridEltSizeY)
{
if (gridEltSizeX <= 0.f || gridEltSizeY <= 0.f || size == 0)
{
clear();
return;
}
_Grid.clear();
_Grid.resize((size + 1) * (size + 1));
_XPos = 0;
_YPos = 0;
_EltSizeX = gridEltSizeX;
_EltSizeY = gridEltSizeY;
_Size = size;
}
//=====================================================================
void CPrecipitationClipGrid::updateGrid(const NLMISC::CVector &/* userPos */, NLPACS::UGlobalRetriever * /* gr */)
{
// temp
return;
//
/*
if (_EltSizeX == 0.f) return;
sint newX = (sint) floorf(userPos.x / _EltSizeX) - (_Size >> 1);
sint newY = (sint) floorf(userPos.y / _EltSizeY) - (_Size >> 1);
if (_Touched)
{
#if defined(NL_CPU_INTEL) && defined(NL_DEBUG)
CSimpleClock clock;
CSimpleClock::init();
clock.start();
#endif
// recompute the whole grid
updateGridPart(newX, newY, 0, 0, _Size + 1, _Size + 1, gr);
#if defined(NL_CPU_INTEL) && defined(NL_DEBUG)
clock.stop();
// display number of millisecond needed for the update
double freq = (double) CSystemInfo::getProcessorFrequency();
double msPerTick = 1000 / (double) freq;
nldebug("Updated precipitation clip grid : time = %.2f ms", (float) (clock.getNumTicks() * msPerTick));
// display the height in the clip grid
printGridValues();
#endif
// update pos
_XPos = newX;
_YPos = newY;
_Touched = false;
return;
}
if (newX == _XPos && newY == _YPos)
{
return; // the grid hasn't changed its pos
}
// move the grid
sint offsetX = newX - _XPos;
sint offsetY = newY - _YPos;
moveGrid(- offsetX, - offsetY);
// complete new positions
#if defined(NL_CPU_INTEL) && defined(NL_DEBUG)
CSimpleClock clock;
CSimpleClock::init();
clock.start();
#endif
// Update right or left part.
if (newX > _XPos) // moved right ?
{
// the width to update
uint width = std::min((uint) offsetX, _Size + 1);
// the the grid moved top or bottom, exclude this part
sint height = _Size + 1 - abs(offsetY);
if (height > 0)
{
// complete column on the right
updateGridPart(newX + _Size + 1 - width, newY - offsetY, _Size + 1 - width, std::max(-offsetY, 0), width, height, gr);
}
}
else if (newX < _XPos) // moved left ?
{
// the width to update
uint width = std::min((uint) (- offsetX), _Size + 1);
// the the grid moved top or bottom, exclude
sint height = _Size + 1 - abs(offsetY);
if (height > 0)
{
// complete column on the right
updateGridPart(newX, newY - offsetY, 0, std::max(-offsetY, 0), width, height, gr);
}
}
// update top or bottom part
if (newY > _YPos)
{
sint height = std::min((uint) offsetY, _Size + 1);
updateGridPart(newX, newY + _Size + 1 - height, 0, _Size + 1 - height, _Size + 1, height, gr);
}
else
if (newY < _YPos)
{
sint height = std::min((uint) (- offsetY), _Size + 1);
updateGridPart(newX, newY, 0, 0, _Size + 1, height, gr);
}
#if defined(NL_CPU_INTEL) && defined(NL_DEBUG)
clock.stop();
// display number of millisecond needed for the update
double freq = (double) CSystemInfo::getProcessorFrequency();
double msPerTick = 1000 / (double) freq;
nldebug("Updated precipitation clip grid : time = %.2f ms", (float) (clock.getNumTicks() * msPerTick));
// display the height in the clip grid
printGridValues();
#endif
// update pos
_XPos = newX;
_YPos = newY;
*/
}
//=====================================================================
void CPrecipitationClipGrid::printGridValues() const
{
for(uint k = 0; k <= _Size; ++k)
{
std::string outStr;
for(uint l = 0; l <= _Size; ++l)
{
TGrid::const_iterator gridIt = getGridIt(_Grid, l, k, _Size);
outStr += toString("%5d%c ", (uint) gridIt->MeanHeight, l == _Size ? ' ' : ',');
}
nlinfo(outStr.c_str());
}
}
//=====================================================================
void CPrecipitationClipGrid::moveGrid(sint offsetX, sint offsetY)
{
static TGrid otherGrid; // the grid is likely to be rather small so it's ok to keep it static
otherGrid.resize(_Grid.size());
// get start pos in the source
uint srcX, srcY;
sint width, height;
// compute position in source & size
if (offsetX > 0)
{
srcX = 0;
width = (_Size + 1) - offsetX;
}
else
{
srcX = -offsetX;
width = (_Size + 1) - srcX;
}
if (offsetY > 0)
{
srcY = 0;
height = (_Size + 1) - offsetY;
}
else
{
srcY = -offsetY;
height = (_Size + 1) - srcY;
}
if (width > 0 && height > 0)
{
TGrid::const_iterator srcIt = getGridIt(_Grid, srcX, srcY, _Size);
TGrid::iterator dstIt = getGridIt(otherGrid, srcX + offsetX, srcY + offsetY, _Size);
do
{
// copy one row of the grid
std::copy(srcIt, srcIt + width, dstIt);
// go to next row for source & destination
srcIt += (_Size + 1);
dstIt += (_Size + 1);
}
while (--height);
_Grid.swap(otherGrid); // replace previous grid
}
}
//=====================================================================
const CPrecipitationClipGrid::CGridPoint *CPrecipitationClipGrid::get(sint x, sint y) const
{
// pos in the grid
sint gx = x - _XPos;
sint gy = y - _YPos;
if ((uint) gx > (_Size + 1) || (uint) gy > (_Size + 1)) return NULL;
return &(*getGridIt(_Grid, gx, gy, _Size));
}
//=====================================================================
void CPrecipitationClipGrid::clear()
{
_XPos = 0;
_YPos = 0;
_Size = 0;
_EltSizeX = 0;
_EltSizeY = 0;
_Grid.clear();
}
//=====================================================================
void CPrecipitationClipGrid::updateGridPart(sint worldX, sint worldY, uint gridX, uint gridY, uint width, uint height, NLPACS::UGlobalRetriever *gr)
{
nlassert(gridX <= _Size);
nlassert(gridY <= _Size);
nlassert(gridX + width >= gridX && gridX + width <= _Size + 1);
nlassert(gridY + height >= gridY && gridY + height <= _Size + 1);
NLMISC::CVector worldPos(worldX * _EltSizeX, worldY * _EltSizeY, 10000.f);
TGrid::iterator dest = getGridIt(_Grid, gridX, gridY, _Size);
// fill each row
for (uint y = 0; y < height; ++y)
{
TGrid::iterator currDest = dest;
NLMISC::CVector currWorldPos = worldPos;
// fill a row
for (uint x = 0; x < width; ++x)
{
if (!gr)
{
currDest->Clipped = true;
currDest->MeanHeight = 0.f;
}
else
{
// build a global position
NLPACS::UGlobalPosition gpos = gr->retrievePosition(currWorldPos, 20000.f);
if (gpos.InstanceId != -1)
{
// is it an interior ?
if (gr->isInterior(gpos))
{
currDest->Clipped = true;
currDest->MeanHeight = 0.f;
}
else
{
// get mean height at this point
currDest->Clipped = false;
currDest->MeanHeight = gr->getMeanHeight(gpos);
}
}
else
{
currDest->MeanHeight = 0.f;
}
}
++ currDest;
currWorldPos.x += _EltSizeX;
}
// move to next row
dest += (_Size + 1);
currWorldPos.y += _EltSizeY;
}
}
//=====================================================================
void CPrecipitationClipGrid::display(NL3D::UDriver &drv) const
{
// get render context
CMatrix modelMat = drv.getModelMatrix();
CMatrix viewMat = drv.getViewMatrix();
CFrustum f = drv.getFrustum();
drv.setMatrixMode2D(CFrustum(0, 800, 600, 0, 0, 1, false));
const uint stepX = 16;
const uint stepY = 16;
for (uint y = 0; y < _Size + 1; ++y)
{
for (uint x = 0; x < _Size + 1; ++x)
{
TGrid::const_iterator gridPoint = getGridIt(_Grid, x, y, _Size);
CRGBA col = gridPoint->Clipped ? CRGBA::Red : CRGBA::White;
drv.drawLine((float) (x * stepX - 1), (float) (y * stepY), (float) (x * stepX + 1), (float) (y * stepY), col);
drv.drawLine((float) (x * stepX), (float) (y * stepY - 1), (float) (x * stepX), (float) (y * stepY + 1), col);
}
}
// restore render context
drv.setModelMatrix(modelMat);
drv.setViewMatrix(viewMat);
drv.setFrustum(f);
}