|
@@ -48,7 +48,7 @@ void startCoreTasks() {
|
|
|
1
|
|
|
);
|
|
|
delay(500);
|
|
|
-
|
|
|
+
|
|
|
//core 0
|
|
|
xTaskCreatePinnedToCore(
|
|
|
PrimaryController, /* Task function. */
|
|
@@ -67,39 +67,30 @@ void PrimaryController( void * pvParameters ) {
|
|
|
for (;;) {
|
|
|
//Loop of primary logics
|
|
|
setAnimationCode('a');
|
|
|
- delay(30000);
|
|
|
- //setAnimationCode('c');
|
|
|
- //delay(5000);
|
|
|
- setAnimationCode('j');
|
|
|
- delay(30000);
|
|
|
-
|
|
|
-
|
|
|
- //Stepper test
|
|
|
+ delay(10000);
|
|
|
/*
|
|
|
- forward(50);
|
|
|
- delay(3000);
|
|
|
- backward(50);
|
|
|
- delay(3000);
|
|
|
- rotateAntiClockwise(100);
|
|
|
- delay(1000);
|
|
|
-
|
|
|
- //blink
|
|
|
- loadAndRender("/b.bin");
|
|
|
- delay(300);
|
|
|
- loadAndRender("/a.bin");
|
|
|
- delay(2000);
|
|
|
- //rotate backward
|
|
|
- rotateClockwise(100);
|
|
|
- delay(3000);
|
|
|
- //Servo test
|
|
|
- servoCoverPusher.write(90);
|
|
|
- delay(1000);
|
|
|
- servoSwitchPusher.write(180);
|
|
|
- delay(1000);
|
|
|
- servoCoverPusher.write(0);
|
|
|
- servoSwitchPusher.write(0);
|
|
|
- delay(3000);
|
|
|
+ //Stepper test
|
|
|
+ forward(50);
|
|
|
+ delay(3000);
|
|
|
+ backward(50);
|
|
|
+ delay(3000);
|
|
|
+ rotateAntiClockwise(100);
|
|
|
+ delay(1000);
|
|
|
+ //rotate backward
|
|
|
+ rotateClockwise(100);
|
|
|
+ delay(3000);
|
|
|
*/
|
|
|
+ //Servo test
|
|
|
+ servoCoverPusher.write(90);
|
|
|
+ delay(1000);
|
|
|
+ servoSwitchPusher.write(145);
|
|
|
+ delay(1000);
|
|
|
+ servoCoverPusher.write(0);
|
|
|
+ servoSwitchPusher.write(0);
|
|
|
+ delay(3000);
|
|
|
+
|
|
|
+ setAnimationCode('j');
|
|
|
+ delay(10000);
|
|
|
}
|
|
|
}
|
|
|
|