return_origin.c

来自「数控系统的模拟系统,用SSTC51仿真单片机,仿真数控机床切割,能执行数控机床代」· C语言 代码 · 共 84 行

void  Return_origin(void)   // 手动
  { 
  WriteCommandLCM(0x01,1);  
   TAI_BI=1;
   TAI_BI=0;
   Lcd_print("Return_Origin");
   Lcd_print1(1,2,"sure?     "); 
   ir_data[2]=0;
TR2=1; 
  while(1)
  {
    while(ir_flag) 
  	   {
	   if(ir_data[2]==EXIT) goto b;
  	   	switch(ir_data[2])
  	         { 
		   case ENTER: 
		      { 
			Lcd_print1(1,0,"     "); 
			displayXY();
			ir_data[2]=0;
		   while(Pref_y>0) Y_Reset();
		     Pref_y=0;
               while(Pref_x>0) X_Reset();
			     Pref_x=0;
				 Lcd_print1(1,0,"GetOver");   
				  SaveXYToNVRAM();
			   } 
		   displayXY();
			   break;
           case STOP: 
		   	Lcd_print1(1,2,"stop       "); 
			break;
	             }
	   	 }
 b: ir_flag=0;
     break;
  }
 TR2=0; 
 //SaveXYToNVRAM();

   	} 

 void  Y_Reset(void)
  {
   unsigned char i=0;
   Y_F=0;
   Lcd_print1(1,0,"Y_Reset");
	Y_M=1;
 while((!(ir_data[2]==TING))&&(Pref_y>0))
  { 
   i=150;
 while (i--);
  Y_M=0;
  i=2;
  while (i--); 	 
  Y_M=1;
    Pref_y--;
  displayY();	
 } 
//     Lcd_print1(1,0,"GetOver");    
}
 //X电机正向驱动
 
void  X_Reset(void)
  {
  unsigned char  i=0;
  X_F=0;
   Lcd_print1(1,0,"X_Reset");
	X_M=1;
 while((!(ir_data[2]==TING))&&(Pref_x>0))
  { 
   i=150;
 while (i--);
  X_M=0;
   i=2 ;
  while (i--);	 
  X_M=1;
  Pref_x--;
  displayX();	
 }  
   
// Lcd_print1(1,0,"GetOver");   
}