fixed dirty transform bugs
Merge pull request #363 from ros-planning/fix-dirty-transforms

fixed dirty transform bugs