Skip to content

Commit 78558e7

Browse files
unknownunknown
authored andcommitted
added bounds to dutycycle for servo control
1 parent cc97507 commit 78558e7

File tree

1 file changed

+4
-0
lines changed

1 file changed

+4
-0
lines changed

coderbot.py

Lines changed: 4 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -116,6 +116,8 @@ def _servo_motor_control(self, pin, speed):
116116
# transform speed value from -100 to +100 range
117117
# to servo duty cycle range: 100 to 200
118118
speed = 150 + speed/2
119+
if (speed < 90): speed = 90
120+
if (speed > 210): speed = 210
119121
self.pi.set_PWM_range(pin, PWM_RANGE)
120122
self.pi.set_PWM_frequency(pin, PWM_FREQUENCY)
121123
self.pi.set_PWM_dutycycle(pin, speed)
@@ -125,6 +127,8 @@ def _servo_control(self, pin, angle):
125127
# assuming angle range is 0 to 120
126128
# transform from angle range to servo duty cycle range (100 to 200)
127129
duty = angle + 90 # (90-210)
130+
if (duty < 90): duty = 90
131+
if (duty > 210): duty = 210
128132
self.pi.set_PWM_range(pin, PWM_RANGE)
129133
self.pi.set_PWM_frequency(pin, PWM_FREQUENCY)
130134
self.pi.set_PWM_dutycycle(pin, duty)

0 commit comments

Comments
 (0)