tt.bak

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

  bb_y = y_ps;
  if (buf[b_p] == 'X'){
    e_x = atof(&(buf[b_p+1]));
    e_x -= o_x;
    i = b_p + 1;
    while ((buf[i] != 'Y')&&(buf[i] != 0))
      i ++;
    if (buf[i] == 'Y'){
      e_y = atof(&(buf[i+1]));
      e_y -= o_y;
    }
    else{
      e_y = b_y;
    }
  }
  else{
    e_x = b_x;
    e_y = atof(&(buf[b_p+1]));
    e_y -= o_y;
  }

  if (fabs(e_x-b_x) + fabs(e_y-b_y) < 0.0001)
    return -1;
  if (fabs(e_x) + fabs(e_y) < 0.0001)
    i = 0;
  oldx = curx = b_x;
  oldy = cury = b_y;
  x_pp = (e_x-b_x)*xsteps;
  y_pp = (e_y-b_y)*ysteps;
  x_c = 0;
  y_c = 0;
  if (fabs(e_x-b_x) > fabs(e_y-b_y)){
    len = sqrt((e_x-b_x)*(e_x-b_x)+(e_y-b_y)*(e_y-b_y));
    if (len*xsteps > 2*x_len_to_acc){
      s = (len*xsteps - 2*x_len_to_acc) -
	  (int)((len*xsteps - 2*x_len_to_acc)/vmax)*vmax;
      s2 = s1 = s/2;
      for (i=0;i<x_times;i++){
	strcpy(buf1,"P");
	if (s1 > 0){
	  if (s1 > 1){
	    xx = (i+1)*x_once_max_a_pulses + 2;
	    s1 -= 2;
	  }
	  else{
	    xx = (i+1)*x_once_max_a_pulses + 1;
	    s1 --;
	  }
	}
	else
	  xx = (i+1)*x_once_max_a_pulses;
	yy = xx*fabs(e_y-b_y)/fabs(e_x-b_x);
	xx1 = xx;
	yy1 = yy;
	xx = xx*xx1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*xx1/sqrt(xx1*xx1+yy1*yy1);
	if (e_x < b_x)
	  xx = -xx;
	if (e_y < b_y)
	  yy = -yy;
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	curx = oldx + xx/xsteps;
	cury = oldy + yy/ysteps;
	x = xx = (curx - oldx)*xsteps;
	y = yy = ((x_ps + x) - b_x*xsteps)*(e_y-b_y)/(e_x-b_x) + bb_y - y_ps;
	oldx = curx;
	oldy = cury;
	put1();

	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
	x_c += x;
	y_c += y;
      }
      x_a_ps = x_c;

      flag = 0;
      while (flag==0){
	strcpy(buf1,"P");
	xx = vmax*fabs(e_x-b_x)/sqrt((e_x-b_x)*(e_x-b_x)+(e_y-b_y)*(e_y-b_y));
	yy = xx*fabs(e_y-b_y)/fabs(e_x-b_x);

	if (e_x < b_x)
	  xx = -xx;
	if (e_y < b_y)
	  yy = -yy;
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	curx = oldx + xx/xsteps;
	cury = oldy + yy/ysteps;
	x = xx = (curx - oldx)*xsteps;
	y = yy = ((x_ps + x) - b_x*xsteps)*(e_y-b_y)/(e_x-b_x) + bb_y - y_ps;
	if (x_pp > 0){
	  if (x_c+x > (x_pp-x_a_ps)){
	    flag = 1;
	    x = x_pp-x_a_ps - x_c;
	  }
	}
	else{
	  if (-x_c-x > (-x_pp+x_a_ps)){
	    flag = 1;
	    x = x_pp-x_a_ps - x_c;
	  }
	}

	oldx = curx;
	oldy = cury;
	put1();

	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
	x_c += x;
	y_c += y;

      }

      for (i=0;i<x_times;i++){
	strcpy(buf1,"P");
	if (s2 > 0){
	  if (s2 > 1){
	    xx = (x_times - i)*x_once_max_a_pulses + 2;
	    s2 -= 2;
	  }
	  else{
	    xx = (x_times - i)*x_once_max_a_pulses + 1;
	    s2 --;
	  }
	}
	else
	  xx = (x_times - i)*x_once_max_a_pulses;
	yy = xx*fabs(e_y-b_y)/fabs(e_x-b_x);
	xx1 = xx;
	yy1 = yy;
	xx = xx*xx1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*xx1/sqrt(xx1*xx1+yy1*yy1);
	if (e_x < b_x)
	  xx = -xx;
	if (e_y < b_y)
	  yy = -yy;
	if (i != x_times-1){
	  curx = oldx + xx/xsteps;
	  cury = oldy + yy/ysteps;
	}
	else{
	  curx = e_x;
	  cury = e_y;
	}
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	x = xx = (curx - oldx)*xsteps;
	y = yy = ((x_ps + x) - b_x*xsteps)*(e_y-b_y)/(e_x-b_x) + bb_y - y_ps;
	put1();
	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
	x_c += x;
	y_c += y;
      }
    }
    else{
      len /= 2;
      times = 0;
      ll = 0;
      while (ll < len){
        times ++;
        xx = times*x_once_max_a_pulses/xsteps;
	yy = xx*fabs(e_y-b_y)/fabs(e_x-b_x);
	xx1 = xx;
	yy1 = yy;
	xx = xx*xx1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*xx1/sqrt(xx1*xx1+yy1*yy1);
	ll += sqrt(xx*xx + yy*yy);
      }
      ll -= sqrt(xx*xx + yy*yy);
      times --;
      s1 = s2 = (len - ll)*xsteps;
      for (i=0;i<times;i++){
	strcpy(buf1,"P");
	if (s1 > 0){
	  if (s1 > 1){
	    xx = (i+1)*x_once_max_a_pulses + 2;
	    s1 -= 2;
	  }
	  else{
	    xx = (i+1)*x_once_max_a_pulses + 1;
	    s1 --;
	  }
	}
	else
	  xx = (i+1)*x_once_max_a_pulses;
	yy = xx*fabs(e_y-b_y)/fabs(e_x-b_x);
	xx1 = xx;
	yy1 = yy;
	xx = xx*xx1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*xx1/sqrt(xx1*xx1+yy1*yy1);
	if (e_x < b_x)
	  xx = -xx;
	if (e_y < b_y)
	  yy = -yy;
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	curx = oldx + xx/xsteps;
	cury = oldy + yy/ysteps;
	x = xx = (curx - oldx)*xsteps;
	y = yy = ((x_ps + x) - b_x*xsteps)*(e_y-b_y)/(e_x-b_x) + bb_y - y_ps;
	oldx = curx;
	oldy = cury;
	put1();

	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
      }

      for (i=0;i<times;i++){
	strcpy(buf1,"P");
	if (s2 > 0){
	  if (s2 > 1){
	    xx = (times - i)*x_once_max_a_pulses + 2;
	    s2 -= 2;
	  }
	  else{
	    xx = (times - i)*x_once_max_a_pulses + 1;
	    s2 --;
	  }
	}
	else
	  xx = (times - i)*x_once_max_a_pulses;
	yy = xx*fabs(e_y-b_y)/fabs(e_x-b_x);
	xx1 = xx;
	yy1 = yy;
	xx = xx*xx1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*xx1/sqrt(xx1*xx1+yy1*yy1);
	if (e_x < b_x)
	  xx = -xx;
	if (e_y < b_y)
	  yy = -yy;
	if (i != times-1){
	  curx = oldx + xx/xsteps;
	  cury = oldy + yy/ysteps;
	}
	else{
	  curx = e_x;
	  cury = e_y;
	}
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	x = xx = (curx - oldx)*xsteps;
	y = yy = ((x_ps + x) - b_x*xsteps)*(e_y-b_y)/(e_x-b_x) + bb_y - y_ps;
	oldx = curx;
	oldy = cury;
	put1();
	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;

      }
    }
  }
  else{
    len = sqrt((e_y-b_y)*(e_y-b_y)+(e_x-b_x)*(e_x-b_x));
    if (len*ysteps > 2*y_len_to_acc){
      s = (len*ysteps - 2*y_len_to_acc) -
	  (int)((len*ysteps - 2*y_len_to_acc)/vmax)*vmax;
      s2 = s1 = s/2;
      for (i=0;i<y_times;i++){
	strcpy(buf1,"P");
	if (s1 > 0){
	  if (s1 > 1){
	    yy = (i+1)*y_once_max_a_pulses + 2;
	    s1 -= 2;
	  }
	  else{
	    yy = (i+1)*y_once_max_a_pulses + 1;
	    s1 --;
	  }
	}
	else
	  yy = (i+1)*y_once_max_a_pulses;
	xx = yy*fabs(e_x-b_x)/fabs(e_y-b_y);
	xx1 = xx;
	yy1 = yy;
	xx = xx*yy1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*yy1/sqrt(xx1*xx1+yy1*yy1);
	if (e_y < b_y)
	  yy = -yy;
	if (e_x < b_x)
	  xx = -xx;
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	curx = oldx + xx/xsteps;
	cury = oldy + yy/ysteps;
	y = yy = (cury - oldy)*ysteps;
	x = xx = ((y_ps + y) - b_y*ysteps)*(e_x-b_x)/(e_y-b_y) + bb_x - x_ps;
	oldx = curx;
	oldy = cury;
	put1();

	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
	x_c += y;
	y_c += y;
      }

      y_a_ps = x_c;

      flag = 0;
      while (flag == 0){
	strcpy(buf1,"P");
	yy = vmax*fabs(e_y-b_y)/sqrt((e_x-b_x)*(e_x-b_x)+(e_y-b_y)*(e_y-b_y));
	xx = yy*fabs(e_x-b_x)/fabs(e_y-b_y);
	if (e_x < b_x)
	  xx = -xx;
	if (e_y < b_y)
	  yy = -yy;
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	curx = oldx + xx/xsteps;
	cury = oldy + yy/ysteps;
	y = yy = (cury - oldy)*ysteps;
	x = xx = ((y_ps + y) - b_y*ysteps)*(e_x-b_x)/(e_y-b_y) + bb_x - x_ps;
	if (y_pp > 0){
	  if (y_c+y > (y_pp-y_a_ps)){
	    flag = 1;
	    y = y_pp-y_a_ps - y_c;
	  }
	}
	else{
	  if (-y_c-y > (-y_pp+y_a_ps)){
	    flag = 1;
	    y = y_pp-y_a_ps - y_c;
	  }
	}
	oldx = curx;
	oldy = cury;
	put1();

	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
	x_c += x;
	y_c += y;
      }

      for (i=0;i<y_times;i++){
	strcpy(buf1,"P");
	if (s2 > 0){
	  if (s2 > 1){
	    yy = (y_times - i)*y_once_max_a_pulses + 2;
	    s2 -= 2;
	  }
	  else{
	    yy = (y_times - i)*y_once_max_a_pulses + 1;
	    s2 --;
	  }
	}
	else
	  yy = (y_times - i)*y_once_max_a_pulses;
	xx = yy*fabs(e_x-b_x)/fabs(e_y-b_y);
	xx1 = xx;
	yy1 = yy;
	xx = xx*yy1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*yy1/sqrt(xx1*xx1+yy1*yy1);
	if (e_x < b_x)
	  xx = -xx;
	if (e_y < b_y)
	  yy = -yy;
	if (e_x < b_x)
	  xx = -xx;
	if (i != y_times-1){
	  curx = oldx + xx/xsteps;
	  cury = oldy + yy/ysteps;
	}
	else{
	  curx = e_x;
	  cury = e_y;
	}
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	y = yy = (cury - oldy)*ysteps;
	x = xx = ((y_ps + y) - b_y*ysteps)*(e_x-b_x)/(e_y-b_y) + bb_x - x_ps;
	oldx = curx;
	oldy = cury;
	put1();
	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
	x_c += x;
	y_c += y;
      }
    }
    else{
      len /= 2;
      times = 0;
      ll = 0;
      while (ll < len){
	times ++;
	yy = times*y_once_max_a_pulses/ysteps;
	xx = yy*fabs(e_x-b_x)/fabs(e_y-b_y);
	xx1 = xx;
	yy1 = yy;
	xx = xx*yy1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*yy1/sqrt(xx1*xx1+yy1*yy1);
	ll += sqrt(xx*xx + yy*yy);
      }
      ll -= sqrt(xx*xx + yy*yy);
      times --;
      s1 = s2 = (len - ll)*ysteps;
      for (i=0;i<times;i++){
	strcpy(buf1,"P");
	if (s1 > 0){
	  if (s1 > 1){
	    yy = (i+1)*y_once_max_a_pulses + 2;
	    s1 -= 2;
	  }
	  else{
	    yy = (i+1)*y_once_max_a_pulses + 1;
	    s1 --;
	  }
	}
	else
	  yy = (i+1)*y_once_max_a_pulses;
	xx = yy*fabs(e_x-b_x)/fabs(e_y-b_y);
	xx1 = xx;
	yy1 = yy;
	xx = xx*yy1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*yy1/sqrt(xx1*xx1+yy1*yy1);
	if (e_y < b_y)
	  yy = -yy;
	if (e_x < b_x)
	  xx = -xx;
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	curx = oldx + xx/xsteps;
	cury = oldy + yy/ysteps;
	y = yy = (cury - oldy)*ysteps;
	x = xx = ((y_ps + y) - b_y*ysteps)*(e_x-b_x)/(e_y-b_y) + bb_x - x_ps;
	oldx = curx;
	oldy = cury;
	put1();

	oldxx = x;
	oldyy = y;
	x_count += x;
	y_count += y;
      }

      for (i=0;i<times;i++){
	strcpy(buf1,"P");
	if (s2 > 0){
	  if (s2 > 1){
	    yy = (times - i)*y_once_max_a_pulses + 2;
	    s2 -= 2;
	  }
	  else{
	    yy = (times - i)*y_once_max_a_pulses + 1;
	    s2 --;
	  }
	}
	else
	  yy = (times - i)*y_once_max_a_pulses;
	xx = yy*fabs(e_x-b_x)/fabs(e_y-b_y);
	xx1 = xx;
	yy1 = yy;
	xx = xx*yy1/sqrt(xx1*xx1+yy1*yy1);
	yy = yy*yy1/sqrt(xx1*xx1+yy1*yy1);
	if (e_y < b_y)
	  yy = -yy;
	if (e_x < b_x)
	  xx = -xx;
	if (i != times-1){
	  curx = oldx + xx/xsteps;
	  cury = oldy + yy/ysteps;
	}
	else{
	  curx = e_x;
	  cury = e_y;
	}
	oldx = x_ps/xsteps;
	oldy = y_ps/ysteps;
	y = yy = (cury - oldy)*ysteps;
	x = xx = ((y_ps + y) - b_y*ysteps)*(e_x-b_x)/(e_y-b_y) + bb_x - x_ps;
	oldx = curx;
	oldy = cury;
	put1();
      }
      oldxx = x;
      oldyy = y;
    }
  }
  oldx = e_x;
  oldy = e_y;
  return 1;
}


put1()
{
  int i;

  if ((((oldxx > 0)&&(x < 0))||((oldxx < 0)&&(x > 0)))||
      (((oldyy > 0)&&(y < 0))||((oldyy < 0)&&(y > 0)))){
    strcpy(buf1,"P");
    itoa(0,buf2,10);
    strcat(buf1,buf2);
    itoa(0,buf2,10);
    strcat(buf1," ");
    strcat(buf1,buf2);
    put_a_line(to_file,buf1);
    strcpy(buf1,"P");
    itoa(x,buf2,10);
    strcat(buf1,buf2);
    itoa(y,buf2,10);
    strcat(buf1," ");
    strcat(buf1,buf2);
    put_a_line(to_file,buf1);
    x_ps += x;
    y_ps += y;
  }
  else{
    strcpy(buf1,"P");
    itoa(x,buf2,10);
    strcat(buf1,buf2);
    itoa(y,buf2,10);
    strcat(buf1," ");
    strcat(buf1,buf2);
    put_a_line(to_file,buf1);
    x_ps += x;
    y_ps += y;
  }
  if (y == 8171)
    i = 0;
}