Untested version of speed calculation and uniform movement