roboforum.ru

import org.reprap.*;
import org.reprap.geometry.polygons.*;
import org.reprap.gui.*;
import org.reprap.utilities.*;

STLObject stl;
STLSlice stlsl;
RrCSGPolygonList slice;
RrGraphics rr;

void setup()
{
  size(640,640);
  background(0);
  stroke(0,255,0);
  stl = new STLObject();
  stl.addSTL("file:/c:/test.stl");
  stlsl = new STLSlice(stl);
 
  println(stlsl.maxZ());
  slice = stlsl.slice(15); 
  rr = new RrGraphics(slice.get(0));
/*  for(int i=0;i<20;i++){
    slice = stlsl.slice(i); 
    println(slice.size());
  }
  */
}

void draw(){
  point(mouseX,mouseY);
  rr.plot();
}

public class RrGraphics
{
   final color background = color (0,0,0);
   final color boxes = color(0,255,0);
   final color polygon1 = color(0,255,0);
   final color polygon0 = color(0,255,0);
   final color infill = color(0,255,120);
   final color hatch1 = color(120,255,0);
   final color hatch0 = color(120,255,120);   

   private final int frame = 600;
   private int frameWidth;
   private int frameHeight;
   private RrCSGPolygon csg_p = null;
   private boolean csgSolid = true;
   private double scale;
   private Rr2Point p_0;
   private Rr2Point pos;
   private RrBox scaledBox, originalBox;
   private boolean plot_box = false;
   
   private void setScales(RrBox b)
   {
      scaledBox = b.scale(1.2);
      
      double width = scaledBox.x().length();
      double height = scaledBox.y().length();
      if(width > height)
      {
         frameWidth = frame;
         frameHeight = (int)(0.5 + (frameWidth*height)/width);
      } else
      {
         frameHeight = frame;
         frameWidth = (int)(0.5 + (frameHeight*width)/height);
      }
      double xs = (double)frameWidth/width;
      double ys = (double)frameHeight/height;
      
      if (xs < ys)
         scale = xs;
      else
         scale = ys;   
      p_0 = new Rr2Point((frameWidth - (width + 2*scaledBox.x().low())*scale)*0.5,
            (frameHeight - (height + 2*scaledBox.y().low())*scale)*0.5);
      
      pos = new Rr2Point(width*0.5, height*0.5);
   }
   

   private void init(RrBox b)
   {
      originalBox = b;
      setScales(b);                  
   }
   
   public RrGraphics(RrCSGPolygon cp)
   {
      csg_p = cp;      
      init(csg_p.box());
   }
   

   public RrGraphics()
   {
      csg_p = null;
   }

   private Rr2Point transform(Rr2Point p)
   {
      return new Rr2Point(p_0.x() + scale*p.x(), (double)frameHeight -
            (p_0.y() + scale*p.y()));
   }

   private Rr2Point iTransform(int x, int y)
   {
      return new Rr2Point(((double)x - p_0.x())/scale, ((double)(frameHeight - y)
            - p_0.y())/scale);
   }

   private void move(Rr2Point p)
   {
      pos = transform(p);
   }

   private void plot(Rr2Point p)
   {
      Rr2Point a = transform(p);
      line((int)Math.round(pos.x()), (int)Math.round(pos.y()),
            (int)Math.round(a.x()), (int)Math.round(a.y()));
      pos = a;
   }

   private void plot(RrBox b)
   {
      if(RrBox.intersection(b, scaledBox).empty())
         return;
      
      stroke(boxes);
      move(b.sw());
      plot(b.nw());
      plot(b.ne());
      plot(b.se());
      plot(b.sw());
   }

   private void plot(RrPolygon p)
   {
      if(RrBox.intersection(p.getBox(), scaledBox).empty())
         return;
      
      move(p.point(0));
      stroke(polygon1);
      for(int i = 1; i < p.size(); i++)   
            plot(p.point(i));
      stroke(polygon0);
      plot(p.point(0));
   }

   private void plot(RrLine a, RrInterval i)
   {
      if(i.empty()) return;
      move(a.point(i.low()));
      plot(a.point(i.high()));
   }

   private void fillCSG(RrCSGPolygon q)
   {
      if(RrBox.intersection(q.box(), scaledBox).empty())
         return;
      
      if(q.c_1() != null)
      {
         fillCSG(q.c_1());
         fillCSG(q.c_2());
         fillCSG(q.c_3());
         fillCSG(q.c_4());
         return;
      }
      
      if(q.csg().operator() == RrCSGOp.NULL)
         return;
         
      stroke(infill);
      Rr2Point sw = transform(q.box().sw());
      Rr2Point ne = transform(q.box().ne());
      int x0 = (int)Math.round(sw.x());
      int y0 = (int)Math.round(sw.y());
      int x1 = (int)Math.round(ne.x());
      int y1 = (int)Math.round(ne.y());
      
      if(q.csg().operator() == RrCSGOp.UNIVERSE)
      {
         rect(x0, y1, x1 - x0 + 1, y0 - y1 + 1);
         return;
      }
      
      for(int x = x0; x <= x1; x++)
      {
         for(int y = y1; y <= y0; y++)  // Bloody backwards coordinates...
         {
            Rr2Point p = iTransform(x, y);
            double v = q.csg().value(p);
            if(v <= 0)
               rect(x, y, 1, 1);
         }
      }
      
   }
   
   private void boxCSG(RrCSGPolygon q)
   {
      if(RrBox.intersection(q.box(), scaledBox).empty())
         return;
      
      if(q.c_1() != null)
      {
         boxCSG(q.c_1());
         boxCSG(q.c_2());
         boxCSG(q.c_3());
         boxCSG(q.c_4());
         return;
      }
      plot(q.box());
   }

   private void plot(RrCSGPolygon q)
   {
      if(RrBox.intersection(q.box(), scaledBox).empty())
         return;      
      
      if(q.c_1() != null)
      {
         plot(q.c_1());
         plot(q.c_2());
         plot(q.c_3());
         plot(q.c_4());
         return;
      }
      
      stroke(polygon1);
      if(q.csg().complexity() == 1)
         plot(q.csg().plane().pLine(), q.interval1());
      else if (q.csg().complexity() == 2)
      {
         plot(q.csg().c_1().plane().pLine(), q.interval1());
         plot(q.csg().c_2().plane().pLine(), q.interval2());
      }
   }
   
   private void plot()
   {
      if(csg_p != null)
      {
         if(csgSolid)
            fillCSG(csg_p);
         
         if(plot_box)
            boxCSG(csg_p);
         else
            plot(csg_p.box());
         
         plot(csg_p);
      }
      

   }
}