Fixed some calculation problems.
Modified closest point format to be used to other calculation.