everything works but insert is O(nlogn) not O(n)
got the heap to work, started on cosine