libraries: fix delay after subsequent Robotis servo detections
This fix probably reflects the original intention of the code author, because without it delays set in detect_servos() are ignored. Without this fix Dynamixel XC330-T288-T does not start and enters something like a "soft bricked" state (no errors reported, but not responding to any commands). This adds a delay after ping messages so that servos have time to respond to the pings and are ready to be configured further.
This commit is contained in:
parent
ba72c58659
commit
abc78d1169
@ -373,6 +373,7 @@ void AP_RobotisServo::update()
|
|||||||
if (detection_count < DETECT_SERVO_COUNT) {
|
if (detection_count < DETECT_SERVO_COUNT) {
|
||||||
detection_count++;
|
detection_count++;
|
||||||
detect_servos();
|
detect_servos();
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (servo_mask == 0) {
|
if (servo_mask == 0) {
|
||||||
|
Loading…
Reference in New Issue
Block a user