cuikTWS.c

Go to the documentation of this file.

#include "parameters.h"
#include "defines.h"
#include "world.h"
#include "error.h"
#include "filename.h"

#include <stdlib.h>
#include <string.h>
#include <unistd.h>

int main(int argc, char **arg)
{
  Tparameters parameters;     /* Parameters */
  Tworld world;               /* Environemtn and mechanisms */
  TCuikSystem cs;             /* The cuiksystem to generate*/

  Tfilename fparam;
  Tfilename fcuik;
  
  FILE *f;

  if (argc>2)
    {
      /*Init parameters*/
      CreateFileName(NULL,arg[1],NULL,PARAM_EXT,&fparam);
      #if (_DEBUG>0)
        printf("Reading parameter file            : %s\n",GetFileFullName(&fparam));
      #endif
      InitParametersFromFile(GetFileFullName(&fparam),&parameters);

      /*keep equations in the original form*/
      ChangeParameter(CT_DUMMIFY,0,&parameters);
      
      /*Read the world file*/
      InitWorldFromFile(&parameters,TRUE,arg[1],&world);

      /*Add TWS equations*/
      GenerateWorldTWSEquations(&parameters,arg[2],&cs,&world);
      
      /*Print resulting extended cuiksystem*/
      CreateFileName(NULL,arg[1],"_TWS",CUIK_EXT,&fcuik);

      f=fopen(GetFileFullName(&fcuik),"w");
      if (!f)
         Error("Could not open output file in cuiksingequations");     
      #if (_DEBUG>0)
        printf("Generating the _TWS.cuik file     : %s\n",GetFileFullName(&fcuik));
      #endif
      PrintCuikSystemWithSimplification(&parameters,f,&cs);
      fclose(f);

      /* link the parameter/joints/links files */
      LinkFileNameWithExtension(arg[1],PARAM_EXT ,&fcuik);
      LinkFileNameWithExtension(arg[1],JOINTS_EXT,&fcuik);
      LinkFileNameWithExtension(arg[1],LINKS_EXT ,&fcuik);

      /* Delete the data structures */
      DeleteCuikSystem(&cs);
      DeleteParameters(&parameters);

      /* Delete the file names */
      DeleteFileName(&fparam);
      DeleteFileName(&fcuik);
    }
  else
    {
      fprintf(stderr,"  Wrong number of parameters.\n");
      fprintf(stderr,"  Use:\n");   
      fprintf(stderr,"      cuikTWS <Sing> <problem name>\n");
      fprintf(stderr,"  where \n");
      fprintf(stderr,"       <problem name> is the world file from which to generate the equations\n");
      fprintf(stderr,"       <Sing> It must be the name of the link to focus\n");
    }

  return(EXIT_SUCCESS);
}