Added qselect and swap functions.

These functions will be used to build an optimal KD-Tree.
Refactor of the Point class.