---

inisim.cc

Go to the documentation of this file.

#include "simmot_n.h"
#include "inifile.h"
#include "emcglb.h"
#include <stdlib.h>
#include <string.h>


NML *sim_cmd;
NML *sim_stat;
SIMMOT_COMMAND cmd;

int main(int argc, char **argv)
{
  emcGetArgs(argc,argv); // get EMC_NMLFILE, and EMC_INIFILE;
  INIFILE inifile;
  const char *inistring;

  // open it
  if (-1 == inifile.open(EMC_INIFILE)) {
    exit(-1);
  }

  if (NULL != (inistring = inifile.find("NML_FILE", "EMC"))) {
    // copy to global
    strcpy(EMC_NMLFILE, inistring);
  }
  else {
    // not found, use default
  }


  sim_cmd = new NML(simmot_format, "simmot_cmd","inisim",EMC_NMLFILE);
  if(NULL == sim_cmd)
    {
      exit(-1);
    }
  if(!sim_cmd->valid())
    {
      exit(-1);
    }

  sim_stat = new NML(simmot_format, "simmot_stat","inisim",EMC_NMLFILE);
  if(NULL == sim_stat)
    {
      exit(-1);
    }
  if(!sim_stat->valid())
    {
      exit(-1);
    }
  int retval,t;
  char sectionString[INIFILE_MAX_LINELEN];

  for (t = 0; t < SIM_MAX_AXIS; t++)
    {
#ifndef UNDER_CE
      sprintf(sectionString, "AXIS_%d", t);
#else
      strcpy(sectionString,"AXIS_");
      _itoa(t,sectionString+5,10);
#endif

      if (0 != amplifierIniLoad(&cmd.data.amplifier[t], EMC_INIFILE, sectionString))
        {
          retval = -1;
        }
      if (0 != dcmotorIniLoad(&cmd.data.dcmotor[t], EMC_INIFILE, sectionString))
        {
          retval = -1;
        }
      if (0 != encoderIniLoad(&cmd.data.encoder[t], EMC_INIFILE, sectionString))
        {
          retval = -1;
        }
    }
  sim_cmd->write(&cmd);
  while(sim_stat->read() == 0) ;

  delete sim_cmd;
  delete sim_stat;


}

---