Return agent pos/rot as reference, removed old unused code