New step detection algorithm implemented