Added penalty velocity and repositioning for particles that get stuck in solids