brmlab/lasic
4
0
Fork 0
mirror of https://github.com/brmlab/lasic.git synced 2025-06-12 11:14:00 +02:00
Code Issues Projects Releases Packages Wiki Activity

sketch: Added Focus Control

Browse source
This commit is contained in:
TomSuch 2011-12-27 23:53:48 +01:00
parent 1a6a83ba46
commit 85a926a104
1 changed files with 32 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

32
sketch/lasic.pde
View file

@ -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);
}