HobbyCNC fórum - UCCNC vezérlő program

// ================================================================================================// Mxxxxx - Macroloop: Yaxley olvasás - lépés // ================================================================================================ // "A másik Yaxley 3 állású és kiválasztja a 0,001, 0,01 és 0,1 léptetést az MPG-nek." // ================================================================================================ int currState = 0; int readState = 0; // =============== Előkészítés if (led0001 == -1) { led0001 = GetLEDNumber(port0001, pin0001); led001 = GetLEDNumber(port001, pin001); led01 = GetLEDNumber(port01, pin01); led1 = GetLEDNumber(port1, pin1); } // =============== Feldolgozás currState = (exec.GetLED(step0001) ? 1 : 0); currState = currState << 1 | (exec.GetLED(step001) ? 1 : 0); currState = currState << 1 | (exec.GetLED(step01) ? 1 : 0); currState = currState << 1 | (exec.GetLED(step1) ? 1 : 0); readState = GetPinState(led0001, neg0001); readState = readState << 1 | GetPinState(led001, neg001); readState = readState << 1 | GetPinState(led01, neg01); readState = readState << 1 | GetPinState(led1, neg1); if (readState != currState) { switch (readState) { case 0x01: exec.Callbutton(btn1); exec.AddStatusmessage("Step: 1.0"); break; case 0x02: exec.Callbutton(btn01); exec.AddStatusmessage("Step: 0.1"); break; case 0x04: exec.Callbutton(btn001); exec.AddStatusmessage("Step: 0.01"); break; case 0x08: exec.Callbutton(btn0001); exec.AddStatusmessage("Step: 0.001"); break; } } // ============================================================================= -- Events -- #Events // ================================================================================================ // =============== LED konstansok const int step0001 = 148; const int step001 = 149; const int step01 = 150; const int step1 = 151; // =============== Gomb konstansok const int btn0001 = 241; const int btn001 = 164; const int btn01 = 165; const int btn1 = 166; // =============== Bemenetek - Port, pin, negálás const int port0001 = 1; const int pin0001 = 12; const bool neg0001 = false; const int port001 = 1; const int pin001 = 11; const bool neg001 = false; const int port01 = 1; const int pin01 = 15; const bool neg01 = false; const int port1 = 0; const int pin1 = 0; const bool neg1 = false; // =============== Bemenetek - LEDek static int led0001 = -1; static int led001 = -1; static int led01 = -1; static int led1 = -1; // ================================================================================================ // =============== LED száma port és pin alapján int GetLEDNumber(int port, int pin) { int LED = -1; switch (port) { case 1: LED = pin; break; case 2: LED = 68 + pin; break; case 3: LED = 85 + pin; break; case 4: LED = 102 + pin; break; case 5: LED = 119 + pin; break; } return LED; } // =============== Bemenet állapota int GetPinState(int led, bool neg) { if (led == -1) return 0; bool ledState = exec.GetLED(led); return (ledState ^ neg ? 1 : 0); }

// ================================================================================================// Mxxxxx - Macroloop: Yaxley olvasás - tengely és mód // ================================================================================================ // "Az egyik 5 állású Yaxley, 0, X, Y, Z, A állással. (0 -> cont / más -> MPG multi)" // ================================================================================================ int currState = 0; int readState = 0; // =============== Előkészítés if (ledCont == -1) { ledCont = GetLEDNumber(portCont, pinCont); ledMPGX = GetLEDNumber(portMPGX, pinMPGX); ledMPGY = GetLEDNumber(portMPGY, pinMPGY); ledMPGZ = GetLEDNumber(portMPGZ, pinMPGZ); ledMPGA = GetLEDNumber(portMPGA, pinMPGA); } // =============== Feldolgozás currState = (exec.GetLED(modeCont) ? 1 : 0); currState = currState << 1 | (exec.GetLED(modeMPGMulti) ? 1 : 0); for (int i = 0; i < 4; i++) currState = currState << 1 | (exec.GetLED(axisX + i) ? 1 : 0); // readState = GetPinState(ledCont, negCont) == 1 ? 0x02 : 0x01; readState = GetPinState(ledCont, negCont) << 1; readState = readState << 1 | GetPinState(ledMPGX, negMPGX); readState = readState << 1 | GetPinState(ledMPGY, negMPGY); readState = readState << 1 | GetPinState(ledMPGZ, negMPGZ); readState = readState << 1 | GetPinState(ledMPGA, negMPGA); if ((readState & 0x0F) != 0x00) readState |= 0x10; // 0 0 C M X Y Z A if (readState != currState) { if ((readState & 0xF0) != (currState & 0xF0)) switch (readState & 0xF0) { case 0x10: exec.Callbutton(btnMPGMulti); break; case 0x20: exec.Callbutton(btnCont); exec.AddStatusmessage("Mode: Continous"); break; } if ((readState & 0xF0) == 0x10) switch (readState & 0x0F) { case 0x01: exec.Callbutton(btnAxisA); exec.AddStatusmessage("Mode: MPG Multi A"); break; case 0x02: exec.Callbutton(btnAxisZ); exec.AddStatusmessage("Mode: MPG Multi Z"); break; case 0x04: exec.Callbutton(btnAxisY); exec.AddStatusmessage("Mode: MPG Multi Y"); break; case 0x08: exec.Callbutton(btnAxisX); exec.AddStatusmessage("Mode: MPG Multi X"); break; } } // ============================================================================= -- Events -- #Events // ================================================================================================ // =============== LED konstansok const int modeCont = 145; const int modeMPGMulti = 154; const int axisX = 155; // =============== Gomb konstansok const int btnCont = 161; const int btnMPGMulti = 228; const int btnAxisX = 220; const int btnAxisY = 221; const int btnAxisZ = 222; const int btnAxisA = 223; // =============== Bemenetek - Port, pin, negálás const int portCont = 1; const int pinCont = 12; const bool negCont = false; const int portMPGX = 1; const int pinMPGX = 11; const bool negMPGX = false; const int portMPGY = 1; const int pinMPGY = 15; const bool negMPGY = false; const int portMPGZ = 0; const int pinMPGZ = 0; const bool negMPGZ = false; const int portMPGA = 0; const int pinMPGA = 0; const bool negMPGA = false; // =============== Bemenetek - LEDek static int ledCont = -1; static int ledMPGX = -1; static int ledMPGY = -1; static int ledMPGZ = -1; static int ledMPGA = -1; // ================================================================================================ // =============== LED száma port és pin alapján int GetLEDNumber(int port, int pin) { int LED = -1; switch (port) { case 1: LED = pin; break; case 2: LED = 68 + pin; break; case 3: LED = 85 + pin; break; case 4: LED = 102 + pin; break; case 5: LED = 119 + pin; break; } return LED; } // =============== Bemenet állapota int GetPinState(int led, bool neg) { if (led == -1) return 0; bool ledState = exec.GetLED(led); return (ledState ^ neg ? 1 : 0); }