cost_matrix_diagonal_weighted_cpp function

(C++) Compute Orthogonal and Weighted Diagonal Least Cost Matrix from a Distance Matrix