/*
    gcodetool, a utility for analyzing/modifying already sliced parts
    Copyright (C) 2018  <email hidden>

    This program is free software: you can redistribute it and/or modify
    it under the terms of the GNU Affero General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU Affero General Public License for more details.

    You should have received a copy of the GNU Affero General Public License
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/
#include <stdio.h>
#include <string.h>
#include <ctype.h>
#include "gcode.h"

int gtool_mirror(const char* filename, const char* outfilename, char axis)
{
  struct gcode* gcode=gcode_read(filename);
  if(!gcode){return -1;}
  printf("Loaded %u bytes of gcode\n", gcode->size);
  double min=999999999;
  double max=-999999999;
  while(gcode_seekcmd(gcode, axis))
  {
    ++gcode->pos;
    double v=gcode_readnumber(gcode);
    if(v<min){min=v;}
    if(v>max){max=v;}
  }
// printf("%c min: %g\n", axis, min);
// printf("%c max: %g\n", axis, max);
  double center=(min+max)/2;
  printf("%c center/pivot point: %g\n", axis, center);
  gcode_reset(gcode);
  // Loop through gcode, cloning most, processing axis coordinates before writing mirrored values
  FILE* out=fopen(outfilename, "w");
  unsigned int lastwrite=0;
  while(gcode_seekcmd(gcode, axis))
  {
    ++gcode->pos;
    fwrite(&gcode->code[lastwrite], 1, gcode->pos-lastwrite, out);
    double v=gcode_readnumber(gcode);
    lastwrite=gcode->pos;
    fprintf(out, "%g ", center*2-v);
  }
  // Write the remaining gcode
  fwrite(&gcode->code[lastwrite], 1, gcode->pos-lastwrite, out);
  fclose(out);
  gcode_free(gcode);
  return 0;
}

int gtool_mirror_arg(int argc, char** argv)
{
  const char* filename=0;
  const char* outfilename=0;
  char axis=toupper(argv[1][6]);
  int i;
  for(i=2; i<argc; ++i)
  {
    if(!strcmp(argv[i], "-h") || !strcmp(argv[i], "--help"))
    {
      filename=0; // Setting filename to 0 is a shortcut to avoid having to track the help option, both cases show the help
      break;
    }
    else if(!strcmp(argv[i], "-o") && i+1<argc)
    {
      outfilename=argv[++i];
    }
    else if(!filename)
    {
      filename=argv[i];
    }else{
      filename=0;
      break;
    }
  }
  if(!filename)
  {
    printf("Usage: %s %s [options] <filename>\n"
           "Options:\n"
           "-o <filename> = leave the input file unchanged and write\n"
           "                  the changed version to <filename>\n"
           "-h/--help     = display this help text\n", argv[0], argv[1]);
    return -1;
  }
  if(!outfilename)
  {
    outfilename=filename;
  }
  if(axis=='Z'){printf("Warning! you have chosen to mirror on the Z axis, which is unlikely to give the desired outcome (for now anyway)\n");}
  return gtool_mirror(filename, outfilename, axis);
}