all stuff moved to robot reference frame