fix pos and vel frames for multi-robots