step length estimation code for 1119data

10% error