KD-Tree Search Tree with multi-objective costs. The first release was accounting for the manipulability of the robot