fixed dirty transform bugs

This fixes 3 places where the benchmarks_gui crashes because of dirty transforms if you build in Debug mode.  If you build in Release mode, it doesn't crash but the markers show up at 0,0,0 instead of the end-effector.