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

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

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

      // поиск НОМЕ по 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=0x103;// включение обработки концевого датчика на оси 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=0x103;// включение обработки концевого датчика на оси Х,
            
            
                 // поиск НОМЕ по 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=0x103;// включение обработки концевого датчика на оси 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;
   }