45 lines
773 B
C++
45 lines
773 B
C++
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);
|
|
}
|
|
}
|