Initial commit
This commit is contained in:
44
Code arduino Pelican/TESTMOTE/TESTMOTE.ino
Normal file
44
Code arduino Pelican/TESTMOTE/TESTMOTE.ino
Normal file
@@ -0,0 +1,44 @@
|
||||
const int DIR = 12;
|
||||
const int STEP = 14;
|
||||
int nbstep , timeto;
|
||||
|
||||
void setup()
|
||||
{
|
||||
Serial.begin(115200);
|
||||
pinMode(STEP, OUTPUT);
|
||||
pinMode(DIR, OUTPUT);
|
||||
}
|
||||
void loop()
|
||||
{
|
||||
aspirate(48,1200);
|
||||
delay(1000);
|
||||
//2K =2.5cm
|
||||
eject(48,1200);
|
||||
delay(1000);
|
||||
}
|
||||
|
||||
void aspirate(int nbstep,int timeto){
|
||||
digitalWrite(DIR, HIGH);
|
||||
Serial.println("Aspiration");
|
||||
|
||||
for(int i = 0; i<nbstep; i++)
|
||||
{
|
||||
digitalWrite(STEP, HIGH);
|
||||
delayMicroseconds(timeto);
|
||||
digitalWrite(STEP, LOW);
|
||||
delayMicroseconds(timeto);
|
||||
}
|
||||
}
|
||||
|
||||
void eject(int nbstep,int timeto){
|
||||
digitalWrite(DIR, LOW);
|
||||
Serial.println("Ejection");
|
||||
|
||||
for(int i = 0; i<nbstep; i++)
|
||||
{
|
||||
digitalWrite(STEP, HIGH);
|
||||
delayMicroseconds(timeto);
|
||||
digitalWrite(STEP, LOW);
|
||||
delayMicroseconds(timeto);
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user