unpower servos at boot a different way
parent
686b9411c7
commit
6a292b3cf6
|
@ -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
|
||||||
|
|
||||||
|
|
|
@ -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();
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue