Ton/LinuxCNC_ArduinoConnector
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Bug fixing Arduino Code

Browse Source
This commit is contained in:
Alexander Richter 2022-11-26 01:16:53 +01:00
parent 9ae56ab73c
commit c3005f77ab
1 changed files with 8 additions and 16 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

24
LinuxCNC_ArduinoConnector.ino
View File

@ -62,7 +62,7 @@
#define PWMOUTPUTS
#ifdef PWMOUTPUTS
const int PwmOutputs = 2; //number of outputs
int PwmOutPinmap[] = {13,11};
int PwmOutPinmap[] = {12,11};
#endif
#define AINPUTS
@ -262,30 +262,22 @@ void flushSerial(){
}
void writeOutputs(int Pin, int Stat){
for(int x = 0; x<Outputs;x++){
if(OutPinmap[x]==Pin){
digitalWrite(OutPinmap[x], Stat);
}
}
digitalWrite(Pin, Stat);
}
void writePwmOutputs(int Pin, int Stat){
for(int x = 0; x<PwmOutputs;x++){
if(PwmOutPinmap[x]==Pin){
analogWrite(PwmOutPinmap[x], Stat);
}
}
analogWrite(Pin, Stat);
}
int readLPoti(){
for(int i= 0;i<LPotis; i++){
int State = analogRead(LPotiPins[i][0])+margin;
Lpoti[i] = 1024/(LPotiPins[i][1]-1);
State = State/(LPotiPins[i][1]-1);
if(oldLpoti[i]!= State){
oldLpoti[i] = State;
int var = analogRead(LPotiPins[i][0])+margin;
int pos = 1024/(LPotiPins[i][1]-1);
var = var/pos;
if(oldLpoti[i]!= var){
oldLpoti[i] = var;
sendData('L', LPotiPins[i][0],oldLpoti[i]);
}
}