added id to manipulation plan, small changes to pick and place