import java.io.*;

public class LogoCanvasWithCNC extends LogoCanvas {

  Writer out;
  
  static int index = 1;
  int places=4;
  
  double downDepth=1, upDepth=.1;
  double scale = 1;
  double dx, dy;  // double, not difference
  
  public LogoCanvasWithCNC(Writer out) {
    this.out = out;
  }
  
  public void start() {
    try {
      out.write("\n");
      out.write("\n%\n");
      out.write("O"+(index++)+"\n");
      out.write("[G90, M6m M8, etc...]\n");
      out.flush();
    }
    catch (Exception e) { System.out.println("Error writing CNC: "+e); }
  }
  public void end() {
    try {
      if (penDown) out.write("G01 Z"+upDepth+"\n");
      out.write("M30\n");
      out.write("\n%\n");
      out.flush();
    }
    catch (Exception e) { System.out.println("Error writing CNC: "+e); }
  }
  
  public void penUp() {
    try {
      if (penDown) out.write("G01 Z"+formatDouble(upDepth)+"\n");
      out.flush();
    }
    catch (Exception e) { System.out.println("Error writing CNC: "+e); }
    super.penUp();
  }
  
  public void penDown() {
    try {
      if (!penDown) out.write("G01 Z"+formatDouble(downDepth)+"\n");
      out.flush();
    }
    catch (Exception e) { System.out.println("Error writing CNC: "+e); }
    super.penDown();
  }
  
  public void forward(double d) {
    try {
      double px=dx, py=dy;
      dx += d*Math.cos(ang);
      dy += d*Math.sin(ang);
      if (penDown) out.write("G01 X"+formatDouble(scale*dx)+" Y"+formatDouble(scale*dy)+"\n");
      else out.write("G00 X"+formatDouble(scale*dx)+" Y"+formatDouble(scale*dy)+"\n");
    }
    catch (Exception e) { System.out.println("Error writing CNC: "+e); }
    super.forward(d);
  }
  
  public String formatDouble(double d) {
    double pow = Math.pow(10, places);
    d *= pow;
    d += .5;
    return ""+((long)d)/pow;
  }
  
}