go back to use optimalCut.m
implement the graph search in a new way (inward shooting + order perserving + high curvature compensation)
modified other files correspondingly.