cnc-club.ru

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

SetBitDirection(39,0); // для оси X1

 // поиск НОМЕ по Х1

 Zero(3); // обнуление координаты оси Х1
 Jog(3,10240); // перемещение оси Х1 в положительном направлении на скорости 5% от максимальной 204800 имп/сек
while (!ReadBit(39)) ; // ожидание срабатывания индексной метки по Х1- пин 39 - появление сигнала
Zero(3); // обнуление координаты оси Х1
 Jog(3,0); // остановка оси Х1

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

#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()
{

//определяем пины для индексных меток, как ВХОД

SetBitDirection(36,0); // для оси Х
SetBitDirection(37,0); // для оси Y
SetBitDirection(38,0); // для оси Z
SetBitDirection(39,0); // для оси X1

      // поиск НОМЕ по Z
                       ch2->LimitSwitchOptions=0x100; // отключение обработки концевого датчика на оси Z, чтобы не блокировалась ось
            Jog(2,-20480);                            // перемещение оси Z в отрицательном направлении на скорости 10% от максимальной 204800 имп/сек
            while (ReadBit(141)) ;               // ожидание срабатывания датчика по Z-  пин 141 - пропадание сигнала
            Zero(2);                                    // обнуление координаты оси Z
            Jog(2,0);                              // остановка оси Z
            Jog(2,10240);                            // перемещение оси Z в положительном направлении на скорости 5% от максимальной 204800 имп/сек
            while (!ReadBit(38)) ;               // ожидание срабатывания индексной метки по Z-  пин 38 - появление сигнала
            Zero(2);                                    // обнуление координаты оси Z
            Jog(2,0);                              // остановка оси Z
                                ch2->LimitSwitchOptions=0x10f;// включение обработки концевого датчика на оси Z,
            
            
         
      // поиск НОМЕ по Х      
                       ch0->LimitSwitchOptions=0x100; // отключение обработки концевого датчика на оси Х, чтобы не блокировалась ось
            Jog(0,-20480);                            // перемещение оси Х в отрицательном направлении на скорости 10% от максимальной 204800 имп/сек
            while (ReadBit(137)) ;               // ожидание срабатывания датчика по Z-  пин 137  - пропадание сигнала
            Zero(0);                                    // обнуление координаты оси Х
            Jog(0,0);                              // остановка оси Х
            Jog(0,10240);                            // перемещение оси Х в положительном направлении на скорости 5% от максимальной 204800 имп/сек
            while (!ReadBit(36)) ;                 // ожидание срабатывания индексной метки по Х-  пин 36 - появление сигнала
            Zero(0);                                    // обнуление координаты оси Х
            Jog(0,0);                              // остановка оси Х
                                ch0->LimitSwitchOptions=0x10f;// включение обработки концевого датчика на оси Х,
          
// поиск НОМЕ по Х1 
                           ch3->MasterAxis=-1;
            Jog(3,10240);                            // перемещение оси Х1 в положительном направлении на скорости 5% от максимальной 204800 имп/сек
            while (!ReadBit(39)) ;                 // ожидание срабатывания индексной метки по Х1-  пин 39 - появление сигнала
            Zero(3);                                    // обнуление координаты оси Х1
            Jog(3,0);                              // остановка оси Х1
                            ch3->MasterAxis=0;
            
                 // поиск НОМЕ по Y      
                       ch1->LimitSwitchOptions=0x100; // отключение обработки концевого датчика на оси Y, чтобы не блокировалась ось
            Jog(1,-20480);                            // перемещение оси Y в отрицательном направлении на скорости 10% от максимальной 204800 имп/сек
            while (ReadBit(139)) ;               // ожидание срабатывания датчика по Y- пин 139
            Zero(1);                                    // обнуление координаты оси Y
            Jog(1,0);                              // остановка оси Y
            Jog(1,10240);                            // перемещение оси Y в положительном направлении на скорости 5% от максимальной 204800 имп/сек
            while (!ReadBit(37)) ;                 // ожидание срабатывания индексной метки по Y-  пин 37 - появление сигнала
            Zero(1);                                    // обнуление координаты оси Y
            Jog(1,0);                              // остановка оси Y
                                ch1->LimitSwitchOptions=0x10f;// включение обработки концевого датчика на оси Y,

            

            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;
   }