void TrajectoryVisualization::setColor(const base::Vector3d& color)
{
{ boost::mutex::scoped_lock lockit(this->updateMutex);
this->color = osg::Vec4(color.x(), color.y(), color.z(), 1.0); }
emit propertyChanged("Color");
setDirty();
}
void TrajectoryVisualization::updateDataIntern( const base::Vector3d& data )
{
if(doClear)
{
points.clear();
doClear = false;
}
Point p;
p.point = osg::Vec3(data.x(), data.y(), data.z());
p.color = color;
points.push_back(p);
while(points.size() > max_number_of_points)
points.pop_front();
}