|
@@ -66,8 +66,8 @@ void PrimaryController( void * pvParameters ) {
|
|
|
Serial.println("Primary logic process started on core " + String(xPortGetCoreID()));
|
|
|
for (;;) {
|
|
|
//Loop of primary logics
|
|
|
- setAnimationCode('a');
|
|
|
- delay(10000);
|
|
|
+ //setAnimationCode('a');
|
|
|
+ //delay(10000);
|
|
|
/*
|
|
|
//Stepper test
|
|
|
forward(50);
|
|
@@ -81,14 +81,21 @@ void PrimaryController( void * pvParameters ) {
|
|
|
delay(3000);
|
|
|
*/
|
|
|
//Servo test
|
|
|
+ //Push button angle: 140
|
|
|
+ //Servo arm vertical alignment angle: 125
|
|
|
+
|
|
|
servoCoverPusher.write(90);
|
|
|
delay(1000);
|
|
|
- servoSwitchPusher.write(145);
|
|
|
+ servoSwitchPusher.write(130);
|
|
|
delay(1000);
|
|
|
servoCoverPusher.write(0);
|
|
|
servoSwitchPusher.write(0);
|
|
|
delay(3000);
|
|
|
|
|
|
+
|
|
|
+ //Servo install position = 125 (vertical)
|
|
|
+ //servoSwitchPusher.write(125);
|
|
|
+
|
|
|
setAnimationCode('j');
|
|
|
delay(10000);
|
|
|
}
|