Fixed:moving though walls when planning