+changed floting matrices to double
+removed static feature
+added distransformation variable and function to compute it
stable pose voting without correct vote sphere