fix bug in step calculation with non zero floor
Merge pull request #15 from prajwalkman/stepping_floor_fix

fix bug in step calculation with non zero floor