unpower servos at boot a different way

pull/134/head
gabrielburnworth 2020-02-13 08:21:51 -08:00
parent 686b9411c7
commit 6a292b3cf6
2 changed files with 17 additions and 2 deletions

View File

@ -388,6 +388,11 @@ void setPinInputOutput()
pinMode(SERVO_2_PIN, OUTPUT);
pinMode(SERVO_3_PIN, OUTPUT);
digitalWrite(SERVO_0_PIN, LOW);
digitalWrite(SERVO_1_PIN, LOW);
digitalWrite(SERVO_2_PIN, LOW);
digitalWrite(SERVO_3_PIN, LOW);
Serial.print(COMM_REPORT_COMMENT);
Serial.print(SPACE);
Serial.print("Set input/output");
@ -472,6 +477,11 @@ void setPinInputOutput()
pinMode(SERVO_2_PIN, OUTPUT);
pinMode(SERVO_3_PIN, OUTPUT);
digitalWrite(SERVO_0_PIN, LOW);
digitalWrite(SERVO_1_PIN, LOW);
digitalWrite(SERVO_2_PIN, LOW);
digitalWrite(SERVO_3_PIN, LOW);
Serial.print(COMM_REPORT_COMMENT);
Serial.print(SPACE);
Serial.print("Set input/output");
@ -579,6 +589,11 @@ void setPinInputOutput()
pinMode(SERVO_1_PIN, OUTPUT);
pinMode(SERVO_2_PIN, OUTPUT);
pinMode(SERVO_3_PIN, OUTPUT);
digitalWrite(SERVO_0_PIN, LOW);
digitalWrite(SERVO_1_PIN, LOW);
digitalWrite(SERVO_2_PIN, LOW);
digitalWrite(SERVO_3_PIN, LOW);
}
#endif

View File

@ -32,7 +32,7 @@ void setup()
loadMovementSetting();
startMotor();
startPinGuard();
startServo();
//startServo();
startInterrupt();
initLastAction();
homeOnBoot();
@ -57,4 +57,4 @@ void loop()
checkParamsChanged();
periodicChecksAndReport();
}
}