revamped updateSpeeds method, now the actions taken are based on the slope between omniPersonBottomPointMean and desiredPersonPosition