cuikplotrrt.c

Go to the documentation of this file.

#include "world.h"
#include "parameters.h"

#include "defines.h"
#include "error.h"
#include "filename.h"
#include "rrt.h"

#include <stdlib.h>

int main(int argc, char **arg)
{
  TAtlasBase world;        /* The set of mechanism and obstacles.  */
  Tparameters parameters;  /* Parameters used in the Cuik process. */
  Trrt rrt;                /* The rrt to plot. */

  unsigned int nx,ny,nz;
  unsigned int xID,yID,zID;
  unsigned int i,s,nv,nvs;  
  boolean *systemVars;

  Tfilename fparam;
  Tfilename fplot;
  Tfilename frrt;
  
  if (argc==5)
    { 
      /*Init parameters*/
      CreateFileName(NULL,arg[1],NULL,PARAM_EXT,&fparam);
      InitParametersFromFile(GetFileFullName(&fparam),&parameters);
      fprintf(stderr,"Reading parameters from           : %s\n",GetFileFullName(&fparam));

      /*Read the world from file*/
      CS_WD_INIT(&parameters,arg[1],&world);
      nv=CS_WD_GET_SYSTEM_VARS(&systemVars,&world);

      CreateFileName(NULL,arg[1],NULL,RRT_EXT,&frrt);
      fprintf(stderr,"Reading rrt from                  : %s\n",GetFileFullName(&frrt));
      LoadRRT(&parameters,&frrt,&world,&rrt);

      nx=atoi(arg[2]);
      ny=atoi(arg[3]);
      nz=atoi(arg[4]);
      
      fprintf(stderr,"Projecting on variables           : ");
      PRINT_VARIABLE_NAME(stderr,CS_WD_GET_SYSTEM_VAR_NAME(nx,&world));fprintf(stderr,",");
      PRINT_VARIABLE_NAME(stderr,CS_WD_GET_SYSTEM_VAR_NAME(ny,&world));fprintf(stderr,",");
      PRINT_VARIABLE_NAME(stderr,CS_WD_GET_SYSTEM_VAR_NAME(nz,&world));fprintf(stderr,"\n");
      
      nvs=0;
      s=0;
      for(i=0;i<nv;i++)
        {
          if (systemVars[i])
            {
              /* Transform index from system variables only to
                 all variables (in the original system in both cases!!) */
              if (nx==nvs) {xID=i; s++;}
              if (ny==nvs) {yID=i; s++;}
              if (nz==nvs) {zID=i; s++;}
              nvs++;
            }
        }

      if (s!=3)
        Error("Projection dimensions are beyond the ambient space dimensionality");

      CreateFileName(NULL,arg[1],"_rrt",PLOT3D_EXT,&fplot);
      fprintf(stderr,"Generating rrt plot to            : %s\n",GetFileFullName(&fplot));

      PlotRRT(GetFileFullName(&fplot),argc,arg,&parameters,xID,yID,zID,&rrt);

      DeleteParameters(&parameters);

      free(systemVars);

      CS_WD_DELETE(&world);

      DeleteRRT(&rrt);

      DeleteFileName(&fplot);
      DeleteFileName(&frrt);
      DeleteFileName(&fparam);
    }
 else
   {
     fprintf(stderr,"  Wrong number of parameters.\n");
     fprintf(stderr,"  Use:\n");   
     fprintf(stderr,"      cuikplotrrt <problem filename> <xID> <yID> <zID>\n");
     fprintf(stderr,"  where <problem filename> is the rrt to plot\n");
     fprintf(stderr,"        <xID> <yID> <zID> are the 3 projection dimensions\n");
     
   }
  return(EXIT_SUCCESS);
}