maybe this works...

This commit is contained in:
Alexander Richter 2023-07-23 17:06:16 +02:00
parent edb005e778
commit 60be9d8736
2 changed files with 56 additions and 68 deletions

View File

@ -128,12 +128,14 @@ Note that Analog Pin numbering is different to the Print on the PCB.
#endif #endif
//#define ROTENC #define QUADENC
//Support for Rotatary Encoders with Quadrature Output. Define Pins for A and B Signals for your encoders. Visit https://www.pjrc.com/teensy/td_libs_Encoder.html for further explanation. //Support for Rotatary Encoders with Quadrature Output. Define Pins for A and B Signals for your encoders. Visit https://www.pjrc.com/teensy/td_libs_Encoder.html for further explanation.
#ifdef ROTENC #ifdef QUADENC
#include <Encoder.h> #include <Encoder.h>
const int RotEncs = 2; //how many Rotary Encoders do you want? const int QuadEncs = 2; //how many Rotary Encoders do you want?
#define QUADENCS 2
// Encoders have 2 signals, which must be connected to 2 pins. There are three options. // Encoders have 2 signals, which must be connected to 2 pins. There are three options.
//Best Performance: Both signals connect to interrupt pins. //Best Performance: Both signals connect to interrupt pins.
@ -159,10 +161,11 @@ Encoder Encoder1(31,33); //A,B Pin
//Encoder Encoder2(A,B); //Encoder Encoder2(A,B);
//Encoder Encoder3(A,B); //Encoder Encoder3(A,B);
//Encoder Encoder4(A,B); //Encoder Encoder4(A,B);
const int RotEncSig[] = {1,1}; //define wich kind of Signal you want to generate. const int QuadEncSig[] = {1,1}; //define wich kind of Signal you want to generate.
//1= send up or down signal (typical use for selecting modes in hal) //1= send up or down signal (typical use for selecting modes in hal)
//2= send position signal (typical use for MPG wheel) //2= send position signal (typical use for MPG wheel)
const int RotEncMp[] = {1,4}; //some Rotary encoders send multiple Electronical Impulses per mechanical pulse. How many Electrical impulses are send for each mechanical Latch? const int QuadEncMp[] = {1,4}; //some Rotary encoders send multiple Electronical Impulses per mechanical pulse. How many Electrical impulses are send for each mechanical Latch?
#endif #endif
//#define JOYSTICK //Support of an Rotating Knob that was build in my Machine. It encodes 32 Positions with 5 Pins in Binary. This will generate 32 Pins in LinuxCNC Hal. //#define JOYSTICK //Support of an Rotating Knob that was build in my Machine. It encodes 32 Positions with 5 Pins in Binary. This will generate 32 Pins in LinuxCNC Hal.
@ -319,9 +322,9 @@ const int debounceDelay = 50;
#ifdef KEYPAD #ifdef KEYPAD
byte KeyState = 0; byte KeyState = 0;
#endif #endif
#ifdef ROTENC #ifdef QUADENC
long EncCount[RotEncs]; long EncCount[QuadEncs];
long OldEncCount[RotEncs]; long OldEncCount[QuadEncs];
#endif #endif
#ifdef JOYSTICK #ifdef JOYSTICK
@ -455,7 +458,7 @@ void loop() {
readKeypad(); //read Keyboard & send data readKeypad(); //read Keyboard & send data
#endif #endif
#ifdef ROTENC #ifdef QUADENC
readEncoders(); //read Encoders & send data readEncoders(); //read Encoders & send data
#endif #endif
#ifdef JOYSTICK #ifdef JOYSTICK
@ -505,30 +508,40 @@ void readJoySticks() {
void readEncoders(){ void readEncoders(){
if(RotEncs>=1){ if(QuadEncs>=1){
EncCount[0] = Encoder0.read()/RotEncMp[0]; #if QUADENCS >= 1
EncCount[0] = Encoder0.read()/QuadEncMp[0];
#endif
} }
if(RotEncs>=2){ if(QuadEncs>=2){
EncCount[1] = Encoder1.read()/RotEncMp[1]; #if QUADENCS >= 2
EncCount[1] = Encoder1.read()/QuadEncMp[1];
#endif
} }
if(RotEncs>=3){ if(QuadEncs>=3){
//EncCount[2] = Encoder2.read()/RotEncMp[2]; #if QUADENCS >= 3
EncCount[2] = Encoder2.read()/QuadEncMp[2];
#endif
} }
if(RotEncs>=4){ if(QuadEncs>=4){
//EncCount[3] = Encoder3.read()/RotEncMp[3]; #if QUADENCS >= 4
EncCount[3] = Encoder3.read()/QuadEncMp[3];
#endif
} }
if(RotEncs>=5){ if(QuadEncs>=5){
//EncCount[4] = Encoder4.read()/RotEncMp[4]; #if QUADENCS >= 5
EncCount[4] = Encoder4.read()/QuadEncMp[4];
#endif
} }
for(int i=0; i<RotEncs;i++){ for(int i=0; i<QuadEncs;i++){
if(RotEncSig[i]==2){ if(QuadEncSig[i]==2){
if(OldEncCount[i] != EncCount[i]){ if(OldEncCount[i] != EncCount[i]){
sendData('R',i,EncCount[i]);//send Counter sendData('R',i,EncCount[i]);//send Counter
OldEncCount[i] = EncCount[i]; OldEncCount[i] = EncCount[i];
} }
} }
if(RotEncSig[i]==1){ if(QuadEncSig[i]==1){
if(OldEncCount[i] < EncCount[i]){ if(OldEncCount[i] < EncCount[i]){
sendData('R',i,1); //send Increase by 1 Signal sendData('R',i,1); //send Increase by 1 Signal
OldEncCount[i] = EncCount[i]; OldEncCount[i] = EncCount[i];

View File

@ -178,7 +178,7 @@ InPinmap += sInPinmap
# Storing Variables for counter timing Stuff # Storing Variables for counter timing Stuff
counter_last_update = {} counter_last_update = {}
counter_hold_interval = 100 min_update_interval = 100
######## SetUp of HalPins ######## ######## SetUp of HalPins ########
# setup Input halpins # setup Input halpins
@ -394,57 +394,32 @@ while True:
if(Debug):print("Keypad{}:{}".format(Chars[io],0)) if(Debug):print("Keypad{}:{}".format(Chars[io],0))
elif cmd == "R": elif cmd == "R":
firstcom = 1 firstcom = 1
if JoySticks > 0:
for pins in range(JoySticks*2): if JoySticks > 0:
if (io == JoyStickPins[pins]): for pins in range(JoySticks * 2):
c["Counter.{}".format(io)] = value if io == JoyStickPins[pins]:
if (Debug):print("Counter.{}:{}".format(io,value))
if QuadEncs > 0:
if QuadEncSig[io]== 1:
if value == 0:
c["CounterDown.{}".format(io)] = 1
time.sleep(0.1)
c["CounterDown.{}".format(io)] = 0
if value == 1:
c["CounterUp.{}".format(io)] = 1
time.sleep(0.1)
c["CounterUp.{}".format(io)] = 0
if QuadEncSig[io]== 2:
c["Counter.{}".format(io)] = value c["Counter.{}".format(io)] = value
if Debug:
print("Counter.{}:{}".format(io, value))
if QuadEncs > 0:
# Check if the button is not already in the dictionary, and set its last update time to 0
if io not in counter_last_update: if io not in counter_last_update:
counter_last_update[io] = 0 counter_last_update[io] = 0
if time.time() - counter_last_update[io] >= min_update_interval:
global counter_last_update
if QuadEncSig[io] == 1:
if value == 0:
c["CounterDown.{}".format(io)] = 1
counter_last_update[io] = time.time() # Set the last update time
elif value == 1:
c["CounterUp.{}".format(io)] = 1
counter_last_update[io] = time.time() # Set the last update time
elif QuadEncSig[io] == 2:
c["Counter.{}".format(io)] = value
if JoySticks > 0:
for pins in range(JoySticks*2):
if (io == JoyStickPins[pins]):
c["Counter.{}".format(io)] = value
if Debug:
print("Counter.{}:{}".format(io, value))
if QuadEncs > 0:
if QuadEncSig[io] == 1:
# Check if enough time has passed since the last update
if millis() - counter_last_update[io] >= counter_hold_interval:
counter_last_update[io] = millis() # Update the last update time for the button
if value == 0:
c["CounterDown.{}".format(io)] = 1
counter_last_update[io] = millis() # Update the last update time for the button
if value == 1:
c["CounterUp.{}".format(io)] = 1
counter_last_update[io] = millis() # Update the last update time for the button
elif QuadEncSig[io] == 2:
c["Counter.{}".format(io)] = value
elif cmd == "R":
firstcom = 1
handle_button_press(io, value)
elif cmd == 'E': elif cmd == 'E':
arduino.write(b"E0:0\n") arduino.write(b"E0:0\n")