cuikpatheffort.c

Go to the documentation of this file.

#include "world.h"
#include "parameters.h"
 
#include "defines.h"
#include "error.h"
#include "filename.h"
#include "atlas.h"
#include "samples.h"
#include "random.h"
 
#include <stdlib.h>
 
int main(int argc, char **arg)
{
  Tworld world;            /* The set of mechanism and obstacles.  */
  Tparameters parameters;  /* Parameters used in the Cuik process. */
 
  Tfilename fparam;
  Tfilename fpath;
  
  /* input path */
  unsigned int nvs,ns;
  double **path;
  
  if (argc>=2)
    {
      /*Init parameters*/
      CreateFileName(NULL,arg[1],NULL,PARAM_EXT,&fparam);
      InitParametersFromFile(GetFileFullName(&fparam),&parameters);
      fprintf(stderr,"Reading parameters from           : %s\n",GetFileFullName(&fparam));
 
      if (GetParameter(CT_DYNAMICS,&parameters)>0)
        Error("cuikpatheffort do not work for problems with dynamics");
      
      /*Read the world from file*/
      InitWorldFromFile(&parameters,FALSE,TRUE,arg[1],&world);
 
      if (argc>2)
        CreateFileName(NULL,arg[2],NULL,SOL_EXT,&fpath);
      else
        CreateFileName(NULL,arg[1],"_path",SOL_EXT,&fpath);
 
      if (LoadSamples(&fpath,&nvs,&ns,&path))
        {
          fprintf(stderr,"Path control effort               : %g\n",PathEffort(&parameters,nvs,ns,path,&world));
          DeleteSamples(ns,path);
        }
      else
        Error("Could not read the input path file");
 
      DeleteWorld(&world);
      DeleteParameters(&parameters);
 
      DeleteFileName(&fparam);
      DeleteFileName(&fpath);
    }
 else
   {
     fprintf(stderr,"  Wrong number of parameters.\n");
     fprintf(stderr,"  Use:\n");   
     fprintf(stderr,"      cuikpatheffort <base filename> [<path file>]\n");
     fprintf(stderr,"  where <base filename> is used for the parameters, world, and path files.\n");
     fprintf(stderr,"        <path file> [optional] is the file with the path.\n");
   }
  return(EXIT_SUCCESS);
}