mirror of
https://github.com/brmlab/lasic.git
synced 2025-06-09 09:43:59 +02:00
sketch: Added Focus Control
This commit is contained in:
parent
1a6a83ba46
commit
85a926a104
1 changed files with 32 additions and 0 deletions
|
@ -7,6 +7,8 @@ unsigned long lastTime = 0;
|
||||||
int LaserPIN = 14;
|
int LaserPIN = 14;
|
||||||
int Ypojezd = 19;
|
int Ypojezd = 19;
|
||||||
int Xpojezd = 18;
|
int Xpojezd = 18;
|
||||||
|
int FDir = 16;
|
||||||
|
int FStep = 17;
|
||||||
|
|
||||||
const int stepperY_factor = 3;
|
const int stepperY_factor = 3;
|
||||||
|
|
||||||
|
@ -29,6 +31,10 @@ void setup() {
|
||||||
digitalWrite(Ypojezd, HIGH);
|
digitalWrite(Ypojezd, HIGH);
|
||||||
pinMode(Xpojezd, INPUT);
|
pinMode(Xpojezd, INPUT);
|
||||||
digitalWrite(Xpojezd, HIGH);
|
digitalWrite(Xpojezd, HIGH);
|
||||||
|
pinMode(FDir, OUTPUT);
|
||||||
|
digitalWrite(FDir, LOW);
|
||||||
|
pinMode(FStep, OUTPUT);
|
||||||
|
digitalWrite(FStep, LOW);
|
||||||
}
|
}
|
||||||
|
|
||||||
void loop() {
|
void loop() {
|
||||||
|
@ -224,6 +230,14 @@ void ExeCmd(char *InCmd){
|
||||||
XYReset();
|
XYReset();
|
||||||
Serial.println(SeqID, DEC);
|
Serial.println(SeqID, DEC);
|
||||||
break;
|
break;
|
||||||
|
case 2:
|
||||||
|
FocusUp();
|
||||||
|
Serial.println(SeqID, DEC);
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
FocusDown();
|
||||||
|
Serial.println(SeqID, DEC);
|
||||||
|
break;
|
||||||
default:
|
default:
|
||||||
Serial.print("Unknow Command: ");
|
Serial.print("Unknow Command: ");
|
||||||
Serial.println(SCommand,DEC );
|
Serial.println(SCommand,DEC );
|
||||||
|
@ -403,6 +417,24 @@ void PrintHelp(){
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void FocusDown(){
|
||||||
|
digitalWrite(FDir, LOW);
|
||||||
|
delay(1);
|
||||||
|
digitalWrite(FStep, HIGH);
|
||||||
|
delay(1);
|
||||||
|
digitalWrite(FStep, LOW);
|
||||||
|
delay(1);
|
||||||
|
}
|
||||||
|
|
||||||
|
void FocusUp(){
|
||||||
|
digitalWrite(FDir, HIGH);
|
||||||
|
delay(1);
|
||||||
|
digitalWrite(FStep, HIGH);
|
||||||
|
delay(1);
|
||||||
|
digitalWrite(FStep, LOW);
|
||||||
|
delay(1);
|
||||||
|
digitalWrite(FDir, LOW);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue