mirror of
https://github.com/legop3/MultiRoombaRover.git
synced 2026-09-17 01:50:47 -04:00
ug
This commit is contained in:
Vendored
BIN
Binary file not shown.
Vendored
BIN
Binary file not shown.
@@ -174,13 +174,16 @@ func (s *CameraServo) rateLimitAngleLocked(target float64) float64 {
|
|||||||
now := time.Now()
|
now := time.Now()
|
||||||
if s.lastMove.IsZero() {
|
if s.lastMove.IsZero() {
|
||||||
s.lastMove = now
|
s.lastMove = now
|
||||||
return target
|
|
||||||
}
|
}
|
||||||
elapsed := now.Sub(s.lastMove).Seconds()
|
elapsed := now.Sub(s.lastMove).Seconds()
|
||||||
if elapsed <= 0 {
|
if elapsed <= 0 {
|
||||||
s.lastMove = now
|
s.lastMove = now
|
||||||
return s.currentAngle
|
return s.currentAngle
|
||||||
}
|
}
|
||||||
|
maxElapsed := servoStepInterval.Seconds()
|
||||||
|
if elapsed > maxElapsed {
|
||||||
|
elapsed = maxElapsed
|
||||||
|
}
|
||||||
maxDelta := maxServoDegPerSec * elapsed
|
maxDelta := maxServoDegPerSec * elapsed
|
||||||
delta := target - s.currentAngle
|
delta := target - s.currentAngle
|
||||||
if math.Abs(delta) <= maxDelta {
|
if math.Abs(delta) <= maxDelta {
|
||||||
|
|||||||
Reference in New Issue
Block a user