Prevent run into a wall situations. This looks weird. Make unit stand instead. Make unit move their legs depend on it position, but not what keys player press. This also can resolve infantry sliding to new position caused by lag in multiplayer. It will just go to new position by moving his legs.