Added frame id to pose