Made data all in the same frame even in simulation. Data now as though it is in PR2's head kinct frame when warping.