Improves Cover Tree implementation

This commit is contained in:
Volodymyr Orlov
2019-09-30 08:55:41 -07:00
parent 874d528f58
commit b8e1bf9a80
2 changed files with 200 additions and 43 deletions
+198 -41
View File
@@ -1,12 +1,15 @@
use crate::math;
use crate::algorithm::neighbour::KNNAlgorithm;
use std::collections::HashMap;
use crate::algorithm::sort::heap_select::HeapSelect;
use std::collections::{HashMap, HashSet};
use std::iter::FromIterator;
use std::fmt::Debug;
use std::cmp::{PartialOrd};
use core::hash::{Hash, Hasher};
pub struct CoverTree<'a, T>
where T: Debug
{
base: f64,
max_level: i8,
min_level: i8,
@@ -18,39 +21,25 @@ impl<'a, T> CoverTree<'a, T>
where T: Debug
{
pub fn new(data: Vec<T>, distance: &'a Fn(&T, &T) -> f64) -> CoverTree<T> {
pub fn new(mut data: Vec<T>, distance: &'a Fn(&T, &T) -> f64) -> CoverTree<T> {
let mut tree = CoverTree {
base: 2f64,
max_level: 10,
min_level: 10,
max_level: 100,
min_level: 100,
distance: distance,
nodes: Vec::new()
};
for p in data {
tree.insert(p);
}
let p = tree.new_node(None, data.remove(0));
tree.construct(p, data, Vec::new(), 10);
tree
}
pub fn new_node(&mut self, data: T) -> NodeId {
let next_index = self.nodes.len();
let node_id = NodeId { index: next_index };
self.nodes.push(
Node {
index: node_id,
data: data,
parent: None,
children: HashMap::new()
});
node_id
}
fn insert(&mut self, p: T) {
pub fn insert(&mut self, p: T) {
if self.nodes.is_empty(){
self.new_node(p);
self.new_node(None, p);
} else {
let mut parent: Option<NodeId> = Option::None;
let mut p_i = 0;
@@ -59,27 +48,102 @@ where T: Debug
loop {
let i_d = self.base.powf(i as f64);
let q_p_ds = self.get_children_dist(&p, &qi_p_ds, i);
let d_p_Q = self.min_ds(&q_p_ds);
if d_p_Q < math::small_e {
let d_p_q = self.min_by_distance(&q_p_ds);
if d_p_q < math::SMALL_ERROR {
return
} else if d_p_Q > i_d {
} else if d_p_q > i_d {
break;
}
if self.min_ds(&qi_p_ds) <= self.base.powf(i as f64){
parent = q_p_ds.iter().find(|(_, d)| d <= &i_d).map(|(n, d)| n.index);
if self.min_by_distance(&qi_p_ds) <= self.base.powf(i as f64){
parent = q_p_ds.iter().find(|(_, d)| d <= &i_d).map(|(n, _)| n.index);
p_i = i;
}
qi_p_ds = q_p_ds.into_iter().filter(|(n, d)| d <= &i_d).collect();
qi_p_ds = q_p_ds.into_iter().filter(|(_, d)| d <= &i_d).collect();
i -= 1;
}
let new_node = self.new_node(p);
self.nodes.get_mut(parent.unwrap().index).unwrap().children.insert(p_i, new_node);
let new_node = self.new_node(parent, p);
self.add_child(parent.unwrap(), new_node, p_i);
self.min_level = i8::min(self.min_level, p_i-1);
}
}
pub fn new_node(&mut self, parent: Option<NodeId>, data: T) -> NodeId {
let next_index = self.nodes.len();
let node_id = NodeId { index: next_index };
self.nodes.push(
Node {
index: node_id,
data: data,
parent: parent,
children: HashMap::new()
});
node_id
}
fn split(&self, p_id: NodeId, r: f64, s1: &mut Vec<T>, s2: Option<&mut Vec<T>>) -> (Vec<T>, Vec<T>){
let mut my_near = (Vec::new(), Vec::new());
my_near = self.split_remove_s(p_id, r, s1, my_near);
for s in s2 {
my_near = self.split_remove_s(p_id, r, s, my_near);
}
return my_near
}
fn split_remove_s(&self, p_id: NodeId, r: f64, s: &mut Vec<T>, mut my_near: (Vec<T>, Vec<T>)) -> (Vec<T>, Vec<T>){
if s.len() > 0 {
let p = &self.nodes.get(p_id.index).unwrap().data;
let mut i = 0;
while i != s.len() {
let d = (self.distance)(p, &s[i]);
if d <= r {
my_near.0.push(s.remove(i));
} else if d > r && d <= 2f64 * r{
my_near.1.push(s.remove(i));
} else {
i += 1;
}
}
}
return my_near
}
fn construct<'b>(&mut self, p: NodeId, mut near: Vec<T>, mut far: Vec<T>, i: i8) -> (NodeId, Vec<T>) {
if near.len() < 1{
self.min_level = std::cmp::min(self.min_level, i);
return (p, far);
} else {
let (my, n) = self.split(p, self.base.powf((i-1) as f64), &mut near, None);
let (pi, mut near) = self.construct(p, my, n, i-1);
while near.len() > 0 {
let q_data = near.remove(0);
let nn = self.new_node(Some(p), q_data);
let (my, n) = self.split(nn, self.base.powf((i-1) as f64), &mut near, Some(&mut far));
let (child, mut unused) = self.construct(nn, my, n, i-1);
self.add_child(pi, child, i);
let new_near_far = self.split(p, self.base.powf(i as f64), &mut unused, None);
near.extend(new_near_far.0);
far.extend(new_near_far.1);
}
self.min_level = std::cmp::min(self.min_level, i);
return (pi, far);
}
}
fn add_child(&mut self, parent: NodeId, node: NodeId, i: i8){
self.nodes.get_mut(parent.index).unwrap().children.insert(i, node);
}
fn root(&self) -> &Node<T> {
self.nodes.first().unwrap()
}
@@ -98,19 +162,70 @@ where T: Debug
}
fn min_ds(&self, q_p_ds: &Vec<(&Node<T>, f64)>) -> f64 {
q_p_ds.into_iter().min_by(|(_, d1), (_, d2)| d1.partial_cmp(d2).unwrap()).unwrap().1
fn min_k_by_distance(&self, q_p_ds: &mut Vec<(&Node<T>, f64)>, k: usize) -> f64 {
let mut heap = HeapSelect::with_capacity(k);
for (_, d) in q_p_ds {
heap.add(d);
}
heap.sort();
*heap.get().pop().unwrap()
}
fn min_p_ds(&self, q_p_ds: &mut Vec<(&Node<T>, f64)>, k: usize) -> f64 {
q_p_ds.sort_by(|(_, d1), (_, d2)| d1.partial_cmp(d2).unwrap());
q_p_ds[..usize::min(q_p_ds.len(), k)].last().unwrap().1
fn min_by_distance(&self, q_p_ds: &Vec<(&Node<T>, f64)>) -> f64 {
q_p_ds.into_iter().min_by(|(_, d1), (_, d2)| d1.partial_cmp(d2).unwrap()).unwrap().1
}
fn get_child(&self, node: &Node<T>, i: i8) -> Option<&Node<T>> {
node.children.get(&i).and_then(|n_id| self.nodes.get(n_id.index))
}
#[allow(dead_code)]
fn check_invariant(&self, invariant: fn(&CoverTree<T>, &Vec<&Node<T>>, &Vec<&Node<T>>, i8) -> ()) {
let mut current_nodes: Vec<&Node<T>> = Vec::new();
current_nodes.push(self.root());
for i in (self.min_level..self.max_level+1).rev() {
let mut next_nodes: Vec<&Node<T>> = Vec::new();
next_nodes.extend(current_nodes.iter());
next_nodes.extend(current_nodes.iter().flat_map(|n| self.get_child(n, i)));
invariant(self, &current_nodes, &next_nodes, i);
current_nodes = next_nodes
}
}
#[allow(dead_code)]
fn nesting_invariant(_: &CoverTree<T>, nodes: &Vec<&Node<T>>, next_nodes: &Vec<&Node<T>>, _: i8) {
let nodes_set: HashSet<&Node<T>> = HashSet::from_iter(nodes.into_iter().map(|n| *n));
let next_nodes_set: HashSet<&Node<T>> = HashSet::from_iter(next_nodes.into_iter().map(|n| *n));
for n in nodes_set.iter() {
assert!(next_nodes_set.contains(n), "Nesting invariant of the cover tree is not satisfied. Set of nodes [{:?}] is not a subset of [{:?}]", nodes_set, next_nodes_set);
}
}
#[allow(dead_code)]
fn covering_tree(tree: &CoverTree<T>, nodes: &Vec<&Node<T>>, next_nodes: &Vec<&Node<T>>, i: i8) {
let mut p_selected: Vec<&Node<T>> = Vec::new();
for p in next_nodes {
for q in nodes {
if (tree.distance)(&p.data, &q.data) <= tree.base.powf(i as f64) {
p_selected.push(*p);
}
}
let c = p_selected.iter().filter(|q| p.parent.map(|p| q.index == p).unwrap_or(false)).count();
assert!(c <= 1);
}
}
#[allow(dead_code)]
fn separation(tree: &CoverTree<T>, nodes: &Vec<&Node<T>>, _: &Vec<&Node<T>>, i: i8) {
for p in nodes {
for q in nodes {
if p != q {
assert!((tree.distance)(&p.data, &q.data) > tree.base.powf(i as f64));
}
}
}
}
}
impl<'a, T> KNNAlgorithm<T> for CoverTree<'a, T>
@@ -121,15 +236,15 @@ where T: Debug
for i in (self.min_level..self.max_level+1).rev() {
let i_d = self.base.powf(i as f64);
let mut q_p_ds = self.get_children_dist(&p, &qi_p_ds, i);
let d_p_q = self.min_p_ds(&mut q_p_ds, k);
qi_p_ds = q_p_ds.into_iter().filter(|(n, d)| d <= &(d_p_q + i_d)).collect();
let d_p_q = self.min_k_by_distance(&mut q_p_ds, k);
qi_p_ds = q_p_ds.into_iter().filter(|(_, d)| d <= &(d_p_q + i_d)).collect();
}
qi_p_ds.sort_by(|(_, d1), (_, d2)| d1.partial_cmp(d2).unwrap());
qi_p_ds[..usize::min(qi_p_ds.len(), k)].iter().map(|(n, _)| n.index.index).collect()
}
}
#[derive(Debug, Clone, Copy)]
#[derive(Debug, Clone, Copy, PartialEq)]
pub struct NodeId {
index: usize,
}
@@ -142,6 +257,24 @@ struct Node<T> {
parent: Option<NodeId>
}
impl<T> PartialEq for Node<T> {
fn eq(&self, other: &Self) -> bool {
self.index.index == other.index.index
}
}
impl<T> Eq for Node<T> {}
impl<T> Hash for Node<T> {
fn hash<H>(&self, state: &mut H)
where
H: Hasher,
{
state.write_usize(self.index.index);
state.finish();
}
}
#[cfg(test)]
mod tests {
@@ -149,13 +282,37 @@ mod tests {
#[test]
fn cover_tree_test() {
let data = vec!(1, 2, 3, 4, 5, 6, 7, 8, 9);
let distance = |a: &i32, b: &i32| -> f64 {
(a - b).abs() as f64
};
let mut tree = CoverTree::<i32>::new(data, &distance);
for d in vec!(10, 11, 12, 13, 14, 15, 16, 17, 18, 19) {
tree.insert(d);
}
let mut nearest_3_to_5 = tree.find(&5, 3);
nearest_3_to_5.sort();
assert_eq!(vec!(3, 4, 5), nearest_3_to_5);
let mut nearest_3_to_15 = tree.find(&15, 3);
nearest_3_to_15.sort();
assert_eq!(vec!(13, 14, 15), nearest_3_to_15);
assert_eq!(-1, tree.min_level);
assert_eq!(100, tree.max_level);
}
#[test]
fn test_invariants(){
let data = vec!(1, 2, 3, 4, 5, 6, 7, 8, 9);
let distance = |a: &i32, b: &i32| -> f64 {
(a - b).abs() as f64
};
let tree = CoverTree::<i32>::new(data, &distance);
let nearest_3 = tree.find(&5, 3);
assert_eq!(vec!(4, 5, 3), nearest_3);
tree.check_invariant(CoverTree::nesting_invariant);
tree.check_invariant(CoverTree::covering_tree);
tree.check_invariant(CoverTree::separation);
}
}
+1 -1
View File
@@ -1,3 +1,3 @@
pub mod distance;
pub static small_e:f64 = 0.000000001f64;
pub static SMALL_ERROR:f64 = 0.0000000000000001f64;