/* -----------------------------------------------------------------------
   See COPYRIGHT.TXT and LICENSE.TXT for copyright and license information
   ----------------------------------------------------------------------- */
#include "plmsegment_config.h"
#include <list>
#include <stdio.h>
#include <stdlib.h>

#include "itkImageMaskSpatialObject.h"
#include "itkVotingBinaryIterativeHoleFillingImageFilter.h"

#include "dir_list.h"
#include "dice_statistics.h"
#include "distance_map.h"
#include "file_util.h"
#include "hausdorff_distance.h"
#include "itk_adjust.h"
#include "itk_bbox.h"
#include "itk_crop.h"
#include "itk_resample.h"
#include "itk_image_save.h"
#include "itk_threshold.h"
#include "logfile.h"
#include "mabs.h"
#include "mabs_atlas_selection.h"
#include "mabs_parms.h"
#include "mabs_staple.h"
#include "mabs_stats.h"
#include "mabs_vote.h"
#include "option_range.h"
#include "path_util.h"
#include "plm_image.h"
#include "plm_image_header.h"
#include "plm_timer.h"
#include "plm_warp.h"
#include "print_and_exit.h"
#include "registration.h"
#include "registration_data.h"
#include "registration_parms.h"
#include "rt_study.h"
#include "rtss.h"
#include "segmentation.h"
#include "string_util.h"
#include "xform.h"
#include "zcrop.h"
class Mabs_private {
public:
    /* These are the input parameters */
    const Mabs_parms *parms;
 
    /* Store the executed command */
    std::string executed_command;
    
    /* traindir_base is the output directory when we are 
       doing a training task (i.e. not labeling), and is of the form:
       ".../train_dir */
    std::string traindir_base;

    /* ".../train_dir/convert" */
    std::string convert_dir;
    /* ".../train_dir/prealign" */
    std::string prealign_dir;
    /* prealign_dir, if it exists.  Otherwise, convert_dir */
    std::string preprocessed_dir;
    /* ".../train_dir/atlas-train" */
    std::string atlas_train_dir;
    /* ".../train_dir/mabs-train" */
    std::string mabs_train_dir;

    /* segment_input_fn is the input file (img.nrrd) for a segmentation task */
    std::string segment_input_fn;
    /* segmentation_fn is the input directory for a segmentation task */
    std::string segmentation_fn;
    /* outdir_base is the output directory when we are 
       doing a labeling task (i.e. not training) */
    std::string segment_outdir_base;

    /* registration_list is the list of registration parameter files */
    std::list<std::string> registration_list;
    /* output_dir is ??? */
    std::string output_dir;

    /* Binary structure used to align the center of gravity */
    Plm_image::Pointer input_roi_for_cog_prealignment;

    /* String containing the roi file name passed by command line */
    std::string prealign_roi_cmd_name;
    
    /* process_dir_list is a list of the input directories which 
       need to be processed, one directory per case
       - during the atlas_convert stage, it is the list of 
       original (dicom) atlas directories
       - during the atlas_prealign stage, it is the list of 
       converted atlas directories
       - <need more detail here for later stages>
    */
    std::list<std::string> process_dir_list;

    /* There is one reference image at a time, which is the 
       image we are segmenting. */
    std::string ref_id;
    Rt_study::Pointer ref_rtds;
    std::list<std::string> atlas_list;

    /* Select atlas parameters */
    std::map<std::string, std::list<std::pair<std::string, double> > 
        > selected_atlases_train;

    std::list<std::pair<std::string, double> > selected_atlases;

    /* Convert parameters */
    bool convert_resample;
    float convert_spacing[3];

    /* Prealign parameters */
    bool prealign_resample;
    float prealign_spacing[3];

    /* Utility class for keeping track of statistics */
    Mabs_stats stats;

    /* Segmentation parameters */
    std::string registration_id;
    
    /* While segmenting an image, we sometimes loop through 
       the structures for evaluation.  This holds the 
       binary image of the current structure which we are 
       evaluating. */
    bool have_ref_structure;
    UCharImageType::Pointer ref_structure_image;

    /* This configures the trainer to evaluate segmentation parameters,
       it is set to false when --train-registration is used */
    bool train_segmentation;
    /* This configures the trainer to display and write segmentation results,
       it is set to true when --segmentation is used */
    bool segmentation;
    /* Decide whether distance map should be computed during the 
       main registration loop */
    bool compute_distance_map;

    /* You can set these variables to save some intermediate data 
       for debugging and tuning */
    bool write_weight_files;
    bool write_thresholded_files;
    bool write_distance_map_files;
    bool write_registration_files;
    bool write_warped_images;
    /* This is used when creating a final segmentation */
    bool write_dicom_rt_struct;
    
    /* While looping through atlases, the gaussin voting/staple information is stored here */
    std::map<std::string, Mabs_vote*> vote_map;
    std::map<std::string, Mabs_staple*> staple_map;

    /* Store timing information for performance evaluation */
    double time_atlas_selection;
    double time_dmap;
    double time_extract;
    double time_io;
    double time_reg;
    double time_vote;
    double time_staple;
    double time_warp_img;
    double time_warp_str;

    /* Z crop values */
    float zcrop_vec[2];

public:
    Mabs_private () {
        parms = 0;
        train_segmentation = true;
        have_ref_structure = false;
        convert_resample = false;
        prealign_resample = false;
        segmentation = false;
        registration_id = "";

        ref_rtds = Rt_study::New ();

        compute_distance_map = true;
        write_weight_files = false;
        write_thresholded_files = true;
        write_distance_map_files = true;
        write_registration_files = true;
        write_warped_images = true;
        write_dicom_rt_struct = false;

        this->reset_timers ();

	for (int i = 0; i < 2; i++) {
            zcrop_vec[i] = 0.f;
	}

    }
    void reset_timers () {
        time_atlas_selection = 0;
        time_dmap = 0;
        time_extract = 0;
        time_io = 0;
        time_reg = 0;
        time_vote = 0;
        time_staple = 0;
        time_warp_img = 0;
        time_warp_str = 0;
    }
    void clear_vote_map () {
        std::map<std::string, Mabs_vote*>::iterator it;
        for (it = vote_map.begin(); it != vote_map.end(); ++it) {
            delete it->second;
        }
        vote_map.clear ();
    }
    void clear_staple_map () {
        std::map<std::string, Mabs_staple*>::iterator it;
        for (it = staple_map.begin(); it != staple_map.end(); ++it) {
            delete it->second;
        }
        staple_map.clear ();
    }

public:
    void print_structure_map ();
    std::string map_structure_name (const std::string& ori_name);
    void extract_reference_image (const std::string& mapped_name);
    std::string extract_and_crop_reference (
        UCharImageType::Pointer& structure_image,
        const std::string& mapped_name);
    void segmentation_threshold_weight (
        const std::string& label_output_dir, 
        FloatImageType::Pointer weight_image, 
        const std::string& mapped_name, 
        const std::string& structure_label, 
        const Mabs_seg_weights* msw,
        float thresh_val);
};

/* Print out structure map */
void
Mabs_private::print_structure_map ()
{
    std::map<std::string, std::string>::const_iterator it;
    for (it = this->parms->structure_map.begin ();
         it != this->parms->structure_map.end (); 
         it++)
    {
        lprintf ("SM> %s\n", (*it).first.c_str());
    }
}

/* Map an input-specific structure name to a canonical structure name 
   Return "" if no canonical name */
std::string
Mabs_private::map_structure_name (
    const std::string& ori_name)
{
    if (this->parms->structure_map.size() == 0) {
        lprintf (" > no structure list specified\n");
        return ori_name;
    }

    std::map<std::string, std::string>::const_iterator it 
        = this->parms->structure_map.find (ori_name);
    if (it == this->parms->structure_map.end()) {
        lprintf (" > irrelevant structure: %s\n", ori_name.c_str());
        return "";
    }

    const std::string& mapped_name = it->second;
    if (mapped_name == "") {
        lprintf (" > irrelevant structure: %s\n", ori_name.c_str());
    }
    else if (mapped_name == ori_name) {
        lprintf (" > relevant structure: %s\n", ori_name.c_str());
    }
    else {
        lprintf (" > relevant structure: %s -> %s\n", 
            ori_name.c_str(), mapped_name.c_str());
    }
    return mapped_name;
}

/* Extract reference structure as binary mask, and save into the 
   variable d_ptr->ref_structure_image.
   This image is used when computing dice statistics. 

   GCS FIX: This is inefficient, it could be extracted 
   once at the beginning, and cached. */
void
Mabs_private::extract_reference_image (const std::string& mapped_name)
{
    this->have_ref_structure = false;
    Segmentation::Pointer rtss = this->ref_rtds->get_segmentation();
    if (!rtss) {
        return;
    }
    for (size_t j = 0; j < rtss->get_num_structures(); j++)
    {
        std::string ref_ori_name 
            = rtss->get_structure_name (j);
        std::string ref_mapped_name 
            = this->map_structure_name (ref_ori_name);
        if (ref_mapped_name == mapped_name) {
            lprintf ("Extracting %d, %s\n", j, ref_ori_name.c_str());
            this->ref_structure_image = rtss->get_structure_image (j);
            this->have_ref_structure = true;
            break;
        }
    }
}

std::string
Mabs_private::extract_and_crop_reference (
    UCharImageType::Pointer& structure_image,
    const std::string& mapped_name)
{
    Plm_timer timer;

    /* Extract reference structure as binary mask. */
    timer.start();
    lprintf ("Extracting reference image (%s)\n",
        mapped_name.c_str());
    this->extract_reference_image (mapped_name);
    lprintf ("Done extracting reference image.\n");
    this->time_extract += timer.report();

    if (this->have_ref_structure) {
        if (this->parms->structure_zcrop.count(mapped_name) > 0) {
            std::string zcrop1 
                = this->parms->structure_zcrop.at(mapped_name);
            //std::cout << zcrop1 << std::endl;
            std::stringstream ss(zcrop1);
            for (int i = 0; i < 2; i++) {
                ss >> this->zcrop_vec[i];
            }
            zcrop (structure_image, this->ref_structure_image, this->zcrop_vec);
        }	
        /* Compute Dice, etc. */
        timer.start();

        std::string stats_string 
            = this->stats.compute_statistics (
                registration_id,
                this->ref_structure_image,
                structure_image);
        timer.start();
        return stats_string;
    }
    return std::string();
}


void
Mabs_private::segmentation_threshold_weight (
    const std::string& label_output_dir, 
    FloatImageType::Pointer weight_image, 
    const std::string& mapped_name, 
    const std::string& structure_label,
    const Mabs_seg_weights* msw,
    float thresh_val
)
{
    Plm_timer timer; 
    Rt_study rtds;
    /* Threshold the weight image */
    timer.start();
    UCharImageType::Pointer thresh_img = itk_threshold_above (
        weight_image, thresh_val);
    std::string seg_dice_log_fn; 
    /* Fill holes and remove islands from the computed contour 
     * PAOLO ZAFFINO July 3th 2015 */
       
    typedef itk::VotingBinaryIterativeHoleFillingImageFilter<UCharImageType>  MorphologicalFilterType;
    
    MorphologicalFilterType::Pointer closing_filter = MorphologicalFilterType::New();
    MorphologicalFilterType::Pointer island_removing_filter = MorphologicalFilterType::New();
    
    UCharImageType::SizeType indexRadius;
    indexRadius[0] = 1; 
    indexRadius[1] = 1; 
    indexRadius[2] = 1; 
    
    closing_filter->SetRadius(indexRadius);
    island_removing_filter->SetRadius(indexRadius);

    closing_filter->SetBackgroundValue(0);
    closing_filter->SetForegroundValue(1);
    closing_filter->SetMajorityThreshold(2);
    closing_filter->SetMaximumNumberOfIterations(3);
    
    island_removing_filter->SetBackgroundValue(1);
    island_removing_filter->SetForegroundValue(0);
    island_removing_filter->SetMajorityThreshold(1);
    island_removing_filter->SetMaximumNumberOfIterations(3);
    
    closing_filter->SetInput(thresh_img);
    closing_filter->Update();
    
    island_removing_filter->SetInput(closing_filter->GetOutput());
    island_removing_filter->Update();

    UCharImageType::Pointer clean_structure = island_removing_filter->GetOutput();

    this->time_vote += timer.report();

    /* Optionally, save the thresholded files */
    if (this->write_thresholded_files) {
        lprintf ("Saving thresholded structures\n");
        std::string thresh_img_fn = string_format (
            "%s/%s_thresh_%f.nrrd", 
            label_output_dir.c_str(), 
            structure_label.c_str(), 
            thresh_val);
        timer.start();

        itk_image_save (clean_structure, thresh_img_fn.c_str());
        this->time_io += timer.report();
    }
        
    /* If we are training, zcrop the reference structure */
    this->extract_and_crop_reference (clean_structure, mapped_name);

    /* Compute Dice, etc. */
    if (this->have_ref_structure) {
        /* Compute statistics */
        std::string stats_string = this->stats.compute_statistics (
            "segmentation", /* Not used yet */
            this->ref_structure_image,
            clean_structure);
        if (this->segmentation) {
	    ref_id = segmentation_fn;
        }
	std::string seg_log_string = string_format (
            "target=%s,reg=%s,struct=%s,"
            "rho=%f,sigma=%f,minsim=%f,thresh=%f,"
            "%s\n",
            this->ref_id.c_str(),
            this->registration_id.c_str(),
            mapped_name.c_str(),
            msw->rho,
            msw->sigma,
            msw->minsim,
            thresh_val,
            stats_string.c_str());
        lprintf ("%s", seg_log_string.c_str());

        /* Update seg_dice file */
	/* If --segmentation is used update the seg_dice file in the output directory 
	 * else update the seg_dice in the training directory */
	if (!this->segmentation) {
       	seg_dice_log_fn = string_format (
            "%s/seg_dice.csv",
            this->mabs_train_dir.c_str());
        }
	else {
        seg_dice_log_fn = string_format (
            "%s/seg_dice.csv",
            label_output_dir.c_str());
        }
        FILE *fp = fopen (seg_dice_log_fn.c_str(), "a");
        fprintf (fp, "%s", seg_log_string.c_str());
        fclose (fp);
    }

    /* Or, if we don't have the reference image, then we might 
       want to add it to the referenced rt_study, so it can 
       be saved as a final segmentation. */
    else if (this->write_dicom_rt_struct) {
        this->ref_rtds->add_structure (
            clean_structure,
            mapped_name.c_str(),
            0);
    }
}

Mabs::Mabs () {
    d_ptr = new Mabs_private;
}

Mabs::~Mabs () {
    delete d_ptr;
}

void
Mabs::load_process_dir_list (const std::string& dir)
{
    /* Clear process_dir_list to avoid multiple entries in case of multiple
     * calls to this function */
    d_ptr->process_dir_list.clear();

    Dir_list d (dir);
    for (int i = 0; i < d.num_entries; i++)
    {
        /* Skip "." and ".." */
        if (!strcmp (d.entries[i], ".") || !strcmp (d.entries[i], "..")) {
            continue;
        }

        /* Build string containing full path to atlas item */
        std::string path = compose_filename (dir, d.entries[i]);

        /* Only consider directories */
        if (!is_directory (path.c_str())) {
            continue;
        }

        /* Add directory to atlas_dir_list */
        d_ptr->process_dir_list.push_back (path);
    }

    lprintf ("Found %d cases to process from directory %s\n",
        d_ptr->process_dir_list.size(), dir.c_str());
}

bool
Mabs::check_seg_checkpoint (std::string folder)
{

    std::string seg_checkpoint_fn = string_format (
        "%s/checkpoint.txt", folder.c_str());
    if (file_exists (seg_checkpoint_fn)) {
        lprintf ("Segmentation complete for %s\n",
            folder.c_str());
        return true;
    }
    else {
        return false;
    }
}

/* ------------------------------------------------------------------------- *
   This function runs a registration for a group of atlases against 
   a single reference image.
 * ------------------------------------------------------------------------- *
   The following variables should be set before running this:
   d_ptr->ref_rtds           the fixed image and its structure set
   d_ptr->atlas_list         list of images that should be registred
   d_ptr->output_dir         directory containing output results
                             (e.g. .../prealign or .../mabs-train)
   d_ptr->registration_list  list of registration command files
 * ------------------------------------------------------------------------- */
void
Mabs::run_registration_loop ()
{
    Plm_timer timer;

    /* Loop through images in the atlas */
    std::list<std::string>::iterator atl_it;
    for (atl_it = d_ptr->atlas_list.begin();
         atl_it != d_ptr->atlas_list.end(); atl_it++)
    {
        Rt_study rtds;
        std::string path = *atl_it;
        std::string input_dir = dirname (path);
        std::string atlas_id = basename (path);
        printf ("%s\n -> %s\n -> %s\n",
            path.c_str(), input_dir.c_str(), atlas_id.c_str());
        std::string atlas_input_path = string_format ("%s/%s",
            input_dir.c_str(), atlas_id.c_str());
        std::string atlas_output_path = string_format ("%s/%s",
            d_ptr->output_dir.c_str(), atlas_id.c_str());

        /* Load image & structures from "prep" directory */
        timer.start();
        rtds.load_rt_study_dir (atlas_input_path);
        d_ptr->time_io += timer.report();

        /* Inspect the structures -- we might be able to skip the 
           atlas if it has no relevant structures */
        bool can_skip = true;
        Segmentation::Pointer rtss = rtds.get_segmentation();
        for (size_t i = 0; i < rtss->get_num_structures(); i++) {
            std::string ori_name = rtss->get_structure_name (i);
            std::string mapped_name = d_ptr->map_structure_name (ori_name);
            if (mapped_name != "") {
                can_skip = false;
                break;
            }
        }
        if (can_skip) {
            lprintf ("No relevant structures. Skipping.\n");
            continue;
        }

        /* Loop through each registration parameter set */
        std::list<std::string>::iterator reg_it;
        for (reg_it = d_ptr->registration_list.begin(); 
             reg_it != d_ptr->registration_list.end(); reg_it++) 
        {
            /* Set up files & directories for this job */
            std::string command_file = *reg_it;
            std::string curr_output_dir;
            std::string registration_id;
            registration_id = basename (command_file);
            curr_output_dir = string_format ("%s/%s",
                atlas_output_path.c_str(),
                registration_id.c_str());

            /* Check if this registration is already complete.
               We might be able to skip it. */
            std::string reg_checkpoint_fn = string_format (
                "%s/checkpoint.txt", curr_output_dir.c_str());
            if (file_exists (reg_checkpoint_fn)) {
                lprintf ("Registration parms complete for %s\n",
                    curr_output_dir.c_str());
                continue;
            }

            /* Set up the registration data structure */
            Registration reg;
            Registration_parms::Pointer regp = reg.get_registration_parms ();
            Registration_data::Pointer regd = reg.get_registration_data ();

            /* Parse the registration command string */
            std::string command_string = slurp_file (command_file);
            int rc = reg.set_command_string (command_string);
            if (rc != PLM_SUCCESS) {
                lprintf ("Skipping command file \"%s\" "
                    "due to parse error.\n", command_file.c_str());
                continue;
            }

            /* Give some feedback about which registration we are 
               going to run */
            lprintf ("** TASK: %s %s %s\n",
                d_ptr->ref_id.c_str(),
                atlas_id.c_str(),
                registration_id.c_str());

            /* Set input files */
            Plm_image::Pointer fixed_image = Plm_image::New ();
            fixed_image->set_itk (
                d_ptr->ref_rtds->get_image()->itk_float());
            reg.set_fixed_image (fixed_image);
            Plm_image::Pointer moving_image = Plm_image::New ();
            moving_image->set_itk (
                rtds.get_image()->itk_float());
            reg.set_moving_image (moving_image);
            
            /* PAOLO ZAFFINO: align centers of gravity */
            if (d_ptr->input_roi_for_cog_prealignment) {
                
                /* Add STAGE only if a segment command is executed. 
		 * Is it needed or we can define it into the 
		 * configuration file? */
                std::string command_string_plus_cog = 
			"[STAGE]\nxform=align_center_of_gravity\n";
                command_string_plus_cog.append(command_string);
                int rc_cog = reg.set_command_string (command_string_plus_cog);
                if (rc_cog != PLM_SUCCESS) {
                    lprintf ("Skipping centers of gravity prealignment addition to command file \"%s\" \n", 
				    command_file.c_str());
                    continue;
                }
             
                /* Set fixed ROI */
                reg.set_fixed_roi(d_ptr->input_roi_for_cog_prealignment); 
               
                /* Set moving ROI*/ 
                std::string target_roi_name;
                if (d_ptr->executed_command == "segment") {
                    target_roi_name = strip_extension(basename(d_ptr->prealign_roi_cmd_name));
                }
                else if (d_ptr->executed_command == "prealign") {
                    target_roi_name = d_ptr->parms->prealign_roi_cfg_name;
                }

                size_t target_roi_index = -1;
                for (size_t i = 0; i < rtss->get_num_structures(); i++) {
                    std::string struct_name = rtss->get_structure_name (i);

                    if (struct_name == target_roi_name) {
                        target_roi_index = i;
                        break;
                    }
                }
                if (target_roi_index != -1) {
                    Plm_image::Pointer moving_roi = Plm_image::New ();
                    moving_roi->set_itk (rtss->get_structure_image (target_roi_index));
                    reg.set_moving_roi(moving_roi);
                }
                else if (target_roi_index == -1) {
                    lprintf("No moving ROI set!\n");
                }
            }

            /* Run the registration */
            lprintf ("DO_REGISTRATION_PURE\n");
            lprintf ("regp->num_stages = %d\n", regp->num_stages);
            timer.start();
            Xform::Pointer xf_out = reg.do_registration_pure ();
            d_ptr->time_reg += timer.report();

            /* Warp the output image */
            lprintf ("Warp output image...\n");
            Plm_image_header fixed_pih (fixed_image);
            Plm_image::Pointer warped_image = Plm_image::New();
            timer.start();

            /* Using the hardened transform for linear transforms 
               does not seem to work well in this case.  See issue #58. */
            plm_warp (warped_image, 0, xf_out, &fixed_pih, 
                moving_image, 
                regp->default_value, true, 0, 1);
            d_ptr->time_warp_img += timer.report();
            
            /* Warp the structures */
            lprintf ("Warp structures...\n");
            Plm_image_header source_pih (rtds.get_image());
            timer.start();
            //rtss->warp (xf_out, &fixed_pih);
            Segmentation::Pointer warped_rtss 
                = rtss->warp_nondestructive (xf_out, &fixed_pih);
            d_ptr->time_warp_str += timer.report();

            /* Save some debugging information */
            if (d_ptr->write_registration_files) {
                timer.start();
                std::string fn;
                lprintf ("Saving registration_files\n");
                if (d_ptr->write_warped_images) {
                    fn = string_format ("%s/img.nrrd", 
                        curr_output_dir.c_str());
                    warped_image->save_image (fn.c_str());
                }
				
                /* Check whether xform is of type vector field
		 * if yes, save as xf.nrrd, else xf.txt  */
		if (xf_out->m_type == XFORM_ITK_VECTOR_FIELD ||
				xf_out->m_type == XFORM_GPUIT_VECTOR_FIELD) {
			fn = string_format ("%s/xf.nrrd", curr_output_dir.c_str());
		} else {
			fn = string_format ("%s/xf.txt", curr_output_dir.c_str());
		}
		xf_out->save (fn.c_str());

                if (d_ptr->parms->write_warped_structures) {
                    fn = string_format ("%s/structures", 
                        curr_output_dir.c_str());
                    warped_rtss->save_prefix (fn, "nrrd");
                }
                d_ptr->time_io += timer.report();
            }

            /* Loop through structures for this atlas image */
            lprintf ("Process structures...\n");
            for (size_t i = 0; i < warped_rtss->get_num_structures(); i++) {
                /* Check structure name, make sure it is something we 
                   want to segment */
                std::string ori_name = warped_rtss->get_structure_name (i);
                std::string mapped_name = d_ptr->map_structure_name (ori_name);
                if (mapped_name == "") {
                    continue;
                }

                /* Extract structure as binary mask */
                timer.start();
                UCharImageType::Pointer structure_image 
                    = warped_rtss->get_structure_image (i);
                d_ptr->time_extract += timer.report();

                /* Make the distance map */
                if (d_ptr->compute_distance_map 
                    && d_ptr->parms->fusion_criteria == "gaussian")
                {
                    timer.start();
                    lprintf ("Computing distance map...\n");
                    this->compute_dmap (structure_image,
                        curr_output_dir, mapped_name);
                }

                /* If we are training, zcrop the reference structure */
                d_ptr->extract_and_crop_reference (structure_image, mapped_name);
                    
                /* Compute Dice, etc. */
                if (!d_ptr->segmentation && d_ptr->have_ref_structure) {
                    timer.start();

                    std::string stats_string 
                        = d_ptr->stats.compute_statistics (
                            registration_id,
                            d_ptr->ref_structure_image,
                            structure_image);
                    std::string reg_log_string = string_format (
                        "target=%s,atlas=%s,reg=%s,struct=%s,%s\n",
                        d_ptr->ref_id.c_str(), 
                        atlas_id.c_str(),
                        registration_id.c_str(),
                        mapped_name.c_str(), 
                        stats_string.c_str());
                    lprintf ("%s", reg_log_string.c_str());

                    /* Update reg_dice file */
                    std::string reg_dice_log_fn = string_format (
                        "%s/reg_dice.csv",
                        d_ptr->output_dir.c_str());
                    FILE *fp = fopen (reg_dice_log_fn.c_str(), "a");
                    fprintf (fp, "%s", reg_log_string.c_str());
                    fclose (fp);
                }
            }

            /* Create checkpoint file which means that this registration
               is complete */
            touch_file (reg_checkpoint_fn);

        } /* end for each registration parameter */
    } /* end for each atlas image */
}

void
Mabs::convert (const std::string& input_dir, const std::string& output_dir)
{
    Rt_study rtds;
    Plm_timer timer;

    /* Load the rtds for the atlas */
    timer.start();
    lprintf ("MABS loading %s\n", input_dir.c_str());
    rtds.load (input_dir);
    lprintf ("MABS load complete\n");
    d_ptr->time_io += timer.report();

    /* Remove structures which are not part of the atlas */
    timer.start();
    Segmentation::Pointer seg = rtds.get_segmentation();
    seg->prune_empty ();
    Rtss *cxt = seg->get_structure_set_raw ();
    for (size_t i = 0; i < seg->get_num_structures(); i++) {
        /* Check structure name, make sure it is something we 
           want to segment */
        std::string ori_name = seg->get_structure_name (i);
        std::string mapped_name = d_ptr->map_structure_name (ori_name);
        lprintf ("Structure i (%s), checking for mapped name\n",
            ori_name.c_str());
        if (mapped_name == "") {
            /* If not, delete it (before rasterizing) */
            lprintf ("Deleted structure %s\n");
            cxt->delete_structure (i);
            --i;
            continue;
        }
        lprintf ("Resetting structure name to %s\n", mapped_name.c_str());
        seg->set_structure_name (i, mapped_name);
    }

    /* Rasterize structure set */
    Plm_image_header pih (rtds.get_image().get());
    seg->rasterize (&pih, false, false);
    d_ptr->time_extract += timer.report();

    /* If so specified, resample the images */
    if (d_ptr->convert_resample) {
        timer.start();
        rtds.resample (d_ptr->convert_spacing);
        d_ptr->time_extract += timer.report();
    }

    /* Save the image as raw files */
    timer.start();
    std::string fn = string_format ("%s/img.nrrd", output_dir.c_str());
    rtds.get_image()->save_image (fn.c_str());
    d_ptr->time_io += timer.report();

    /* Save structures which are part of the atlas */
    std::string prefix = string_format ("%s/structures", output_dir.c_str());
    seg->save_prefix (prefix, "nrrd");
    d_ptr->time_io += timer.report();
}

void
Mabs::atlas_convert ()
{
    /* Parse atlas directory */
    this->load_process_dir_list (d_ptr->parms->atlas_dir);

    /* Just a little debugging */
    d_ptr->print_structure_map ();

    /* Loop through atlas_dir, converting file formats */
    for (std::list<std::string>::iterator it = d_ptr->process_dir_list.begin();
         it != d_ptr->process_dir_list.end(); it++)
    {
        std::string input_dir = *it;
        std::string atlas_id = basename (input_dir);
        std::string output_dir = string_format (
            "%s/%s", d_ptr->convert_dir.c_str(), 
            atlas_id.c_str());

        this->convert (input_dir, output_dir);
    }
    lprintf ("Rasterization time:   %10.1f seconds\n", d_ptr->time_extract);
    lprintf ("I/O time:             %10.1f seconds\n", d_ptr->time_io);
    lprintf ("MABS prep complete\n");
}


void
Mabs::atlas_selection ()
{
    /* Create and start timer */
    Plm_timer timer;
    timer.start();

    /* Parse atlas directory */
    this->load_process_dir_list (d_ptr->preprocessed_dir);

    /* Define stuff to save ranking */
    std::list<std::pair<std::string, double> > ranked_atlases; // Only ranked, not selected
    
    std::string atlas_ranking_file_name = 
        string_format ("%s/atlas_ranking.txt", d_ptr->segment_outdir_base.c_str());
   
    bool compute_new_ranking = true;

    /* Check if a precomputed ranking (not specified by user) can be used */
    if (is_directory(d_ptr->segment_outdir_base.c_str()) &&
        file_exists(atlas_ranking_file_name.c_str()) &&
        d_ptr->parms->atlases_from_ranking != -1) {
        
        compute_new_ranking = false;
    }

    /* Create atlas-train directory */
    if (compute_new_ranking) {
        make_directory(d_ptr->segment_outdir_base.c_str());
    }

    /* Open log file for atlas selection */
    std::string atlas_selection_log_file_name = string_format ("%s/log_atlas_seletion.txt",
        d_ptr->segment_outdir_base.c_str());
    
    FILE *atlas_selection_log_file = plm_fopen (atlas_selection_log_file_name.c_str(), "w");
    
    if (atlas_selection_log_file == NULL) {
        printf("Error opening atlas selection log file!\n");
        exit(1);
    }

    /* Create object and set the parameters */
    Mabs_atlas_selection* atlas_selector = new Mabs_atlas_selection();
    atlas_selector->atlas_selection_criteria = d_ptr->parms->atlas_selection_criteria;
    atlas_selector->selection_reg_parms_fn = d_ptr->parms->selection_reg_parms_fn;
    atlas_selector->similarity_percent_threshold = d_ptr->parms->similarity_percent_threshold;
    atlas_selector->max_random_atlases = d_ptr->parms->max_random_atlases;
    atlas_selector->min_random_atlases = d_ptr->parms->min_random_atlases;
    atlas_selector->hist_bins = d_ptr->parms->mi_histogram_bins;
    atlas_selector->percentage_nmi_random_sample = d_ptr->parms->percentage_nmi_random_sample;
    atlas_selector->atlases_from_ranking = d_ptr->parms->atlases_from_ranking;
    atlas_selector->precomputed_ranking_fn = d_ptr->parms->precomputed_ranking_fn;
    atlas_selector->subject_id = d_ptr->segment_input_fn.c_str();
    atlas_selector->atlas_dir = d_ptr->parms->prealign_dir;
    atlas_selector->number_of_atlases = (int) d_ptr->process_dir_list.size();
    
    if (d_ptr->parms->roi_mask_fn != "") { /* Set the mask if defined */
        Plm_image::Pointer mask_plm = plm_image_load (d_ptr->parms->roi_mask_fn, PLM_IMG_TYPE_ITK_UCHAR);
            
        typedef itk::ImageMaskSpatialObject<3> MaskType;
        atlas_selector->mask = MaskType::New();
        atlas_selector->mask->SetImage(mask_plm->itk_uchar());
        atlas_selector->mask->Update();
    }
        
    atlas_selector->min_hist_sub_value_defined = d_ptr->parms->lower_mi_value_sub_defined;
    atlas_selector->min_hist_sub_value = d_ptr->parms->lower_mi_value_sub;
    atlas_selector->max_hist_sub_value_defined = d_ptr->parms->upper_mi_value_sub_defined;
    atlas_selector->max_hist_sub_value = d_ptr->parms->upper_mi_value_sub;
    atlas_selector->min_hist_atl_value_defined = d_ptr->parms->lower_mi_value_atl_defined;
    atlas_selector->min_hist_atl_value = d_ptr->parms->lower_mi_value_atl;
    atlas_selector->max_hist_atl_value_defined = d_ptr->parms->upper_mi_value_atl_defined;
    atlas_selector->max_hist_atl_value = d_ptr->parms->upper_mi_value_atl;
        
    /* New selection is required, execute it */
    if (compute_new_ranking) {
        
        atlas_selector->subject = plm_image_load_native(atlas_selector->subject_id);
        atlas_selector->atlas_dir_list = d_ptr->process_dir_list;

        // if set, before the selection, prealign the images (using COG or whatever else)
        if (d_ptr->parms->prealign_mode == "custom") {
            
            Registration reg; 
            Registration_parms::Pointer regp = reg.get_registration_parms ();
            Registration_data::Pointer regd = reg.get_registration_data ();
            
            /* Parse the registration command string */
            std::string command_string = slurp_file (d_ptr->parms->prealign_registration_config);
            int rc = reg.set_command_string (command_string);
            if (rc != PLM_SUCCESS) {
                lprintf ("Skipping command file \"%s\" "
                        "due to parse error.\n", d_ptr->parms->prealign_registration_config.c_str());
            }
            
            /* Set input images */
            std::string fixed_image_fn;
            fixed_image_fn = string_format ("%s/%s/img.nrrd",
                    d_ptr->convert_dir.c_str(),
                    d_ptr->parms->prealign_reference.c_str());
            Plm_image::Pointer fixed_image = Plm_image::New (fixed_image_fn);
            reg.set_fixed_image (fixed_image);
            
            Plm_image::Pointer moving_image = Plm_image::New ();
            moving_image->set_itk (atlas_selector->subject->itk_float());
            reg.set_moving_image (moving_image);
            
            /* Align centers of gravity */
            if (d_ptr->prealign_roi_cmd_name != "") {

                /* Add STAGE for COG */
                std::string command_string_plus_cog = "[STAGE]\nxform=align_center_of_gravity\n";
                command_string_plus_cog.append(command_string);
                int rc_cog = reg.set_command_string (command_string_plus_cog);
                if (rc_cog != PLM_SUCCESS) {
                    lprintf ("Skipping centers of gravity prealignment addition to command file \"%s\" \n", d_ptr->parms->prealign_registration_config.c_str());
                }
            
                /* Set moving ROI */
                d_ptr->input_roi_for_cog_prealignment = Plm_image::New (d_ptr->prealign_roi_cmd_name);    
                reg.set_moving_roi(d_ptr->input_roi_for_cog_prealignment);
            
                /* Set fixed ROI*/
                std::string fixed_roi_fn;
                fixed_roi_fn = string_format ("%s/%s/structures/%s.nrrd",
                    d_ptr->convert_dir.c_str(),
                    d_ptr->parms->prealign_reference.c_str(), 
                    d_ptr->parms->prealign_roi_cfg_name.c_str());

                Plm_image::Pointer fixed_roi = Plm_image::New (fixed_roi_fn);
                reg.set_fixed_roi(fixed_roi);
            }
        
            /* Run the registration */
            lprintf ("DO_REGISTRATION_PURE\n");
            lprintf ("regp->num_stages = %d\n", regp->num_stages);
            timer.start();
            Xform::Pointer xf_out = reg.do_registration_pure ();
            d_ptr->time_reg += timer.report();
        
            /* Warp the image */
            lprintf ("Prealign input image...\n");
            Plm_image_header fixed_pih (fixed_image);
            Plm_image::Pointer warped_image = Plm_image::New();
            timer.start();
            plm_warp (warped_image, 0, xf_out, &fixed_pih,
                moving_image,
                regp->default_value, false, 0, 1);
            d_ptr->time_warp_img += timer.report();

            atlas_selector->subject = warped_image; 

        }
        
        atlas_selector->run_selection();
    }

    /* Use a precomputed ranking */
    else if (!compute_new_ranking) {
        atlas_selector->precomputed_ranking_fn = atlas_ranking_file_name.c_str();
        atlas_selector->atlases_from_ranking = d_ptr->parms->atlases_from_ranking;
        atlas_selector->precomputed_ranking();
    }

    /* Write into the log file preliminary information about the selection process */
    fprintf(atlas_selection_log_file,
        "Patient = %s, initial atlases = %d, selection criteria = %s \n",
        atlas_selector->subject_id.c_str(),
        atlas_selector->number_of_atlases,
        atlas_selector->atlas_selection_criteria.c_str());
        
    if (!compute_new_ranking) {
        fprintf(atlas_selection_log_file,
            "SELECTION MADE USING A PRECOMPUTED RANKING\n");   
    }
        
    /* Print into the log file information about the selection process */
    fprintf(atlas_selection_log_file,
        "Selected atlases for patient %s: (%d) \n",
        atlas_selector->subject_id.c_str(),
        (int) atlas_selector->selected_atlases.size());
       
    for (std::list<std::pair<std::string, double> >::iterator it_selected_atlases =
         atlas_selector->selected_atlases.begin();
         it_selected_atlases != atlas_selector->selected_atlases.end();
         it_selected_atlases++) {
        
        fprintf(atlas_selection_log_file,
            "Atlas %s with score value equal to %f \n",
            it_selected_atlases->first.c_str(),
            it_selected_atlases->second);
    }
         
    /* Close log file */
    fclose(atlas_selection_log_file);
       
    /* Fill the structures */
    d_ptr->selected_atlases.assign(atlas_selector->selected_atlases.begin(),
                                   atlas_selector->selected_atlases.end());

    ranked_atlases.assign(atlas_selector->ranked_atlases.begin(),
                          atlas_selector->ranked_atlases.end());
   
    /* Write the new ranking */
    if (compute_new_ranking) {

        FILE *ranking_file = fopen (atlas_ranking_file_name.c_str(), "w");
       
        fprintf(ranking_file, "%s: ", atlas_selector->subject_id.c_str());
            
        /* Cycle over atlases */
        for (std::list<std::pair<std::string, double> >::iterator it_list = ranked_atlases.begin();
             it_list != ranked_atlases.end(); it_list++) {
            fprintf(ranking_file, "%s ", it_list->first.c_str());
        }

        fclose(ranking_file);
    }     
    /* Delete object */
    delete atlas_selector;

    /* Stop timer */
    d_ptr->time_atlas_selection += timer.report();

    printf("Atlas selection done! \n");
}


void
Mabs::train_atlas_selection ()
{
    /* Create and start timer */
    Plm_timer timer;
    timer.start();

    /* Parse atlas directory */
    this->load_process_dir_list (d_ptr->preprocessed_dir);

    /* Define stuff to save ranking */
    std::map<std::string, std::list<std::pair<std::string, double> > > train_ranked_atlases; // Only ranked, not selected
    
    std::string train_atlas_ranking_file_name = 
        string_format ("%s/train_atlas_ranking.txt", d_ptr->atlas_train_dir.c_str());
   
    bool compute_new_ranking = true;

    /* Check if a precomputed ranking (not specified by user) can be used */
    if (is_directory(d_ptr->atlas_train_dir.c_str()) &&
        file_exists(train_atlas_ranking_file_name.c_str()) &&
        d_ptr->parms->atlases_from_ranking != -1) {
        
        /* Count lines */
        FILE *count_lines_file = fopen (train_atlas_ranking_file_name.c_str(), "r");
        char ch;
        int lines_number = 1; /* The last line doesn't have \n */
        
        while ((ch=getc(count_lines_file)) != EOF) {
            if (ch == '\n') ++lines_number;
        }

        fclose(count_lines_file);

        /* If number of lines is equal to number of  atlases use precomputed ranking */
        if (lines_number == (int) d_ptr->process_dir_list.size()) {
            compute_new_ranking = false;
        }
    }

    /* Create atlas-train directory */
    if (compute_new_ranking) {
        make_directory(d_ptr->atlas_train_dir.c_str());
    }

    /* Open log file for atlas selection */
    std::string train_atlas_selection_log_file_name = string_format ("%s/log_train_atlas_seletion.txt",
        d_ptr->atlas_train_dir.c_str());
    
    FILE *train_atlas_selection_log_file = plm_fopen (train_atlas_selection_log_file_name.c_str(), "w");
    
    if (train_atlas_selection_log_file == NULL) {
        printf("Error opening train atlas selection log file!\n");
        exit(1);
    }

    /* Loop through atlas_dir, choosing reference images to segment */
    for (std::list<std::string>::iterator it = d_ptr->process_dir_list.begin();
         it != d_ptr->process_dir_list.end(); it++)
    {
        /* Create atlas list for this test case */
        std::string path = *it;
        d_ptr->atlas_list = d_ptr->process_dir_list;
        d_ptr->atlas_list.remove (path);

        std::string patient_id = basename (path);
        d_ptr->ref_id = patient_id;
        
        /* Load image & structures from "prep" directory */
        if (compute_new_ranking) {
            std::string fn = string_format ("%s/%s/img.nrrd", 
                d_ptr->preprocessed_dir.c_str(), patient_id.c_str());
            d_ptr->ref_rtds->load_image (fn.c_str());
        }
        
        /* Create object and set the parameters */
        Mabs_atlas_selection* train_atlas_selector = new Mabs_atlas_selection();
        train_atlas_selector->atlas_selection_criteria = d_ptr->parms->atlas_selection_criteria;
        train_atlas_selector->selection_reg_parms_fn = d_ptr->parms->selection_reg_parms_fn;
        train_atlas_selector->similarity_percent_threshold = d_ptr->parms->similarity_percent_threshold;
        train_atlas_selector->max_random_atlases = d_ptr->parms->max_random_atlases;
        train_atlas_selector->min_random_atlases = d_ptr->parms->min_random_atlases;
        train_atlas_selector->hist_bins = d_ptr->parms->mi_histogram_bins;
        train_atlas_selector->percentage_nmi_random_sample = d_ptr->parms->percentage_nmi_random_sample;
        train_atlas_selector->atlases_from_ranking = d_ptr->parms->atlases_from_ranking;
        train_atlas_selector->precomputed_ranking_fn = d_ptr->parms->precomputed_ranking_fn;
        train_atlas_selector->subject_id = patient_id;
        train_atlas_selector->atlas_dir = d_ptr->parms->atlas_dir;
        train_atlas_selector->number_of_atlases = (int) d_ptr->process_dir_list.size();
        
        if (d_ptr->parms->roi_mask_fn != "") { /* Set the mask if defined */
            Plm_image::Pointer mask_plm = plm_image_load (d_ptr->parms->roi_mask_fn, PLM_IMG_TYPE_ITK_UCHAR);
            
            typedef itk::ImageMaskSpatialObject<3> MaskType;
            train_atlas_selector->mask = MaskType::New();
            train_atlas_selector->mask->SetImage(mask_plm->itk_uchar());
            train_atlas_selector->mask->Update();
        }
        
        train_atlas_selector->min_hist_sub_value_defined = d_ptr->parms->lower_mi_value_sub_defined;
        train_atlas_selector->min_hist_sub_value = d_ptr->parms->lower_mi_value_sub;
        train_atlas_selector->max_hist_sub_value_defined = d_ptr->parms->upper_mi_value_sub_defined;
        train_atlas_selector->max_hist_sub_value = d_ptr->parms->upper_mi_value_sub;
        train_atlas_selector->min_hist_atl_value_defined = d_ptr->parms->lower_mi_value_atl_defined;
        train_atlas_selector->min_hist_atl_value = d_ptr->parms->lower_mi_value_atl;
        train_atlas_selector->max_hist_atl_value_defined = d_ptr->parms->upper_mi_value_atl_defined;
        train_atlas_selector->max_hist_atl_value = d_ptr->parms->upper_mi_value_atl;
        
        /* New selection is required, execute it */
        if (compute_new_ranking) {
            train_atlas_selector->subject = d_ptr->ref_rtds->get_image();
            train_atlas_selector->atlas_dir_list = d_ptr->process_dir_list;
            train_atlas_selector->run_selection();
        }

        /* Use a precomputed ranking */
        else if (!compute_new_ranking) {
            train_atlas_selector->precomputed_ranking_fn = train_atlas_ranking_file_name.c_str();
            train_atlas_selector->atlases_from_ranking = d_ptr->parms->atlases_from_ranking;
            train_atlas_selector->precomputed_ranking();
        }

        /* Write into the log file preliminary information about the selection process */
        fprintf(train_atlas_selection_log_file,
            "Patient = %s, initial atlases = %d, selection criteria = %s \n",
            train_atlas_selector->subject_id.c_str(),
            train_atlas_selector->number_of_atlases,
            train_atlas_selector->atlas_selection_criteria.c_str());
        
        if (!compute_new_ranking) {
            fprintf(train_atlas_selection_log_file,
                "SELECTION MADE USING A PRECOMPUTED RANKING\n");   
        }
        
        /* Print into the log file information about the selection process */
        fprintf(train_atlas_selection_log_file,
            "Selected atlases for patient %s: (%d) \n",
            train_atlas_selector->subject_id.c_str(),
            (int) train_atlas_selector->selected_atlases.size());
       
        for (std::list<std::pair<std::string, double> >::iterator it_selected_atlases =
                 train_atlas_selector->selected_atlases.begin();
             it_selected_atlases != train_atlas_selector->selected_atlases.end();
             it_selected_atlases++) {
        
            fprintf(train_atlas_selection_log_file,
                "Atlas %s with score value equal to %f \n",
                it_selected_atlases->first.c_str(),
                it_selected_atlases->second);
        }
         
        fprintf(train_atlas_selection_log_file, "\n");
        
        /* Fill the map structures */
        d_ptr->selected_atlases_train.insert(std::make_pair(train_atlas_selector->subject_id,
                train_atlas_selector->selected_atlases));

        train_ranked_atlases.insert(std::make_pair(train_atlas_selector->subject_id,
                train_atlas_selector->ranked_atlases));

        /* Delete object */
        delete train_atlas_selector;
    }

    /* Close log file */
    fclose(train_atlas_selection_log_file);
    
    /* Write the new ranking */
    if (compute_new_ranking &&
		    d_ptr->parms->precomputed_ranking_fn == "") {

        FILE *ranking_file = fopen (train_atlas_ranking_file_name.c_str(), "w");
       
        /* Cycle over reference images */
        std::map<std::string, std::list<std::pair<std::string, double> > >::iterator it_map;
        for (it_map = train_ranked_atlases.begin(); it_map != train_ranked_atlases.end(); it_map++) {
            
            fprintf(ranking_file, "%s: ", it_map->first.c_str());
            
            /* Cycle over atlases */
            for (std::list<std::pair<std::string, double> >::iterator it_list = it_map->second.begin();
                 it_list != it_map->second.end(); it_list++) {
                fprintf(ranking_file, "%s ", it_list->first.c_str());
            }

            /* If it is not the last subject write on a new line */
            if (it_map != (--train_ranked_atlases.end()))
                fprintf(ranking_file, "\n");
        }
        
        fclose(ranking_file);
    } else {
	    std::string ranking_file = train_atlas_ranking_file_name.c_str(); 
	    std::string temp = d_ptr->parms->precomputed_ranking_fn.c_str();
	    /*char c = fgetc(temp); 
	    while (c != EOF) {
		    fputc(c, ranking_file); 
		    c = fgetc(temp);
	    }*/
            copy_file (ranking_file, temp);	    
    }

    /* Stop timer */
    d_ptr->time_atlas_selection += timer.report();

    printf("Train atlas selection done! \n");
}

void
Mabs::atlas_prealign ()
{
    /* Open logfile */
    std::string logfile_path = string_format (
        "%s/%s", d_ptr->prealign_dir.c_str(), "logfile.txt");
    logfile_open (logfile_path.c_str(), "a");

    /* Parse directory with registration files */
    if (d_ptr->parms->prealign_mode == "disabled") {
        print_and_exit ("Prealignment not enabled in parameters file!\n");
    }
    else if (d_ptr->parms->prealign_mode == "default") {
        print_and_exit ("No default prealignment implemented yet!\n");
    }
    else if (d_ptr->parms->prealign_mode == "custom") {
        this->parse_registration_dir (d_ptr->parms->prealign_registration_config);
    }

    /* Parse convert directory */
    this->load_process_dir_list (d_ptr->convert_dir);
    if (d_ptr->process_dir_list.size() < 2) {
        print_and_exit ("Error.  Prealignment requires at least two "
            "images in the convert directory.\n");
    }

    /* Identify directory of reference image */
    std::string reference_id;
    std::string reference_dir;
    if (d_ptr->parms->prealign_reference != "") {
        reference_id = d_ptr->parms->prealign_reference;
        reference_dir = string_format (
            "%s/%s", d_ptr->convert_dir.c_str(), 
            d_ptr->parms->prealign_reference.c_str());
        if (!is_directory (reference_dir)) {
            print_and_exit ("Error.  Prealignment reference directory (%s) "
                " was not found.\n", reference_dir.c_str());
        }
    } else {
        reference_dir = d_ptr->process_dir_list.front();
        reference_id = basename (reference_dir);
    }

    lprintf ("Prealignment reference directory is %s\n",
        reference_dir.c_str());

    /* Load reference image and structures */
    std::string reference_convert_img_fn = string_format (
        "%s/img.nrrd", reference_dir.c_str());
    std::string reference_convert_structures_dir = string_format (
        "%s/structures", reference_dir.c_str());

    /* Load reference image -- we assume this is successful */
    Rt_study::Pointer ref_rtds = Rt_study::New();
    ref_rtds->load_image (reference_convert_img_fn);
    ref_rtds->load_prefix (reference_convert_structures_dir.c_str());

    /* Resample and save reference image and structures */
    std::string reference_prealign_img_fn = string_format (
        "%s/%s/img.nrrd", d_ptr->prealign_dir.c_str(), reference_id.c_str());
    std::string reference_prealign_structures_dir = string_format (
        "%s/%s/structures", d_ptr->prealign_dir.c_str(), reference_id.c_str());
    if (d_ptr->prealign_resample) {
        ref_rtds->resample (d_ptr->prealign_spacing);
    }
    Plm_image::Pointer reference_image = ref_rtds->get_image ();
    
    /* PAOLO ZAFFINO
     * set fixed ROI if defined into the prealign section */ 
    if (d_ptr->parms->prealign_roi_cfg_name != "") {
        Segmentation::Pointer fixed_rtss = ref_rtds->get_segmentation();
        size_t target_roi_index = -1;
        for (size_t i = 0; i < fixed_rtss->get_num_structures(); i++) {
            std::string struct_name = fixed_rtss->get_structure_name (i);
            if (struct_name == d_ptr->parms->prealign_roi_cfg_name) {
                target_roi_index = i;
                break;
            }
        }
        if (target_roi_index != -1) {
            d_ptr->input_roi_for_cog_prealignment = Plm_image::New (fixed_rtss->get_structure_image (target_roi_index));
        }
        else if (target_roi_index == -1) {
            lprintf("No fixed ROI set!\n");
        }
    }

    reference_image->save_image (reference_prealign_img_fn);
    ref_rtds->save_prefix (reference_prealign_structures_dir, "nrrd");

    /* Do it. */
    d_ptr->ref_rtds = ref_rtds;
    d_ptr->ref_id = reference_id;
    d_ptr->atlas_list = d_ptr->process_dir_list;
    d_ptr->output_dir = d_ptr->prealign_dir;
    run_registration_loop ();

    /* Choose best registration parameter settings based on statistics */
    std::string best_registration_name = d_ptr->stats.choose_best ();

    /* Copy results of best pre-alignment method into prealign base */
    std::list<std::string>::iterator atl_it;
    for (atl_it = d_ptr->atlas_list.begin();
         atl_it != d_ptr->atlas_list.end(); atl_it++)
    {
        std::string path = *atl_it;
        std::string atlas_id = basename (path);

        /* Don't copy over results for reference image */
        if (atlas_id == d_ptr->ref_id) {
            continue;
        }

        std::string src_directory = string_format ("%s/%s/%s", 
            d_ptr->prealign_dir.c_str(), atlas_id.c_str(), 
            best_registration_name.c_str());
        std::string dst_directory = string_format ("%s/%s", 
            d_ptr->prealign_dir.c_str(), atlas_id.c_str());
        std::string src_img = string_format ("%s/%s",
            src_directory.c_str(), "img.nrrd");
        std::string dst_img = string_format ("%s/%s",
            dst_directory.c_str(), "img.nrrd");

        /* Copy image */
        printf ("copying %s <- %s\n", dst_img.c_str(), src_img.c_str());
        copy_file (dst_img, src_img);

        /* Copy structures */
        std::string src_structures_dir = string_format ("%s/%s",
            src_directory.c_str(), "structures");
        std::string dst_structures_dir = string_format ("%s/%s",
            dst_directory.c_str(), "structures");
        make_directory (dst_structures_dir.c_str());
        Dir_list d (src_structures_dir);
        for (int i = 0; i < d.num_entries; i++)
        {
            /* Skip "." and ".." */
            if (!strcmp (d.entries[i], ".") || !strcmp (d.entries[i], "..")) {
                continue;
            }

            std::string src_structure = compose_filename (src_structures_dir, 
                d.entries[i]);
            std::string dst_structure = compose_filename (dst_structures_dir, 
                d.entries[i]);
            printf ("copying %s <- %s\n", 
                dst_structure.c_str(), src_structure.c_str());
            copy_file (dst_structure, src_structure);
        }
    }

    lprintf ("MABS pre-align complete\n");

    logfile_close ();
}

void
Mabs::parse_registration_dir (const std::string& registration_config)
{
    /* Figure out whether we need to do a single registration 
       or multiple registrations (for atlas tuning) */

    if (is_directory (registration_config)) {
        Dir_list dir (registration_config);
        for (int i = 0; i < dir.num_entries; i++) {
            std::string full_path = string_format (
                "%s/%s", registration_config.c_str(), 
                dir.entries[i]);
            /* Skip backup files */
            if (extension_is (dir.entries[i], "~")) {
                continue;
            }
            /* Skip directories */
            if (is_directory (full_path)) {
                continue;
            }
            d_ptr->registration_list.push_back (full_path);
        }
    }
    else {
        d_ptr->registration_list.push_back (registration_config);
    }
}

void 
Mabs::set_executed_command (const std::string& executed_command)
{
    d_ptr->executed_command = executed_command;
}

FloatImageType::Pointer
Mabs::compute_dmap (
    UCharImageType::Pointer& structure_image,
    const std::string& curr_output_dir,
    const std::string& mapped_name)
{
    Plm_timer timer;
    Distance_map dmap;

    /* Compute the dmap */
    timer.start ();
    dmap.set_input_image (structure_image);
    dmap.set_inside_is_positive (false);
    dmap.set_use_squared_distance (false);
    /* GCS FIX: This should not be hard-coded */
    dmap.set_maximum_distance (500);
    dmap.run ();
    FloatImageType::Pointer dmap_image = dmap.get_output_image ();

    /* GCS FIX: The below is no longer needed if set_maximum_distance 
       is implemented for other distance map alternatives */

    /* Truncate the dmap.  This is to save disk space. 
       Maybe we won't need this if we can crop. */
    Float_pair_list al;
    al.push_back (std::make_pair (
            -std::numeric_limits<float>::max(), 0));
    al.push_back (std::make_pair (-500, -500));
    al.push_back (std::make_pair (500, 500));
    al.push_back (std::make_pair (
            std::numeric_limits<float>::max(), 0));
    itk_adjust (dmap_image, al);
    d_ptr->time_dmap += timer.report();

    if (d_ptr->write_distance_map_files) {
        timer.start();
        std::string fn = string_format ("%s/dmap_%s.nrrd", 
            curr_output_dir.c_str(), mapped_name.c_str());
        itk_image_save (dmap_image, fn.c_str());
        d_ptr->time_io += timer.report();
    }

    return dmap_image;
}

void
Mabs::no_voting (
    const std::string& atlas_id,
    const std::string& label_output_dir
)
{
    Plm_timer timer;
   
    /* Set up files & directories for this job */
    std::string atlas_input_path;
    atlas_input_path = string_format ("%s/%s",
        d_ptr->preprocessed_dir.c_str(), atlas_id.c_str());
    lprintf ("atlas_input_path: %s\n",
        atlas_input_path.c_str());
    std::string atlas_output_path;
    atlas_output_path = string_format ("%s/%s",
        d_ptr->output_dir.c_str(), atlas_id.c_str());
    lprintf ("atlas_output_path: %s\n",
        atlas_output_path.c_str());
    std::string curr_output_dir;
    curr_output_dir = string_format ("%s/%s",
        atlas_output_path.c_str(),
        d_ptr->registration_id.c_str());
    lprintf ("curr_output_dir: %s\n", curr_output_dir.c_str());

    /* Load xform */
    std::string xf_fn;
    timer.start();
    xf_fn = string_format ("%s/%s",
		    curr_output_dir.c_str(),
		    "xf.nrrd");

    if (!file_exists (xf_fn.c_str())){
	    xf_fn = string_format ("%s/%s",
			    curr_output_dir.c_str(),
			    "xf.txt");
    }
    lprintf ("Loading xform: %s\n", xf_fn.c_str());
    Xform::Pointer xf = xform_load (xf_fn);
    d_ptr->time_io += timer.report();

    /* Loop through structures for this atlas image */
    std::set<std::string>::const_iterator it;
    for (it = d_ptr->parms->structure_set.begin ();
         it != d_ptr->parms->structure_set.end (); it++)
    {
        const std::string& mapped_name = *it;
        lprintf ("Segmenting structure: %s\n", mapped_name.c_str());

        /* Load original structure */
        timer.start();
        std::string atlas_struct_fn;
        atlas_struct_fn = string_format ("%s/structures/%s.nrrd", 
            atlas_input_path.c_str(), mapped_name.c_str());
        Plm_image::Pointer atlas_struct = 
            plm_image_load_native (atlas_struct_fn);
        d_ptr->time_io += timer.report();
        if (!atlas_struct) {
            lprintf ("Atlas %s doesn't have structure %s\n",
                atlas_id.c_str(), mapped_name.c_str());
            continue;
        }

        /* Warp structure */
        timer.start();
        Plm_image::Pointer warped_structure = Plm_image::New();
        Plm_image_header fixed_pih (d_ptr->ref_rtds->get_image());
        lprintf ("Warping atlas structure.\n");
        plm_warp (warped_structure, 0, xf, 
            &fixed_pih, 
            atlas_struct,
            0, false, 0, 0);
        d_ptr->time_warp_str += timer.report();
        
        /* Save warped structure */        
        std::string final_segmentation_img_fn = string_format (
            "%s/%s_novoting.nrrd", label_output_dir.c_str(), 
            mapped_name.c_str());

        itk_image_save (warped_structure->itk_uchar(),
            final_segmentation_img_fn.c_str());
        
        /* If required compute statistics */
        std::string atl_name = basename (d_ptr->output_dir);
        std::string ref_stru_fn = string_format ("%s/%s/structures/%s.nrrd",
            d_ptr->preprocessed_dir.c_str(), atl_name.c_str(),
            mapped_name.c_str());

        Plm_image::Pointer ref_stru = 
            plm_image_load_native (ref_stru_fn);

        if (!ref_stru) {
            /* User is not running train, so no statistics */
            continue;
        }
       
        if (d_ptr->parms->structure_zcrop.count(mapped_name) > 0) {
			std::string zcrop1 
			   = d_ptr->parms->structure_zcrop.at(mapped_name);
			//std::cout << zcrop1 << std::endl;
			std::stringstream ss(zcrop1);
			for (int i = 0; i < 2; i++) {
				ss >> d_ptr->zcrop_vec[i];
			}

		zcrop(ref_stru->itk_uchar(), warped_structure->itk_uchar(), d_ptr->zcrop_vec);
		/*
		itk_bbox(ref_stru->itk_uchar(), 
			d_ptr->bbox_coordinates_1, d_ptr->bbox_indices_1);
		itk_bbox(warped_structure->itk_uchar(), 
			d_ptr->bbox_coordinates_2, d_ptr->bbox_indices_2);
                d_ptr->bbox_coordinates_1[4] += d_ptr->zcrop[1];
		d_ptr->bbox_coordinates_2[4] += d_ptr->zcrop[1];
		d_ptr->bbox_coordinates_1[5] -= d_ptr->zcrop[0];
		d_ptr->bbox_coordinates_2[5] -= d_ptr->zcrop[0];

		ref_stru->itk_uchar() = itk_crop_by_coord(
			ref_stru->itk_uchar(), d_ptr->bbox_coordinates_1);
		warped_structure->itk_uchar() = itk_crop_by_coord(
			warped_structure->itk_uchar(), 
			d_ptr->bbox_coordinates_2);
			*/
	}
        /* Compute Dice, etc. */
        std::string stats_string = d_ptr->stats.compute_statistics (
            "segmentation", /* Not used yet */
            ref_stru->itk_uchar(),
            warped_structure->itk_uchar());
        std::string seg_log_string = string_format (
            "target=%s,reg=%s,struct=%s,"
            "%s\n",
            d_ptr->ref_id.c_str(),
            d_ptr->registration_id.c_str(),
            mapped_name.c_str(),
            stats_string.c_str());
        lprintf ("%s", seg_log_string.c_str());

        /* Update seg_dice file */
        std::string seg_dice_log_fn = string_format (
            "%s/seg_dice.csv",
            d_ptr->mabs_train_dir.c_str());
        FILE *fp = fopen (seg_dice_log_fn.c_str(), "a");
        fprintf (fp, "%s", seg_log_string.c_str());
        fclose (fp);
    
    }
        
}

void
Mabs::gaussian_segmentation_vote (
    const std::string& atlas_id,
    const Mabs_seg_weights_list& seg_weights
)
{
    Plm_timer timer;
   
    /* Set up files & directories for this job */
    std::string atlas_input_path;
    atlas_input_path = string_format ("%s/%s",
        d_ptr->preprocessed_dir.c_str(), atlas_id.c_str());
    lprintf ("atlas_input_path: %s\n",
        atlas_input_path.c_str());
    std::string atlas_output_path;
    atlas_output_path = string_format ("%s/%s",
        d_ptr->output_dir.c_str(), atlas_id.c_str());
    lprintf ("atlas_output_path: %s\n",
        atlas_output_path.c_str());
    std::string curr_output_dir;
    curr_output_dir = string_format ("%s/%s",
        atlas_output_path.c_str(),
        d_ptr->registration_id.c_str());
    lprintf ("curr_output_dir: %s\n", curr_output_dir.c_str());

    /* Load xform */
    std::string xf_fn;
    timer.start();
    xf_fn = string_format ("%s/%s",
		    curr_output_dir.c_str(),
		    "xf.nrrd");
    if (!file_exists(xf_fn.c_str())){
	    xf_fn = string_format ("%s/%s",
		    curr_output_dir.c_str(),
		    "xf.txt");
    }

    lprintf ("Loading xform: %s\n", xf_fn.c_str());
    Xform::Pointer xf = xform_load (xf_fn);
    d_ptr->time_io += timer.report();

    /* Load warped image */
    timer.start();
    std::string warped_image_fn;
    warped_image_fn = string_format (
        "%s/img.nrrd", curr_output_dir.c_str());
    Plm_image::Pointer warped_image = plm_image_load_native (warped_image_fn);
    d_ptr->time_io += timer.report();
    if (!warped_image) {
        /* Load atlas image */
        timer.start();
        std::string atlas_image_fn;
        atlas_image_fn = string_format ("%s/img.nrrd", 
            atlas_input_path.c_str());
        lprintf ("That's ok.  Loading atlas image instead: %s\n", 
            atlas_image_fn.c_str());
        Plm_image::Pointer atlas_image = 
            plm_image_load_native (atlas_image_fn);
        d_ptr->time_io += timer.report();
        /* Warp atlas image */
        lprintf ("Warping atlas image.\n");
        timer.start();
        warped_image = Plm_image::New();
        Plm_image_header fixed_pih (d_ptr->ref_rtds->get_image());
        plm_warp (warped_image, 0, xf, 
            &fixed_pih, 
            atlas_image, 
            0, false, 0, 1);
        d_ptr->time_warp_img += timer.report();
        /* Save warped image */
        if (d_ptr->write_warped_images) {
            timer.start();
            lprintf ("Saving warped atlas image: %s\n",
                warped_image_fn.c_str());
            warped_image->save_image (warped_image_fn.c_str());
            d_ptr->time_io += timer.report();
        }
    }

    /* Loop through structures for this atlas image */
    std::set<std::string>::const_iterator it;
    for (it = d_ptr->parms->structure_set.begin ();
         it != d_ptr->parms->structure_set.end (); it++)
    {
        const std::string& mapped_name = *it;
        lprintf ("Segmenting structure: %s\n", mapped_name.c_str());

        /* Make a new voter if needed */
        Mabs_vote *vote;
        std::map<std::string, Mabs_vote*>::const_iterator vote_it 
            = d_ptr->vote_map.find (mapped_name);
        if (vote_it == d_ptr->vote_map.end()) {

            /* Find fusion weights for this structure */
            const Mabs_seg_weights* msw = seg_weights.find (mapped_name);

            /* Make the voter */
            vote = new Mabs_vote;
            vote->set_rho (msw->rho);
            vote->set_sigma (msw->sigma);
            vote->set_minimum_similarity (msw->minsim);
            d_ptr->vote_map[mapped_name] = vote;
            vote->set_fixed_image (
                d_ptr->ref_rtds->get_image()->itk_float());
        } else {
            vote = vote_it->second;
        }

        /* Load dmap */
        timer.start();
        lprintf ("Loading dmap\n");
        std::string dmap_fn = string_format ("%s/dmap_%s.nrrd", 
            curr_output_dir.c_str(), mapped_name.c_str());
        Plm_image::Pointer dmap_image = plm_image_load_native (
            dmap_fn.c_str());
        d_ptr->time_io += timer.report();
        if (!dmap_image) {
            /* Load warped structure */
            timer.start();
            std::string warped_structure_fn = string_format (
                "%s/structures/%s.nrrd", curr_output_dir.c_str(),
                mapped_name.c_str());
            lprintf ("That's ok, loading warped structure instead: %s\n",
                warped_structure_fn.c_str());
            Plm_image::Pointer warped_structure = plm_image_load_native (
                warped_structure_fn);
            d_ptr->time_io += timer.report();
            if (!warped_structure) {
                /* Load original structure */
                timer.start();
                std::string atlas_struct_fn;
                atlas_struct_fn = string_format ("%s/structures/%s.nrrd", 
                    atlas_input_path.c_str(), mapped_name.c_str());
                lprintf ("That's ok, loading atlas structure instead: %s\n", 
                    atlas_struct_fn.c_str());
                Plm_image::Pointer atlas_struct = 
                    plm_image_load_native (atlas_struct_fn);
                d_ptr->time_io += timer.report();
                if (!atlas_struct) {
                    lprintf ("Atlas %s doesn't have structure %s\n",
                        atlas_id.c_str(), mapped_name.c_str());
                    continue;
                }
                /* Warp structure */
                timer.start();
                warped_structure = Plm_image::New();
                Plm_image_header fixed_pih (d_ptr->ref_rtds->get_image());
                lprintf ("Warping atlas structure.\n");
                plm_warp (warped_structure, 0, xf, 
                    &fixed_pih, 
                    atlas_struct,
                    0, false, 0, 1);
                d_ptr->time_warp_str += timer.report();
            }
            if (!warped_structure) continue;
            /* Recompute distance map */
            timer.start();
            FloatImageType::Pointer dmap_image_itk = this->compute_dmap (
                warped_structure->itk_uchar(),
                curr_output_dir, mapped_name);
            dmap_image = Plm_image::New (dmap_image_itk);
            d_ptr->time_dmap += timer.report();
        }

        /* Vote */
        timer.start();
        lprintf ("Voting\n");
        vote->vote (warped_image->itk_float(), 
            dmap_image->itk_float());
        d_ptr->time_vote += timer.report();
    }
}

void
Mabs::staple_segmentation_prepare (
    const std::string& atlas_id,
    const Mabs_seg_weights_list& seg_weights
)
{
    Plm_timer timer;
    timer.start();

    /* Set up files & directories for this job */
    std::string atlas_input_path;
    atlas_input_path = string_format ("%s/%s",
        d_ptr->preprocessed_dir.c_str(), atlas_id.c_str());
    lprintf ("atlas_input_path: %s\n",
        atlas_input_path.c_str());
    std::string current_dir;
    current_dir = string_format ("%s/%s/%s",
        d_ptr->output_dir.c_str(), atlas_id.c_str(), d_ptr->registration_id.c_str());

    /* Loop through structures for this atlas image */
    std::set<std::string>::const_iterator it;
    for (it = d_ptr->parms->structure_set.begin ();
         it != d_ptr->parms->structure_set.end (); it++)
    {
        const std::string& mapped_name = *it;

        std::string atlas_struct_fn;
        atlas_struct_fn = string_format ("%s/structures/%s.nrrd",
            atlas_input_path.c_str(), mapped_name.c_str());
        Plm_image::Pointer atlas_struct =
            plm_image_load_native (atlas_struct_fn);

        if (!atlas_struct) {
            lprintf ("Atlas %s doesn't have structure %s\n",
                atlas_id.c_str(), mapped_name.c_str());
            continue;
        }

        lprintf ("Preparing structure: %s (atl %s)\n", mapped_name.c_str(), atlas_id.c_str());

        std::string warped_structure_fn = string_format (
            "%s/structures/%s.nrrd", current_dir.c_str(),
            mapped_name.c_str());
        Plm_image::Pointer warped_structure = 
            plm_image_load_native (warped_structure_fn);
       
        /* Find fusion weights for this structure */
        const Mabs_seg_weights* msw = seg_weights.find (mapped_name);
            
        if (warped_structure) {
            /* Make a new staple object if needed */
            Mabs_staple *staple;
            std::map<std::string, Mabs_staple*>::const_iterator staple_it 
                = d_ptr->staple_map.find (mapped_name);
            if (staple_it == d_ptr->staple_map.end()) {
                staple = new Mabs_staple;
                staple->set_confidence_weight(msw->confidence_weight);
                staple->add_input_structure (warped_structure);
                d_ptr->staple_map[mapped_name] = staple;
            } else {
                d_ptr->staple_map[mapped_name]->add_input_structure (warped_structure);
            }
        }

    }

    d_ptr->time_staple += timer.report();
}

void
Mabs::gaussian_segmentation_label (
    const std::string& label_output_dir, 
    const Mabs_seg_weights_list& seg_weights
)
{
    Plm_timer timer;

    /* Get output image for each label */
    lprintf ("Extracting and saving final contours (gaussian)\n");
    std::map<std::string, Mabs_vote*>::const_iterator vote_it;
    for (vote_it = d_ptr->vote_map.begin();
         vote_it != d_ptr->vote_map.end(); vote_it++)
    {
        const std::string& mapped_name = vote_it->first;
        Mabs_vote *vote = vote_it->second;
        lprintf ("Normalizing votes\n");
        timer.start();
        vote->normalize_votes();
        d_ptr->time_vote += timer.report();

        /* Get the weight image */
        FloatImageType::Pointer weight_image;
        weight_image = vote->get_weight_image ();

        /* Optionally, save the weight files */
        if (d_ptr->write_weight_files) {
            lprintf ("Saving weights\n");
            std::string fn = string_format ("%s/weight_%s.nrrd", 
                label_output_dir.c_str(),
                vote_it->first.c_str());
            timer.start();
            itk_image_save (weight_image, fn.c_str());
            d_ptr->time_io += timer.report();
        }

        /* Find fusion weights for this structure */
        const Mabs_seg_weights* msw = seg_weights.find (mapped_name);
        msw->print ();
            
        /*  threshold values */
        Option_range thresh_range;
        thresh_range.set_range (msw->thresh);

        /* Loop through each threshold value, do thresholding,
           and then record score */

        const std::list<float>& thresh_list = thresh_range.get_range();
        std::list<float>::const_iterator thresh_it;
        for (thresh_it = thresh_list.begin(); 
             thresh_it != thresh_list.end(); thresh_it++) 
        {
            d_ptr->segmentation_threshold_weight (
                label_output_dir, weight_image, mapped_name, 
                vote_it->first.c_str(), msw, *thresh_it);
        }
    }
}

void
Mabs::staple_segmentation_label (
    const std::string& label_output_dir, 
    const Mabs_seg_weights_list& seg_weights
)
{
    Plm_timer timer;
    timer.start();

    /* Set up files & directories for this job */
    make_directory (label_output_dir);

    /* Get output image for each label */
    lprintf ("Extracting and saving final contours (staple)\n");
    for (std::map<std::string, Mabs_staple*>::const_iterator staple_it 
             = d_ptr->staple_map.begin(); 
         staple_it != d_ptr->staple_map.end(); staple_it++)
    {
       
        const std::string& mapped_name = staple_it->first;
        std::string atl_name = basename (d_ptr->output_dir);

        /* Find fusion weights for this structure */
        const Mabs_seg_weights* msw = seg_weights.find (mapped_name);

        std::string ref_stru_fn = string_format ("%s/%s/structures/%s.nrrd",
            d_ptr->preprocessed_dir.c_str(), atl_name.c_str(),
            mapped_name.c_str());

        std::string final_segmentation_img_fn = string_format (
            "%s/%s_staple_%.9f.nrrd", label_output_dir.c_str(), 
            mapped_name.c_str(),
            msw->confidence_weight);

        printf("Structure %s \n", final_segmentation_img_fn.c_str());
        staple_it->second->run();

        itk_image_save (staple_it->second->output_img->itk_uchar(),
            final_segmentation_img_fn.c_str());

        Plm_image::Pointer ref_stru = 
            plm_image_load_native (ref_stru_fn);

        if (!ref_stru) {
            /* User is not running train, so no statistics */
            continue;
        }
        if (d_ptr->parms->structure_zcrop.count(mapped_name) > 0) {
			std::string zcrop1 
			   = d_ptr->parms->structure_zcrop.at(mapped_name);
			//std::cout << zcrop1 << std::endl;
			std::stringstream ss(zcrop1);
			for (int i = 0; i < 2; i++) {
				ss >> d_ptr->zcrop_vec[i];
			}

		zcrop(ref_stru->itk_uchar(), staple_it->second->output_img->itk_uchar(), d_ptr->zcrop_vec);
		/*
		itk_bbox(ref_stru->itk_uchar(), 
			d_ptr->bbox_coordinates_1, d_ptr->bbox_indices_1);
		itk_bbox(staple_it->second->output_img->itk_uchar(), 
			d_ptr->bbox_coordinates_2, d_ptr->bbox_indices_2);
                d_ptr->bbox_coordinates_1[4] += d_ptr->zcrop[1];
		d_ptr->bbox_coordinates_2[4] += d_ptr->zcrop[1];
		d_ptr->bbox_coordinates_1[5] -= d_ptr->zcrop[0];
		d_ptr->bbox_coordinates_2[5] -= d_ptr->zcrop[0];

		ref_stru->itk_uchar() = itk_crop_by_coord(
			ref_stru->itk_uchar(), d_ptr->bbox_coordinates_1);
		staple_it->second->output_img->itk_uchar() = 
			itk_crop_by_coord(
			staple_it->second->output_img->itk_uchar(), 
			d_ptr->bbox_coordinates_2);
		*/
	}
	
        /* Compute Dice, etc. */
        std::string stats_string = d_ptr->stats.compute_statistics (
            "segmentation", /* Not used yet */
            ref_stru->itk_uchar(),
            staple_it->second->output_img->itk_uchar());
        std::string seg_log_string = string_format (
            "target=%s,reg=%s,struct=%s,"
            "confidence_weight=%.9f,"
            "%s\n",
            d_ptr->ref_id.c_str(),
            d_ptr->registration_id.c_str(),
            mapped_name.c_str(),
            msw->confidence_weight,
            stats_string.c_str());
        lprintf ("%s", seg_log_string.c_str());

        /* Update seg_dice file */
        std::string seg_dice_log_fn = string_format (
            "%s/seg_dice.csv",
            d_ptr->mabs_train_dir.c_str());
        FILE *fp = fopen (seg_dice_log_fn.c_str(), "a");
        fprintf (fp, "%s", seg_log_string.c_str());
        fclose (fp);
    }
    
    d_ptr->time_staple += timer.report();
}

void
Mabs::run_segmentation (const Mabs_seg_weights_list& seg_weights)
{
    
    /* Just one atlas and no voting option selected */
    if (d_ptr->parms->fusion_criteria == "none"
        && d_ptr->parms->atlases_from_ranking == 1)
    {
        std::string atlas_id = basename (*d_ptr->atlas_list.begin());
        std::string label_output_dir =
            string_format ("%s/segmentations", d_ptr->output_dir.c_str());

        no_voting (atlas_id, label_output_dir);
        return;
    }

    /* Clear out internal structures */
    d_ptr->clear_vote_map ();
    d_ptr->clear_staple_map ();

    /* This function is only run on new examples, so no checkpointing 
       is performed */
    
    /* Loop through images in the atlas */
    std::list<std::string>::iterator atl_it;
    for (atl_it = d_ptr->atlas_list.begin();
         atl_it != d_ptr->atlas_list.end(); atl_it++)
    {
        std::string atlas_id = basename (*atl_it);
        
        /* If gaussian is chosen (alone or with staple) run its code */
        if (d_ptr->parms->fusion_criteria.find("gaussian")
            != std::string::npos)
        {
            gaussian_segmentation_vote (atlas_id, seg_weights);
        }
        /* If staple is chosen (alone or with gaussian) run its code */
        if (d_ptr->parms->fusion_criteria.find("staple")
            != std::string::npos)
        {
            staple_segmentation_prepare (atlas_id, seg_weights);
        }
    }
    
    /* If gaussian is chosen (alone or with staple) run its code */
    if (d_ptr->parms->fusion_criteria.find("gaussian") != std::string::npos) {
        /* Threshold images based on weight */
        std::string label_output_dir =
            string_format ("%s/segmentations", d_ptr->output_dir.c_str());
        gaussian_segmentation_label (label_output_dir, seg_weights);

        /* Clear out internal structure */
        d_ptr->clear_vote_map ();
    }
    /* If staple is chosen (alone or with gaussian) run its code */
    if (d_ptr->parms->fusion_criteria.find("staple") != std::string::npos) {
        /* Threshold images */
        std::string label_output_dir =
            string_format ("%s/segmentations", d_ptr->output_dir.c_str());
        staple_segmentation_label (label_output_dir, seg_weights);

        /* Clear out internal structure */
        d_ptr->clear_staple_map ();
    }
}

void
Mabs::run_segmentation_train (const Mabs_seg_weights& msw)
{
    /* Just one atlas and no voting option selected */
    if (d_ptr->parms->fusion_criteria == "none"
        && d_ptr->parms->atlases_from_ranking == 1)
    {
        std::string atlas_id = basename (*d_ptr->atlas_list.begin());
        std::string label_output_dir =
            string_format ("%s/segmentations", d_ptr->output_dir.c_str());

        no_voting(atlas_id, label_output_dir);
        return;
    }

    /* Clear out internal structures */
    d_ptr->clear_vote_map ();
    d_ptr->clear_staple_map ();

    /* Check if this segmentation is already complete.
       We might be able to skip it. */
    std::string gaussian_seg_checkpoint_fn = "";
    std::string staple_seg_checkpoint_fn = "";

    Mabs_seg_weights_list seg_weights;
    seg_weights.push_back (msw);
    
    /* Gaussian checkpoint */
    if (d_ptr->parms->fusion_criteria.find("gaussian") != std::string::npos)
    {
        std::string curr_output_dir = string_format (
            "%s/segmentations/%s/rho_%f_sig_%f_ms_%f",
            d_ptr->output_dir.c_str(), d_ptr->registration_id.c_str(),
            msw.rho, msw.sigma, msw.minsim);

        if (!this->check_seg_checkpoint(curr_output_dir)) {
            gaussian_seg_checkpoint_fn = string_format ("%s/checkpoint.txt",
                curr_output_dir.c_str());
        }
    }

    /* Staple checkpoint */
    if (d_ptr->parms->fusion_criteria.find("staple") != std::string::npos)
    {
        std::string curr_output_dir = string_format (
            "%s/segmentations/%s/staple_confidence_weight_%.9f",
            d_ptr->output_dir.c_str(), d_ptr->registration_id.c_str(),
            msw.confidence_weight);
        if (!this->check_seg_checkpoint(curr_output_dir)) {
            staple_seg_checkpoint_fn = string_format ("%s/checkpoint.txt",
                curr_output_dir.c_str());
        }
    }

    /* Loop through images in the atlas */
    std::list<std::string>::iterator atl_it;
    for (atl_it = d_ptr->atlas_list.begin();
         atl_it != d_ptr->atlas_list.end(); atl_it++)
    {
        std::string atlas_id = basename (*atl_it);
        
        /* If gaussian is chosen (alone or with staple) and its 
           segmentations aren't already present run its code */
        if (d_ptr->parms->fusion_criteria.find("gaussian") != std::string::npos && gaussian_seg_checkpoint_fn != "") {
            gaussian_segmentation_vote (atlas_id, seg_weights);
        }
        /* If staple is chosen (alone or with gaussian) and its 
           segmentations aren't already present run its code */
        if (d_ptr->parms->fusion_criteria.find("staple") != std::string::npos && staple_seg_checkpoint_fn != "") {
            staple_segmentation_prepare (atlas_id, seg_weights);
        }
    }
    
    /* If gaussian is chosen (alone or with staple) and its segmentations 
       aren't already present run its code */
    if (d_ptr->parms->fusion_criteria.find("gaussian") != std::string::npos
        && gaussian_seg_checkpoint_fn != "")
    {
        /* Threshold images based on weight */
        std::string label_output_dir =
            string_format ("%s/segmentations/%s/rho_%f_sig_%f_ms_%f",
                d_ptr->output_dir.c_str(), d_ptr->registration_id.c_str(),
                msw.rho, msw.sigma, msw.minsim);
        gaussian_segmentation_label (label_output_dir, seg_weights);

        /* Clear out internal structure */
        d_ptr->clear_vote_map ();
    }
    /* If staple is chosen (alone or with gaussian) and its segmentations 
       aren't already present run its code */
    if (d_ptr->parms->fusion_criteria.find("staple") != std::string::npos
        && staple_seg_checkpoint_fn != "")
    {
        /* Threshold images */
        std::string label_output_dir =
            string_format ("%s/segmentations/%s/staple_confidence_weight_%.9f",
                d_ptr->output_dir.c_str(), d_ptr->registration_id.c_str(),
                msw.confidence_weight);
        staple_segmentation_label (label_output_dir, seg_weights);

        /* Clear out internal structure */
        d_ptr->clear_staple_map ();
    }

    /* Create checkpoint files which means that this segmentation
       is complete */
    if (gaussian_seg_checkpoint_fn!="") touch_file (gaussian_seg_checkpoint_fn);
    if (staple_seg_checkpoint_fn!="") touch_file (staple_seg_checkpoint_fn);
}

void
Mabs::run_segmentation_train_loop ()
{
    Option_range minsim_range, rho_range, sigma_range, confidence_weight_range;
    minsim_range.set_range (d_ptr->parms->minsim_values);
    rho_range.set_range (d_ptr->parms->rho_values);
    confidence_weight_range.set_range (d_ptr->parms->confidence_weight);
    sigma_range.set_range (d_ptr->parms->sigma_values);

    /* Loop through each registration parameter set */
    std::list<std::string>::iterator reg_it;
    for (reg_it = d_ptr->registration_list.begin(); 
         reg_it != d_ptr->registration_list.end(); reg_it++) 
    {
        d_ptr->registration_id = basename (*reg_it);

        Mabs_seg_weights_list mswl;
        mswl.push_back (Mabs_seg_weights());
        Mabs_seg_weights& msw = mswl.front();
        msw.thresh = d_ptr->parms->threshold_values;
        
        /* Loop through each training parameter: confidence_weight */
        const std::list<float>& confidence_weight_list
            = confidence_weight_range.get_range();
        std::list<float>::const_iterator confidence_weight_it;
        for (confidence_weight_it = confidence_weight_list.begin();
             confidence_weight_it != confidence_weight_list.end();
             confidence_weight_it++) 
        {
            msw.confidence_weight = *confidence_weight_it;

            /* Loop through each training parameter: rho */
            const std::list<float>& rho_list = rho_range.get_range();
            std::list<float>::const_iterator rho_it;
            for (rho_it = rho_list.begin(); rho_it != rho_list.end(); rho_it++) 
            {
                msw.rho = *rho_it;
         
                /* Loop through each training parameter: sigma */
                const std::list<float>& sigma_list = sigma_range.get_range();
                std::list<float>::const_iterator sigma_it;
                for (sigma_it = sigma_list.begin(); 
                     sigma_it != sigma_list.end(); sigma_it++) 
                {
                    msw.sigma = *sigma_it;
                    
                    /* Loop through each training parameter: minimum similarity */
                    const std::list<float>& minsim_list
                        = minsim_range.get_range();
                    std::list<float>::const_iterator minsim_it;
                    for (minsim_it = minsim_list.begin(); 
                         minsim_it != minsim_list.end(); minsim_it++) 
                    {
                        msw.minsim = *minsim_it;
                        run_segmentation (mswl);
                    }
                }
            }
        }
    }
}

void 
Mabs::set_parms (const Mabs_parms *parms)
{
    Plm_return_code rc;

    d_ptr->parms = parms;

    /* Set up directory strings */
    d_ptr->segment_input_fn = d_ptr->parms->labeling_input_fn;
    d_ptr->segment_outdir_base = d_ptr->parms->labeling_output_fn;
    if (d_ptr->segment_outdir_base == "") {
        d_ptr->segment_outdir_base = "mabs";
    }
    d_ptr->traindir_base = d_ptr->parms->training_dir;
    if (d_ptr->traindir_base == "") {
        d_ptr->traindir_base = "training";
    }
    if (d_ptr->parms->convert_dir != "") {
        d_ptr->convert_dir = d_ptr->parms->convert_dir;
    } else {
        d_ptr->convert_dir = string_format (
            "%s/convert", d_ptr->traindir_base.c_str());
    }
    if (d_ptr->parms->convert_dir != "") {
        d_ptr->prealign_dir = d_ptr->parms->prealign_dir;
    } else {
        d_ptr->prealign_dir = string_format (
            "%s/prealign", d_ptr->traindir_base.c_str());
    }
    d_ptr->atlas_train_dir = string_format (
        "%s/atlas-train", d_ptr->traindir_base.c_str());
    d_ptr->mabs_train_dir = string_format (
        "%s/mabs-train", d_ptr->traindir_base.c_str());

    if (is_directory (d_ptr->prealign_dir)) {
        d_ptr->preprocessed_dir = d_ptr->prealign_dir;
    } else {
        d_ptr->preprocessed_dir = d_ptr->convert_dir;
    }

    std::string preprocessed_dir;

    /* Convert section */
    d_ptr->convert_resample = false;
    rc = parse_float13 (d_ptr->convert_spacing, parms->convert_spacing);
    if (rc == PLM_SUCCESS) {
        d_ptr->convert_resample = true;
    }

    /* Prealgnment section */
    d_ptr->prealign_resample = false;
    rc = parse_float13 (d_ptr->prealign_spacing, parms->prealign_spacing);
    if (rc == PLM_SUCCESS) {
        d_ptr->prealign_resample = true;
    }

    /* Training section */
    d_ptr->stats.set_distance_map_algorithm (parms->distance_map_algorithm);

    /* Segmentation training */
    d_ptr->write_distance_map_files = parms->write_distance_map_files;
    d_ptr->write_thresholded_files = parms->write_thresholded_files;
    d_ptr->write_weight_files = parms->write_weight_files;
    d_ptr->write_warped_images = parms->write_warped_images;
}

void
Mabs::set_segment_input (const std::string& input_fn)
{
    d_ptr->segmentation_fn = input_fn;
}

void 
Mabs::set_segment_output (const std::string& output_dir)
{
    d_ptr->segment_outdir_base = output_dir;
}

void 
Mabs::set_segment_output_dicom (const std::string& output_dicom_dir)
{
    /* Not yet implemented */
}

void 
Mabs::set_prealign_roi_cmd_name (const std::string& input_roi_for_cog_prealignment_fn)
{
    d_ptr->prealign_roi_cmd_name = input_roi_for_cog_prealignment_fn;
}

void
Mabs::train_internal ()
{
    Plm_timer timer;
    Plm_timer timer_total;
    timer_total.start();

    /* Open logfile */
    std::string logfile_path = string_format (
        "%s/%s", d_ptr->mabs_train_dir.c_str(), "logfile.txt");
    logfile_open (logfile_path.c_str(), "a");

    /* Prepare registration parameters */
    if (d_ptr->train_segmentation && 
        d_ptr->parms->optimization_result_reg != "")
    {
        /* We get the best registration result from an optimization file */
        std::string registration_fn = string_format ("%s/%s",
            d_ptr->parms->registration_config.c_str(),
            d_ptr->parms->optimization_result_reg.c_str());
        this->parse_registration_dir (registration_fn);
        lprintf ("Training based on optimized registration result: %s\n",
            registration_fn.c_str());
    } else {
        /* Else, parse directory with registration files */
        this->parse_registration_dir (d_ptr->parms->registration_config);
    }

    /* Parse atlas directory */
    this->load_process_dir_list (d_ptr->preprocessed_dir);

    /* If set, run train atlas selection */
    if (d_ptr->parms->enable_atlas_selection)
    {
        this->train_atlas_selection();
    }
 
    /* Loop through atlas_dir, choosing reference images to segment */
    for (std::list<std::string>::iterator it = d_ptr->process_dir_list.begin();
         it != d_ptr->process_dir_list.end(); it++)
    {
        /* Create atlas list for this test case */
        std::string path = *it;
        d_ptr->atlas_list = d_ptr->process_dir_list;
        d_ptr->atlas_list.remove (path);

        /* Set output dir for this test case */
        std::string patient_id = basename (path);
        d_ptr->ref_id = patient_id;

        d_ptr->output_dir = string_format ("%s/%s",
            d_ptr->mabs_train_dir.c_str(), patient_id.c_str());
        lprintf ("outdir = %s\n", d_ptr->output_dir.c_str());

        /* Load image & structures from "prep" directory */
        timer.start();
        std::string fn = string_format ("%s/%s/img.nrrd", 
            d_ptr->preprocessed_dir.c_str(), patient_id.c_str());
        d_ptr->ref_rtds->load_image (fn.c_str());
        fn = string_format ("%s/%s/structures", 
            d_ptr->preprocessed_dir.c_str(), patient_id.c_str());
        d_ptr->ref_rtds->load_prefix (fn.c_str());
        d_ptr->time_io += timer.report();
        
        /* Use the atlases coming from the selection step */
        if (!d_ptr->selected_atlases_train.empty())
        {
            /* Extract from map structure only the atlases 
               choosen for the current patient*/
            std::list<std::string> atlases_for_train_subject;
            std::list<std::pair<std::string, double> >::iterator atl_it;
            for (atl_it = d_ptr->selected_atlases_train[patient_id].begin();
                atl_it != d_ptr->selected_atlases_train[patient_id].end(); atl_it++)
            {
                std::string complete_atlas_path = string_format("%s/%s",
                    d_ptr->preprocessed_dir.c_str(), atl_it->first.c_str());
                atlases_for_train_subject.push_back(complete_atlas_path);
            }
            
            /* Assign the selected atlases */
            d_ptr->atlas_list = atlases_for_train_subject;
        }

        /* Run the segmentation */
        this->run_registration_loop ();
        if (d_ptr->train_segmentation == true) {
            this->run_segmentation_train_loop ();
        }
    }

    lprintf ("Atlas selection time: %10.1f seconds\n", 
        d_ptr->time_atlas_selection);
    lprintf ("Registration time:    %10.1f seconds\n", d_ptr->time_reg);
    lprintf ("Warping time (img):   %10.1f seconds\n", d_ptr->time_warp_img);
    lprintf ("Warping time (str):   %10.1f seconds\n", d_ptr->time_warp_str);
    lprintf ("Extraction time:      %10.1f seconds\n", d_ptr->time_extract);
    lprintf ("Dice time:            %10.1f seconds\n", 
        d_ptr->stats.get_time_dice());
    lprintf ("Hausdorff time:       %10.1f seconds\n", 
        d_ptr->stats.get_time_hausdorff());
    lprintf ("Distance map time:    %10.1f seconds\n", d_ptr->time_dmap);
    lprintf ("Voting time:          %10.1f seconds\n", d_ptr->time_vote);
    lprintf ("Staple time:          %10.1f seconds\n", d_ptr->time_staple);
    lprintf ("I/O time:             %10.1f seconds\n", d_ptr->time_io);
    lprintf ("Total time:           %10.1f seconds\n", timer_total.report());
    lprintf ("MABS training complete\n");

    logfile_close ();
}
/*Extract_ref_structure*/
void
Mabs::segment ()
{
    d_ptr->segmentation = true;
    
    /* Yeah, I guess this is fine. */
    d_ptr->write_dicom_rt_struct = true;
    
    /* Prepare registration parameters */
#if defined (commentout)
    if (d_ptr->parms->optimization_result_reg != "") {
        /* We know the best registration result from an optimization file */
        std::string registration_fn = string_format ("%s/%s",
            d_ptr->parms->registration_config.c_str(),
            d_ptr->parms->optimization_result_reg.c_str());
        this->parse_registration_dir (registration_fn);
    } else {
        /* Else, parse directory with registration files */
        this->parse_registration_dir (d_ptr->parms->registration_config);
    }
#endif
    /* Inorder to facilitate using other registrtion strategies for segmentation
     * check if the config is a directory and append the best registration 
     * strategy */
    if (is_directory(d_ptr->parms->registration_config.c_str()) 
		    && d_ptr->parms->optimization_result_reg != "") {
	 std::string registration_fn = string_format ("%s/%s",
            d_ptr->parms->registration_config.c_str(),
            d_ptr->parms->optimization_result_reg.c_str());
        this->parse_registration_dir (registration_fn);
    } else {
	/* Else, use the provided file as registration_dir*/    
	    this->parse_registration_dir (d_ptr->parms->registration_config);
    }
    /* Load the image to be labeled.  For now, we'll assume this 
       is successful. */
    Plm_timer timer;
    timer.start();
    d_ptr->segment_input_fn = string_format ("%s/img.nrrd",
		    d_ptr->segmentation_fn.c_str());
    d_ptr->ref_rtds->load (d_ptr->segment_input_fn.c_str());
    
	std::string fn = string_format ("%s/structures", 
            d_ptr->segmentation_fn.c_str());
        d_ptr->ref_rtds->load_prefix (fn.c_str());
        d_ptr->time_io += timer.report();

    /* GCS TBD: For now, we delete any existing structures. 
       This avoids (pushes into the future) any additional development
       needed to update existing structure sets.  */
    if (d_ptr->ref_rtds->have_segmentation()) {
        //d_ptr->ref_rtds->get_segmentation()->clear ();
    }

    /* Parse atlas directory */
    this->load_process_dir_list (d_ptr->preprocessed_dir);

    /* Set atlas_list */
    d_ptr->atlas_list = d_ptr->process_dir_list;

    /* If set, run atlas selection */
    if (d_ptr->parms->enable_atlas_selection)
    {
        this->atlas_selection();

        /* Use the atlases coming from the selection step */
        if (!d_ptr->selected_atlases.empty())
        {
            /* Extract from map structure only the atlases 
               choosen for the current patient*/
            std::list<std::string> atlases_for_subject;
            std::list<std::pair<std::string, double> >::iterator atl_it;
            for (atl_it = d_ptr->selected_atlases.begin();
                atl_it != d_ptr->selected_atlases.end(); atl_it++)
            {
                std::string complete_atlas_path = string_format("%s/%s",
                    d_ptr->preprocessed_dir.c_str(), atl_it->first.c_str());
                atlases_for_subject.push_back(complete_atlas_path);
            }
            
            /* Assign the selected atlases */
            d_ptr->atlas_list = atlases_for_subject;
        }

        else {
            print_and_exit ("Atlas selection not working properly!\n");
        }
    }

    /* Set output dir for this test case */
    d_ptr->output_dir = d_ptr->segment_outdir_base;

    /* Save it for debugging */
    fn = string_format ("%s/%s", 
        d_ptr->segment_outdir_base.c_str(), 
        "img.nrrd");
    d_ptr->ref_rtds->get_image()->save_image (fn.c_str());

    /* Run the registrations */
    d_ptr->write_warped_images = true;
    
    /* PAOLO ZAFFINO: if an input ROI has been passed, prealign the centers of gravity before registration */
    if (d_ptr->prealign_roi_cmd_name != "" ) {
        d_ptr->input_roi_for_cog_prealignment = Plm_image::New (d_ptr->prealign_roi_cmd_name);
    }
    
    this->run_registration_loop ();

    /* Run the segmentation */

    /* GCS FIX: 
       1) registration_id must be set to something sane when 
       optimization results are not available
       2) need better default values for rho, etc.
       3) need to read optimized values of rho, etc.
    */
    if (is_directory(d_ptr->parms->registration_config.c_str()) && 
			    d_ptr->parms->optimization_result_reg != "") {
        d_ptr->registration_id = d_ptr->parms->optimization_result_reg;
    }
    else {
        if (d_ptr->registration_list.empty()) {
            /* No registration file.  Punt. */
            print_and_exit ("Error, could not find registration file.\n");
        }            
        d_ptr->registration_id = basename (
            d_ptr->registration_list.front());
    }
    
    run_segmentation (d_ptr->parms->optimization_result_seg);

    /* Save the output */
    std::string dicomrt_output_dir = string_format (
        "%s/dicom_rt",
        d_ptr->output_dir.c_str());
    d_ptr->ref_rtds->save_dicom (dicomrt_output_dir);
}

void
Mabs::train ()
{
    d_ptr->train_segmentation = true;
    d_ptr->compute_distance_map = true;
    d_ptr->write_warped_images = true;    /* Should be configurable */
    this->train_internal ();
}

void
Mabs::train_registration ()
{
    d_ptr->train_segmentation = false;
    d_ptr->compute_distance_map = d_ptr->write_distance_map_files;
    this->train_internal ();
}
