Merge pull request #27 from BFALacerda/master

trying to avoid planning through walls bug