unpower servos at boot a different way
parent
686b9411c7
commit
6a292b3cf6
|
@ -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
|
||||
|
||||
|
|
|
@ -32,7 +32,7 @@ void setup()
|
|||
loadMovementSetting();
|
||||
startMotor();
|
||||
startPinGuard();
|
||||
startServo();
|
||||
//startServo();
|
||||
startInterrupt();
|
||||
initLastAction();
|
||||
homeOnBoot();
|
||||
|
@ -57,4 +57,4 @@ void loop()
|
|||
checkParamsChanged();
|
||||
periodicChecksAndReport();
|
||||
|
||||
}
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue