1) fix some comment
2) add pairwise distance function
3) add new bezier fitting test, try to avoid huge B matrix by calulate B line by line for each sample time t,
    this could speed up fitting a bit and solve memory problem