958cc0d9cb
this is my first "working" version
192 lines
3.4 KiB
C++
192 lines
3.4 KiB
C++
|
|
|
|
//###IO's###
|
|
|
|
//###Analog In###
|
|
int SpOd[] = {A1,8,-1}; //Knob Spindle Overdrive on A1, has 4 Pos, and initialised with 0
|
|
int FdRes[] = {A2,3,-1};//Knob Feed Resolution on A2, has 9 Pos, and initialised with 0
|
|
const int SpSp = A3;//Knob Potentiometer for SpindleSpeed in manual mode
|
|
|
|
//###Digital In###
|
|
//Absolute encoder Knob
|
|
const int DI0 = 27;//1
|
|
const int DI1 = 28;//2
|
|
const int DI2 = 31;//4
|
|
const int DI3 = 29;//8
|
|
const int DI4 = 30;//16
|
|
|
|
//Buttons
|
|
const int Buttons = 17; //Number of Buttons (Inputs)
|
|
int Button[] = {32,33,34,35,36,37,38,39,40,41,42,43,44,45,46,47,48};
|
|
|
|
//Digital Out###
|
|
const int Outputs = 22; //Number of Outputs (i use them for LEDs in Buttons)
|
|
int OutPin[] = {13,12,11,10,9,8,7,6,5,4,3,2,22,23,24,25,26};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
//Variables for Saving States
|
|
int oldvar = -1;
|
|
int SpSpvar = -1;
|
|
int ButtonState[Buttons];
|
|
int OutState[Outputs];
|
|
int FdOdSt = -1;
|
|
int SpOdSt = -1;
|
|
int SpSpSt = -1;
|
|
|
|
|
|
void setup() {
|
|
|
|
pinMode(DI0, INPUT_PULLUP);
|
|
pinMode(DI1, INPUT_PULLUP);
|
|
pinMode(DI2, INPUT_PULLUP);
|
|
pinMode(DI3, INPUT_PULLUP);
|
|
pinMode(DI4, INPUT_PULLUP);
|
|
|
|
//setting Buttons as Inputs with internal Pullup Resistors
|
|
for(int i= 0; i<Buttons;i++){
|
|
pinMode(Button[i], INPUT_PULLUP);
|
|
ButtonState[i] = -1;
|
|
}
|
|
|
|
for(int o= 0; o<Outputs;o++){
|
|
pinMode(OutPin[o], OUTPUT);
|
|
OutState[o] = 0;
|
|
}
|
|
//Setup Serial
|
|
Serial.begin(9600);
|
|
while (!Serial){
|
|
}
|
|
if (Serial){delay(1000);}
|
|
}
|
|
|
|
|
|
void loop() {
|
|
|
|
listenSerial();
|
|
readAbsKnob();
|
|
readPoti(SpSp);
|
|
|
|
SpOd[2] = readLPoti(SpOd[0],SpOd[1],SpOd[2]);
|
|
FdRes[2] = readLPoti(FdRes[0],FdRes[1],FdRes[2]);
|
|
writeOutputs();
|
|
readInputs();
|
|
delay(10);
|
|
|
|
}
|
|
|
|
|
|
int listenSerial(){
|
|
long rec=0;
|
|
if(Serial.available()){
|
|
rec = Serial.parseInt();
|
|
if(rec >= 10 && rec % 2){
|
|
rec --;
|
|
rec = rec/10;
|
|
if(rec < Buttons){
|
|
OutState[rec]=1;
|
|
}
|
|
}
|
|
if(rec >= 10 && !(rec % 2)){
|
|
rec = rec/10;
|
|
if(rec < Buttons){
|
|
OutState[rec]=0;
|
|
}
|
|
}
|
|
rec= 0;
|
|
}
|
|
}
|
|
|
|
int writeOutputs(){
|
|
for(int x = 0; x<Outputs;x++){
|
|
digitalWrite(OutPin[x], OutState[x]);
|
|
}
|
|
}
|
|
|
|
|
|
int readLPoti(int Pin,int Pos,int Stat){
|
|
int var = analogRead(Pin)+20; //giving it some margin so Numbers dont jitter
|
|
Pos = 1024/Pos;
|
|
var = var/Pos;
|
|
if(var != Stat){
|
|
Stat = var;
|
|
Serial.print("LP");
|
|
Serial.print(Pin);
|
|
Serial.print(":");
|
|
Serial.println(Stat);
|
|
|
|
}
|
|
return (Stat);
|
|
}
|
|
|
|
|
|
|
|
int readPoti(int Pin){
|
|
unsigned long var = 0;;
|
|
for(int i= 0;i<500; i++){
|
|
var = var+ analogRead(Pin);
|
|
}
|
|
var = var / 500;
|
|
if (SpSpSt!=var){
|
|
Serial.print("Pt");
|
|
Serial.print(Pin);
|
|
Serial.print(":");
|
|
Serial.println(var);
|
|
SpSpSt = var;
|
|
}
|
|
|
|
return (var);
|
|
}
|
|
|
|
|
|
|
|
|
|
int readInputs(){
|
|
for(int i= 0;i<Buttons; i++){
|
|
int State = digitalRead(Button[i]);
|
|
|
|
if(ButtonState[i]!= State){
|
|
ButtonState[i] = State;
|
|
Serial.print("I");
|
|
Serial.print(i);
|
|
Serial.print(":");
|
|
Serial.println(ButtonState[i]);
|
|
}
|
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
int readAbsKnob(){
|
|
int var = 0;
|
|
|
|
if(digitalRead(DI0)==1){
|
|
var += 1;
|
|
}
|
|
if(digitalRead(DI1)==1){
|
|
var += 2;
|
|
}
|
|
if(digitalRead(DI2)==1){
|
|
var += 4;
|
|
}
|
|
if(digitalRead(DI3)==1){
|
|
var += 8;
|
|
}
|
|
if(digitalRead(DI4)==1){
|
|
var += 16;
|
|
}
|
|
|
|
if(var != oldvar){
|
|
Serial.print("AK:");
|
|
Serial.println(var);
|
|
}
|
|
oldvar = var;
|
|
|
|
return (var);
|
|
}
|