Update position->pos_t in robot header file