added pose writer to utils and used it in sample_equal