void insertelement(int key, int value) {
mymap::iterator it = m.find(key);
if (it == m.end()) {
Node* n = new Node(key, value);
insertathead(n);
m.insert(std::pair<int, Node*>(key, n));
if (m.size() > maxsize) {
invalidate();
}
} else {
it->second->value = value;
setused(it->second);
}
}
float Spinner::weightedSquaredErrorEstimation(sensor_msgs::PointCloud & cloud1, sensor_msgs::PointCloud & cloud2, mymap &fancyMap){
float error=squaredErrorEstimation(cloud1,cloud2,fancyMap);
error=error/fancyMap.size();
return error;
}
