cnc-club.ru

Код: Выделить всё

#include "KMotionDef.h"

int DoPC(int cmd);
int DoPCInt(int cmd, int i);
#define GATH_OFF 0  // define the offset into the Gather buffer where strings are passed

main()
{

  	// finding НОМЕ Z
            ch2->LimitSwitchOptions=0x100; 		// отключение обработки всех концевых датчиков (начального и конечного) на оси chN, чтобы не блокировалась ось
            Jog(2,1600);                    	// бесконечное перемещение по оси N на скорости  NNN имп/сек в положительном или отрицательном (скорость со знаком "-") направлении
            while (ReadBit(1026)!=1);  	  		// ожидание срабатывания датчика пин NNN
	    Zero(2);                   			// обнуление координаты оси N
	    Jog(2,0);                	 		// остановка оси N (скорось 0)
	    Delay_sec(0.50);					// пауза
	    MoveAtVel(2,-800, 1600);	   		// перемещение оси N в позицию NNN (со знаком "-" для смены направления) импульсов на скорости NNN имп/сек
            while (!CheckDone(2)) ;        		// ожидание окончания движения оси N
            Delay_sec(0.50);
            Jog(2,200);                      	
            while (ReadBit(1026)!=1) ;          
            Zero(2);                          	
            Jog(2,0);                           
            Delay_sec(0.50);
            MoveAtVel(2,-1600, 1600);          	
            while (!CheckDone(2)) ;             
            ch2->LimitSwitchOptions=0x103;		// включение обработки концевых датчиков (начального и конечного) оси N (код может быть другой, по количеству датчиков)

  	// finding НОМЕ Х      
	    ch0->LimitSwitchOptions=0x100; 	
            Jog(0,-1600);                    
            while (ReadBit(1024)!=1);  	  	
	    Zero(0);                   		
	    Jog(0,0);                	 	
	    Delay_sec(0.50);
	    MoveAtVel(0,400, 1600);	   		
            while (!CheckDone(0)) ;        	
            Delay_sec(0.50);
            Jog(0,-20);                      
            while (ReadBit(1024)!=1) ;         
            Zero(0);                          
            Jog(0,0);                          
            Delay_sec(0.50);
            MoveAtVel(0,800, 1600);          
            while (!CheckDone(0)) ;            
            ch0->LimitSwitchOptions=0x103;	

 	// finding НОМЕ Y      
	    ch1->LimitSwitchOptions=0x100; 	
            Jog(1,-1600);                    
            while (ReadBit(1025)!=1);  	  	
	    Zero(1);                   		
	    Jog(1,0);                	 	
	    Delay_sec(0.50);
	    MoveAtVel(1,400, 1600);	   		
            while (!CheckDone(1)) ;        	
            Delay_sec(0.50);
            Jog(1,-20);                      
            while (ReadBit(1025)!=1) ;         
            Zero(1);                          
            Jog(1,0);                          
            Delay_sec(0.50);
            MoveAtVel(1,800, 1600);          
            while (!CheckDone(1)) ;            
            ch1->LimitSwitchOptions=0x103;	
            

            MDI("G92.1");  // очистка всех действующих оффсетов
}

//далее код обеспечивающий ввод команды в MDI

// put the MDI string (Manual Data Input - GCode) in the 
// gather buffer and tell the App where it is
int MDI(char *s)
{
   char *p=(char *)gather_buffer+GATH_OFF*sizeof(int);
   int i;
   
   do // copy to gather buffer w offset 0
   {
      *p++ = *s++;
   }while (s[-1]);
   
   // issue the command an wait till it is complete
   // (or an error - such as busy)
   return DoPCInt(PC_COMM_MDI,GATH_OFF);
}


// Put an integer as a parameter and pass the command to the App
int DoPCInt(int cmd, int i)
{
   int result;
   persist.UserData[PC_COMM_PERSIST+1] = i;
   return DoPC(cmd);
}

// Pass a command to the PC and wait for it to handshake
// that it was received by either clearing the command
// or changing it to a negative error code
int DoPC(int cmd)
{
   int result;
   
   persist.UserData[PC_COMM_PERSIST]=cmd;
   
   do
   {
      WaitNextTimeSlice();   
   }while (result=persist.UserData[PC_COMM_PERSIST]>0);
   
   return result;
   }