reshaped action space
small cost function correction for straight walking