plt.bak

激光加工控制系统 可以读入plt文件

#include <stdio.h>
#include <graphics.h>
#include <math.h>

int get_a_line(FILE *fpe);

char buf[100];
float huge xarr[300][180];
float huge yarr[300][180];
int end_arr;
int end_p[500];
float min_x[500],max_x[500],min_y[500],max_y[500];
int con[500][20];
int end_con[500];

int cur_order;
int order[500];
int cutted[500];


int cut(int n);

main()
{
/*
  FILE *fpe;
  char filename[20];
  int gdriver = DETECT, gmode=18, errorcode;
  int ret,i,x1,y1,x2,y2,j,flag,m;
  float fx,fy;
  long minx,miny,maxx,maxy;
  long curx,cury,x,y,oldx,oldy;

//  printf("Please Input Your File Name To Simu:\n");
//  scanf("%s",filename);
  strcpy(filename,"d:\\a.plt");
  fpe = fopen(filename,"rb");
  ret = get_a_line(fpe);
  minx = miny = maxx = maxy = curx = cury = 0;
  while (ret != -1){
    if (buf[0] == 'P'){
      if ((buf[1] == 'U')||(buf[1] == 'D')){
	x = atoi(&(buf[2]));
	i = 2;
	while (buf[i] != ' ')
	  i ++;
	y = atoi(&(buf[i]));
	curx = x;
	cury = y;
	if (minx > curx)
	  minx = curx;
	if (maxx < curx)
	  maxx = curx;
	if (miny > cury)
	  miny = cury;
	if (maxy < cury)
	  maxy = cury;
      }
    }
    ret = get_a_line(fpe);
  }
  fclose(fpe);
  fpe = fopen(filename,"rb");
  ret = get_a_line(fpe);
  oldx = oldy = 0;
  initgraph(&gdriver, &gmode, "");
  setcolor(WHITE);
  x1 = -1000;
  end_arr = -1;
  j = 0;
  flag = 0;
  while (ret != -1){
    if (buf[0] == 'P'){
      if ((buf[1] == 'U')||(buf[1] == 'D')){
	x = atol(&(buf[2]));
	i = 2;
	while (buf[i] != ' ')
	  i ++;
	y = atol(&(buf[i]));
	curx = x;
	cury = y;
	if (fabs(maxx-minx) > fabs(maxy-miny)){
	  x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	  y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxx-minx);
	  x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	  y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxx-minx);
	}
	else{
	  x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	  y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxy-miny);
	  x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	  y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxy-miny);
	}
	if (buf[1] == 'D'){
//	  line(x1,y1,x2,y2);
	  if (flag == 1){
//	    line(x1-5,y1-5,x1+5,y1+5);
//	    line(x1+5,y1-5,x1-5,y1+5);
	    flag = 0;
	  }
	}
	oldx = curx;
	oldy = cury;
	xarr[end_arr][end_p[end_arr]] = x;
	yarr[end_arr][end_p[end_arr]] = y;
	end_p[end_arr]++;
      }
    }
    if ((buf[0] == 'L')&&(buf[1] == 'T')){
	flag = 1;
	if (end_arr != -1){
	  end_arr ++;
	  end_p[end_arr] = 0;
	}
	else{
	  end_arr = 0;
	  end_p[end_arr] = 0;
	}
    }
    ret = get_a_line(fpe);
  }
  fclose(fpe);
  end_arr ++;
  for (i=0;i<end_arr;i++){
    min_x[i] = 1000000;
    max_x[i] = -1000000;
    min_y[i] = 1000000;
    max_y[i] = -1000000;
    for (j=0;j<end_p[i];j++){
      x = xarr[i][j];
      y = yarr[i][j];
      if (x < min_x[i])
	min_x[i] = x;
      if (x > max_x[i])
	max_x[i] = x;
      if (y < min_y[i])
	min_y[i] = y;
      if (y > max_y[i])
	max_y[i] = y;
    }
  }
  for (i=0;i<end_arr;i++){
    end_con[i] = 0;
    for (j=0;j<end_arr;j++){
      if (i != j){
	if ((min_x[j] >= min_x[i])&&(max_x[j] <= max_x[i])&&
	    (min_y[j] >= min_y[i])&&(max_y[j] <= max_y[i])){
	  con[i][end_con[i]] = j;
	  end_con[i] ++;
	}
      }
    }
  }

  for (i=0;i<end_arr;i++){
    for (j=0;j<end_con[i];j++)
      printf("%d ",con[i][j]);
    printf("\n");
  }

  cur_order = 0;
  for (i=0;i<end_arr;i++)
    cutted[i] = 0;
  flag = 0;
  j = 0;
  while (flag == 0){
    cut(j);
    j ++;
    flag = 1;
    for (i=0;i<end_arr;i++)
      if (cutted[i] == 0)
	flag = 0;
  }

  for (i=0;i<end_arr;i++){
    for (j=0;j<end_arr;j++){
      if (order[j] == i){
	for (m=0;m<end_p[j];m++){
	  curx = xarr[j][m];
	  cury = yarr[j][m];
	  if (fabs(maxx-minx) > fabs(maxy-miny)){
	    x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	    y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxx-minx);
	    x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	    y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxx-minx);
	  }
	  else{
	    x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	    y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxy-miny);
	    x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	    y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxy-miny);
	  }
	  if (m != 0)
	    line(x1,y1,x2,y2);
	  oldx = curx;
	  oldy = cury;
	}
      }
    }
    getch();
  }
  closegraph();

  fpe = fopen("test.g","w");
  fprintf(fpe,"G92X0Y0\n");
  fprintf(fpe,"F1000\n");
  fprintf(fpe,"M9\n");
  for (i=0;i<end_arr;i++){
    for (j=0;j<end_arr;j++){
      if (order[j] == i){
	for (m=0;m<end_p[j];m++){
	  fx = xarr[j][m];
	  fy = yarr[j][m];
	  if (m != 0){
	    fprintf(fpe,"G01X%fY%f\n",(fx+6000)/10,(fy+4500)/10);
	  }
	  else{
	    fprintf(fpe,"G01X%fY%f\n",(fx+6000)/10,(fy+4500)/10);
	    fprintf(fpe,"M8\n");
	  }
	  oldx = fx;
	  oldy = fy;
	}
	fprintf(fpe,"M9\n");
      }
    }
  }

  fclose(fpe);
*/
  trans_plt_to_g_code();
}

trans_plt_to_g_code()
{
  FILE *fpe;
  char filename[20];
  int ret,i,x1,y1,x2,y2,j,flag,m;
  float fx,fy;
  int spd;
  long minx,miny,maxx,maxy;
  long curx,cury,x,y,oldx,oldy;
  int gdriver = DETECT, gmode=18, errorcode;

  initgraph(&gdriver, &gmode, "");
  setcolor(WHITE);
  strcpy(filename,"d:\\a.plt");
  fpe = fopen(filename,"rb");
  if (fpe == NULL){
	  return -1;
  }
  ret = get_a_line(fpe);
  minx = miny = maxx = maxy = curx = cury = 0;
  while (ret != -1){
	  if ((buf[0] == 'V')&&(buf[1] == 'S')){
        spd = atoi(&(buf[2]));
	  }
    if (buf[0] == 'P'){
      if ((buf[1] == 'U')||(buf[1] == 'D')){
	x = atoi(&(buf[2]));
	i = 2;
	while (buf[i] != ' ')
	  i ++;
	y = atoi(&(buf[i]));
	curx = x;
	cury = y;
	if (minx > curx)
	  minx = curx;
	if (maxx < curx)
	  maxx = curx;
	if (miny > cury)
	  miny = cury;
	if (maxy < cury)
	  maxy = cury;
      }
    }
    ret = get_a_line(fpe);
  }
  fclose(fpe);
  fpe = fopen(filename,"rb");
  ret = get_a_line(fpe);
  oldx = oldy = 0;
  x1 = -1000;
  end_arr = -1;
  j = 0;
  flag = 0;
  while (ret != -1){
    if (buf[0] == 'P'){
      if ((buf[1] == 'U')||(buf[1] == 'D')){
	x = atol(&(buf[2]));
	i = 2;
	while (buf[i] != ' ')
	  i ++;
	y = atol(&(buf[i]));
	curx = x;
	cury = y;
	if (fabs(maxx-minx) > fabs(maxy-miny)){
	  x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	  y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxx-minx);
	  x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	  y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxx-minx);
	}
	else{
	  x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	  y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxy-miny);
	  x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	  y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxy-miny);
	}
	if (buf[1] == 'D'){
	  if (flag == 1){
	    flag = 0;
	  }
	}
	oldx = curx;
	oldy = cury;
	xarr[end_arr][end_p[end_arr]] = x;
	yarr[end_arr][end_p[end_arr]] = y;
	end_p[end_arr]++;
      }
    }
    if ((buf[0] == 'L')&&(buf[1] == 'T')){
	flag = 1;
	if (end_arr != -1){
	  end_arr ++;
	  end_p[end_arr] = 0;
	}
	else{
	  end_arr = 0;
	  end_p[end_arr] = 0;
	}
    }
    ret = get_a_line(fpe);
  }
  fclose(fpe);
  end_arr ++;
  for (i=0;i<end_arr;i++){
    min_x[i] = 1000000;
    max_x[i] = -1000000;
    min_y[i] = 1000000;
    max_y[i] = -1000000;
    for (j=0;j<end_p[i];j++){
      x = xarr[i][j];
      y = yarr[i][j];
      if (x < min_x[i])
	min_x[i] = x;
      if (x > max_x[i])
	max_x[i] = x;
      if (y < min_y[i])
	min_y[i] = y;
      if (y > max_y[i])
	max_y[i] = y;
    }
  }
  for (i=0;i<end_arr;i++){
    end_con[i] = 0;
    for (j=0;j<end_arr;j++){
      if (i != j){
	if ((min_x[j] >= min_x[i])&&(max_x[j] <= max_x[i])&&
	    (min_y[j] >= min_y[i])&&(max_y[j] <= max_y[i])){
	  con[i][end_con[i]] = j;
	  end_con[i] ++;
	}
      }
    }
  }

  for (i=0;i<end_arr;i++){
    for (j=0;j<end_con[i];j++)
      printf("%d ",con[i][j]);
    printf("\n");
  }

  cur_order = 0;
  for (i=0;i<end_arr;i++)
    cutted[i] = 0;
  flag = 0;
  j = 0;
  while (flag == 0){
    cut(j);
    j ++;
    flag = 1;
    for (i=0;i<end_arr;i++)
      if (cutted[i] == 0)
	flag = 0;
  }

  for (i=0;i<end_arr;i++){
    for (j=0;j<end_arr;j++){
      if (order[j] == i){
	for (m=0;m<end_p[j];m++){
	  curx = xarr[j][m];
	  cury = yarr[j][m];
	  if (fabs(maxx-minx) > fabs(maxy-miny)){
	    x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	    y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxx-minx);
	    x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxx-minx) + 240;
	    y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxx-minx);
	  }
	  else{
	    x1 = 480.0*(oldx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	    y1 = 240 - 480.0*(oldy-(maxy+miny)/2.0)/(maxy-miny);
	    x2 = 480.0*(curx-(maxx+minx)/2.0)/(maxy-miny) + 240;
	    y2 = 240 - 480.0*(cury-(maxy+miny)/2.0)/(maxy-miny);
	  }
	  oldx = curx;
	  oldy = cury;
	}
      }
    }
  }

  fpe = fopen("c:\\jgs\\test.g","w");
  fprintf(fpe,"G92X0Y0\n");
  fprintf(fpe,"F");
  spd = spd*10;
  fprintf(fpe,"%d",spd);
  fprintf(fpe,"\n");
  fprintf(fpe,"M9\n");
  for (i=0;i<end_arr;i++){
    for (j=0;j<end_arr;j++){
      if (order[j] == i){
	for (m=0;m<end_p[j];m++){
	  fx = xarr[j][m];
	  fy = yarr[j][m];
	  if (m != 0){
	    fprintf(fpe,"G01X%fY%f\n",(fx+6000)/10,(fy+4500)/10);
	  }
	  else{
	    fprintf(fpe,"G01X%fY%f\n",(fx+6000)/10,(fy+4500)/10);
	    fprintf(fpe,"M8\n");
	  }
	  oldx = fx;
	  oldy = fy;
	}
	fprintf(fpe,"M9\n");
      }
    }
  }

  fprintf(fpe,"G00X0Y0\n");
  fclose(fpe);

  closegraph();
  return 1;
}


get_a_line(FILE *fpe)
{
  int i,ch;

  ch = fgetc(fpe);
  if (ch == EOF)
    return -1;
  i = 0;
  while ((ch != 13)&&(ch != 10)&&(ch != EOF)){
    buf[i++] = ch;
    ch = fgetc(fpe);
  }
  buf[i] = 0;
  if (ch == EOF)
    return -1;
  fgetc(fpe);

  return 0;
}

int cut(int n)
{
  int k;

  if (cutted[n] == 1)
    return 1;
  if (end_con[n] == 0){
    order[n] = cur_order;
    cur_order ++;
    cutted[n] = 1;
    return 1;
  }
  for (k=0;k<end_con[n];k++)
    cut(con[n][k]);
  order[n] = cur_order;
  cur_order ++;
  cutted[n] = 1;
  return 1;
}