void
LinearLineOfSightNode::compute(osg::Node* node, bool backgroundThread)
{
if ( !getMapNode() )
return;
if (!_start.isValid() || !_end.isValid() )
{
return;
}
if (_start != _end)
{
const SpatialReference* mapSRS = getMapNode()->getMapSRS();
const Terrain* terrain = getMapNode()->getTerrain();
//Computes the LOS and redraws the scene
if (!_start.transform(mapSRS).toWorld( _startWorld, terrain ) || !_end.transform(mapSRS).toWorld( _endWorld, terrain ))
{
return;
}
DPLineSegmentIntersector* lsi = new DPLineSegmentIntersector(_startWorld, _endWorld);
osgUtil::IntersectionVisitor iv( lsi );
node->accept( iv );
DPLineSegmentIntersector::Intersections& hits = lsi->getIntersections();
if ( hits.size() > 0 )
{
_hasLOS = false;
_hitWorld = hits.begin()->getWorldIntersectPoint();
_hit.fromWorld( mapSRS, _hitWorld );
}
else
{
_hasLOS = true;
}
}
draw(backgroundThread);
for( LOSChangedCallbackList::iterator i = _changedCallbacks.begin(); i != _changedCallbacks.end(); i++ )
{
i->get()->onChanged();
}
}
void
RadialLineOfSightNode::compute_fill(osg::Node* node)
{
if ( !getMapNode() )
return;
GeoPoint centerMap;
_center.transform( getMapNode()->getMapSRS(), centerMap );
centerMap.toWorld( _centerWorld, getMapNode()->getTerrain() );
bool isProjected = getMapNode()->getMapSRS()->isProjected();
osg::Vec3d up = isProjected ? osg::Vec3d(0,0,1) : osg::Vec3d(_centerWorld);
up.normalize();
//Get the "side" vector
osg::Vec3d side = isProjected ? osg::Vec3d(1,0,0) : up ^ osg::Vec3d(0,0,1);
//Get the number of spokes
double delta = osg::PI * 2.0 / (double)_numSpokes;
osg::Geometry* geometry = new osg::Geometry;
geometry->setUseVertexBufferObjects(true);
osg::Vec3Array* verts = new osg::Vec3Array();
verts->reserve(_numSpokes * 2);
geometry->setVertexArray( verts );
osg::Vec4Array* colors = new osg::Vec4Array();
colors->reserve( _numSpokes * 2 );
geometry->setColorArray( colors );
geometry->setColorBinding(osg::Geometry::BIND_PER_VERTEX);
osg::ref_ptr<osgUtil::IntersectorGroup> ivGroup = new osgUtil::IntersectorGroup();
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
double angle = delta * (double)i;
osg::Quat quat(angle, up );
osg::Vec3d spoke = quat * (side * _radius);
osg::Vec3d end = _centerWorld + spoke;
osg::ref_ptr<DPLineSegmentIntersector> dplsi = new DPLineSegmentIntersector( _centerWorld, end );
ivGroup->addIntersector( dplsi.get() );
}
osgUtil::IntersectionVisitor iv;
iv.setIntersector( ivGroup.get() );
node->accept( iv );
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
//Get the current hit
DPLineSegmentIntersector* los = dynamic_cast<DPLineSegmentIntersector*>(ivGroup->getIntersectors()[i].get());
DPLineSegmentIntersector::Intersections& hits = los->getIntersections();
osg::Vec3d currEnd = los->getEnd();
bool currHasLOS = hits.empty();
osg::Vec3d currHit = currHasLOS ? osg::Vec3d() : hits.begin()->getWorldIntersectPoint();
//Get the next hit
unsigned int nextIndex = i + 1;
if (nextIndex == _numSpokes) nextIndex = 0;
DPLineSegmentIntersector* losNext = static_cast<DPLineSegmentIntersector*>(ivGroup->getIntersectors()[nextIndex].get());
DPLineSegmentIntersector::Intersections& hitsNext = losNext->getIntersections();
osg::Vec3d nextEnd = losNext->getEnd();
bool nextHasLOS = hitsNext.empty();
osg::Vec3d nextHit = nextHasLOS ? osg::Vec3d() : hitsNext.begin()->getWorldIntersectPoint();
if (currHasLOS && nextHasLOS)
{
//Both rays have LOS
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _goodColor );
}
else if (!currHasLOS && !nextHasLOS)
{
//Both rays do NOT have LOS
//Draw the "good triangle"
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextHit - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currHit - _centerWorld );
colors->push_back( _goodColor );
//Draw the two bad triangles
verts->push_back( currHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _badColor );
}
else if (!currHasLOS && nextHasLOS)
{
//Current does not have LOS but next does
//Draw the good portion
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currHit - _centerWorld );
colors->push_back( _goodColor );
//Draw the bad portion
verts->push_back( currHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _badColor );
}
else if (currHasLOS && !nextHasLOS)
{
//Current does not have LOS but next does
//Draw the good portion
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextHit - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _goodColor );
//Draw the bad portion
verts->push_back( nextHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _badColor );
}
}
geometry->addPrimitiveSet(new osg::DrawArrays(GL_TRIANGLES, 0, verts->size()));
osg::Geode* geode = new osg::Geode();
geode->addDrawable( geometry );
getOrCreateStateSet()->setMode(GL_LIGHTING, osg::StateAttribute::OFF);
getOrCreateStateSet()->setMode(GL_BLEND, osg::StateAttribute::ON);
osg::MatrixTransform* mt = new osg::MatrixTransform;
mt->setMatrix(osg::Matrixd::translate(_centerWorld));
mt->addChild(geode);
//Remove all the children
removeChildren(0, getNumChildren());
addChild( mt );
for( LOSChangedCallbackList::iterator i = _changedCallbacks.begin(); i != _changedCallbacks.end(); i++ )
{
i->get()->onChanged();
}
}
void
RadialLineOfSightNode::compute_line(osg::Node* node)
{
if ( !getMapNode() )
return;
GeoPoint centerMap;
_center.transform( getMapNode()->getMapSRS(), centerMap );
centerMap.toWorld( _centerWorld, getMapNode()->getTerrain() );
bool isProjected = getMapNode()->getMapSRS()->isProjected();
osg::Vec3d up = isProjected ? osg::Vec3d(0,0,1) : osg::Vec3d(_centerWorld);
up.normalize();
//Get the "side" vector
osg::Vec3d side = isProjected ? osg::Vec3d(1,0,0) : up ^ osg::Vec3d(0,0,1);
//Get the number of spokes
double delta = osg::PI * 2.0 / (double)_numSpokes;
osg::Geometry* geometry = new osg::Geometry;
geometry->setUseVertexBufferObjects(true);
osg::Vec3Array* verts = new osg::Vec3Array();
verts->reserve(_numSpokes * 5);
geometry->setVertexArray( verts );
osg::Vec4Array* colors = new osg::Vec4Array();
colors->reserve( _numSpokes * 5 );
geometry->setColorArray( colors );
geometry->setColorBinding(osg::Geometry::BIND_PER_VERTEX);
osg::Vec3d previousEnd;
osg::Vec3d firstEnd;
osg::ref_ptr<osgUtil::IntersectorGroup> ivGroup = new osgUtil::IntersectorGroup();
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
double angle = delta * (double)i;
osg::Quat quat(angle, up );
osg::Vec3d spoke = quat * (side * _radius);
osg::Vec3d end = _centerWorld + spoke;
osg::ref_ptr<DPLineSegmentIntersector> dplsi = new DPLineSegmentIntersector( _centerWorld, end );
ivGroup->addIntersector( dplsi.get() );
}
osgUtil::IntersectionVisitor iv;
iv.setIntersector( ivGroup.get() );
node->accept( iv );
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
DPLineSegmentIntersector* los = dynamic_cast<DPLineSegmentIntersector*>(ivGroup->getIntersectors()[i].get());
DPLineSegmentIntersector::Intersections& hits = los->getIntersections();
osg::Vec3d start = los->getStart();
osg::Vec3d end = los->getEnd();
osg::Vec3d hit;
bool hasLOS = hits.empty();
if (!hasLOS)
{
hit = hits.begin()->getWorldIntersectPoint();
}
if (hasLOS)
{
verts->push_back( start - _centerWorld );
verts->push_back( end - _centerWorld );
colors->push_back( _goodColor );
colors->push_back( _goodColor );
}
else
{
if (_displayMode == LineOfSight::MODE_SPLIT)
{
verts->push_back( start - _centerWorld );
verts->push_back( hit - _centerWorld );
colors->push_back( _goodColor );
colors->push_back( _goodColor );
verts->push_back( hit - _centerWorld );
verts->push_back( end - _centerWorld );
colors->push_back( _badColor );
colors->push_back( _badColor );
}
else if (_displayMode == LineOfSight::MODE_SINGLE)
{
verts->push_back( start - _centerWorld );
verts->push_back( end - _centerWorld );
colors->push_back( _badColor );
colors->push_back( _badColor );
}
}
if (i > 0)
{
verts->push_back( end - _centerWorld );
verts->push_back( previousEnd - _centerWorld );
colors->push_back( _outlineColor );
colors->push_back( _outlineColor );
}
else
{
firstEnd = end;
}
previousEnd = end;
}
//Add the last outside of circle
verts->push_back( firstEnd - _centerWorld );
verts->push_back( previousEnd - _centerWorld );
colors->push_back( osg::Vec4(1,1,1,1));
colors->push_back( osg::Vec4(1,1,1,1));
geometry->addPrimitiveSet(new osg::DrawArrays(GL_LINES, 0, verts->size()));
osg::Geode* geode = new osg::Geode();
geode->addDrawable( geometry );
getOrCreateStateSet()->setMode(GL_LIGHTING, osg::StateAttribute::OFF);
osg::MatrixTransform* mt = new osg::MatrixTransform;
mt->setMatrix(osg::Matrixd::translate(_centerWorld));
mt->addChild(geode);
//Remove all the children
removeChildren(0, getNumChildren());
addChild( mt );
for( LOSChangedCallbackList::iterator i = _changedCallbacks.begin(); i != _changedCallbacks.end(); i++ )
{
i->get()->onChanged();
}
}
void
RadialLineOfSightNode::compute_fill(osg::Node* node, bool backgroundThread)
{
if ( !getMapNode() )
return;
//Get the center point in geocentric
if (_altitudeMode == ALTMODE_ABSOLUTE)
{
GeoPoint centerMap(getMapNode()->getMapSRS(), _center, ALTMODE_ABSOLUTE);
centerMap.toWorld( _centerWorld, getMapNode()->getTerrain() );
//_mapNode->getMap()->toWorldPoint( centerMap, _centerWorld );
}
else
{
getRelativeWorld(_center.x(), _center.y(), _center.z(), _mapNode.get(), _centerWorld );
}
osg::Vec3d up = osg::Vec3d(_centerWorld);
up.normalize();
//Get the "side" vector
osg::Vec3d side = up ^ osg::Vec3d(0,0,1);
//Get the number of spokes
double delta = osg::PI * 2.0 / (double)_numSpokes;
osg::Geometry* geometry = new osg::Geometry;
geometry->setUseVertexBufferObjects(true);
osg::Vec3Array* verts = new osg::Vec3Array();
verts->reserve(_numSpokes * 2);
geometry->setVertexArray( verts );
osg::Vec4Array* colors = new osg::Vec4Array();
colors->reserve( _numSpokes * 2 );
geometry->setColorArray( colors );
geometry->setColorBinding(osg::Geometry::BIND_PER_VERTEX);
osgSim::LineOfSight los;
los.setDatabaseCacheReadCallback(0);
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
double angle = delta * (double)i;
osg::Quat quat(angle, up );
osg::Vec3d spoke = quat * (side * _radius);
osg::Vec3d end = _centerWorld + spoke;
los.addLOS( _centerWorld, end);
}
los.computeIntersections(node);
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
//Get the current hit
osg::Vec3d currEnd = los.getEndPoint(i);
bool currHasLOS = los.getIntersections(i).empty();
osg::Vec3d currHit = currHasLOS ? osg::Vec3d() : *los.getIntersections(i).begin();
unsigned int nextIndex = i + 1;
if (nextIndex == _numSpokes) nextIndex = 0;
//Get the current hit
osg::Vec3d nextEnd = los.getEndPoint(nextIndex);
bool nextHasLOS = los.getIntersections(nextIndex).empty();
osg::Vec3d nextHit = nextHasLOS ? osg::Vec3d() : *los.getIntersections(nextIndex).begin();
if (currHasLOS && nextHasLOS)
{
//Both rays have LOS
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _goodColor );
}
else if (!currHasLOS && !nextHasLOS)
{
//Both rays do NOT have LOS
//Draw the "good triangle"
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextHit - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currHit - _centerWorld );
colors->push_back( _goodColor );
//Draw the two bad triangles
verts->push_back( currHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _badColor );
}
else if (!currHasLOS && nextHasLOS)
{
//Current does not have LOS but next does
//Draw the good portion
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currHit - _centerWorld );
colors->push_back( _goodColor );
//Draw the bad portion
verts->push_back( currHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _badColor );
}
else if (currHasLOS && !nextHasLOS)
{
//Current does not have LOS but next does
//Draw the good portion
verts->push_back( _centerWorld - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( nextHit - _centerWorld );
colors->push_back( _goodColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _goodColor );
//Draw the bad portion
verts->push_back( nextHit - _centerWorld );
colors->push_back( _badColor );
verts->push_back( nextEnd - _centerWorld );
colors->push_back( _badColor );
verts->push_back( currEnd - _centerWorld );
colors->push_back( _badColor );
}
}
geometry->addPrimitiveSet(new osg::DrawArrays(GL_TRIANGLES, 0, verts->size()));
osg::Geode* geode = new osg::Geode();
geode->addDrawable( geometry );
getOrCreateStateSet()->setMode(GL_LIGHTING, osg::StateAttribute::OFF);
getOrCreateStateSet()->setMode(GL_BLEND, osg::StateAttribute::ON);
osg::MatrixTransform* mt = new osg::MatrixTransform;
mt->setMatrix(osg::Matrixd::translate(_centerWorld));
mt->addChild(geode);
if (!backgroundThread)
{
//Remove all the children
removeChildren(0, getNumChildren());
addChild( mt );
}
else
{
_pendingNode = mt;
}
for( LOSChangedCallbackList::iterator i = _changedCallbacks.begin(); i != _changedCallbacks.end(); i++ )
{
i->get()->onChanged();
}
}
void
RadialLineOfSightNode::compute_line(osg::Node* node, bool backgroundThread)
{
if ( !getMapNode() )
return;
GeoPoint( getMapNode()->getMapSRS(), _center, _altitudeMode ).toWorld( _centerWorld, getMapNode()->getTerrain() );
osg::Vec3d up = osg::Vec3d(_centerWorld);
up.normalize();
//Get the "side" vector
osg::Vec3d side = up ^ osg::Vec3d(0,0,1);
//Get the number of spokes
double delta = osg::PI * 2.0 / (double)_numSpokes;
osg::Geometry* geometry = new osg::Geometry;
geometry->setUseVertexBufferObjects(true);
osg::Vec3Array* verts = new osg::Vec3Array();
verts->reserve(_numSpokes * 5);
geometry->setVertexArray( verts );
osg::Vec4Array* colors = new osg::Vec4Array();
colors->reserve( _numSpokes * 5 );
geometry->setColorArray( colors );
geometry->setColorBinding(osg::Geometry::BIND_PER_VERTEX);
osg::Vec3d previousEnd;
osg::Vec3d firstEnd;
osgSim::LineOfSight los;
los.setDatabaseCacheReadCallback(0);
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
double angle = delta * (double)i;
osg::Quat quat(angle, up );
osg::Vec3d spoke = quat * (side * _radius);
osg::Vec3d end = _centerWorld + spoke;
los.addLOS( _centerWorld, end);
}
los.computeIntersections(node);
for (unsigned int i = 0; i < (unsigned int)_numSpokes; i++)
{
osg::Vec3d start = los.getStartPoint(i);
osg::Vec3d end = los.getEndPoint(i);
osgSim::LineOfSight::Intersections hits = los.getIntersections(i);
osg::Vec3d hit;
bool hasLOS = hits.empty();
if (!hasLOS)
{
hit = *hits.begin();
}
if (hasLOS)
{
verts->push_back( start - _centerWorld );
verts->push_back( end - _centerWorld );
colors->push_back( _goodColor );
colors->push_back( _goodColor );
}
else
{
if (_displayMode == LineOfSight::MODE_SPLIT)
{
verts->push_back( start - _centerWorld );
verts->push_back( hit - _centerWorld );
colors->push_back( _goodColor );
colors->push_back( _goodColor );
verts->push_back( hit - _centerWorld );
verts->push_back( end - _centerWorld );
colors->push_back( _badColor );
colors->push_back( _badColor );
}
else if (_displayMode == LineOfSight::MODE_SINGLE)
{
verts->push_back( start - _centerWorld );
verts->push_back( end - _centerWorld );
colors->push_back( _badColor );
colors->push_back( _badColor );
}
}
if (i > 0)
{
verts->push_back( end - _centerWorld );
verts->push_back( previousEnd - _centerWorld );
colors->push_back( _outlineColor );
colors->push_back( _outlineColor );
}
else
{
firstEnd = end;
}
previousEnd = end;
}
//Add the last outside of circle
verts->push_back( firstEnd - _centerWorld );
verts->push_back( previousEnd - _centerWorld );
colors->push_back( osg::Vec4(1,1,1,1));
colors->push_back( osg::Vec4(1,1,1,1));
geometry->addPrimitiveSet(new osg::DrawArrays(GL_LINES, 0, verts->size()));
osg::Geode* geode = new osg::Geode();
geode->addDrawable( geometry );
getOrCreateStateSet()->setMode(GL_LIGHTING, osg::StateAttribute::OFF);
osg::MatrixTransform* mt = new osg::MatrixTransform;
mt->setMatrix(osg::Matrixd::translate(_centerWorld));
mt->addChild(geode);
if (!backgroundThread)
{
//Remove all the children
removeChildren(0, getNumChildren());
addChild( mt );
}
else
{
_pendingNode = mt;
}
for( LOSChangedCallbackList::iterator i = _changedCallbacks.begin(); i != _changedCallbacks.end(); i++ )
{
i->get()->onChanged();
}
}