Added final_piece_poses && 2. publisher tread to nou.cpp