Added more complex distance functions, renamed old distance to distance_simple
Added more complex distance functions, renamed old distance to distance_simple

krishauser/Klampt,krishauser/Klampt,krishauser/Klampt,krishauser/Klampt,krishauser/Klampt,krishauser/Klampt