https://123dok.net/document/z3d237my-multiple-shape-registration-using-constrained-optimal-control.html