Skip to content

Commit bbae406

Browse files
pieniacyabaghiyan
authored andcommitted
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.
1 parent 5f1546d commit bbae406

File tree

1 file changed

+1
-0
lines changed

1 file changed

+1
-0
lines changed

libraries/AP_RobotisServo/AP_RobotisServo.cpp

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -373,6 +373,7 @@ void AP_RobotisServo::update()
373373
if (detection_count < DETECT_SERVO_COUNT) {
374374
detection_count++;
375375
detect_servos();
376+
return;
376377
}
377378

378379
if (servo_mask == 0) {

0 commit comments

Comments
 (0)