change step peak param to 0.75 again
triangulation done(need real data test)
remove trilateration iteration