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_2_PIN, OUTPUT);
pinMode(SERVO_3_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(COMM_REPORT_COMMENT);
Serial.print(SPACE); Serial.print(SPACE);
Serial.print("Set input/output"); Serial.print("Set input/output");
@ -472,6 +477,11 @@ void setPinInputOutput()
pinMode(SERVO_2_PIN, OUTPUT); pinMode(SERVO_2_PIN, OUTPUT);
pinMode(SERVO_3_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(COMM_REPORT_COMMENT);
Serial.print(SPACE); Serial.print(SPACE);
Serial.print("Set input/output"); Serial.print("Set input/output");
@ -579,6 +589,11 @@ void setPinInputOutput()
pinMode(SERVO_1_PIN, OUTPUT); pinMode(SERVO_1_PIN, OUTPUT);
pinMode(SERVO_2_PIN, OUTPUT); pinMode(SERVO_2_PIN, OUTPUT);
pinMode(SERVO_3_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 #endif

View File

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