RickRongen/WallE
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

feat: set correct min max arms

Browse Source
This commit is contained in:
Rick Rongen
2020-05-17 20:23:50 +02:00
parent 7172f61394
commit f86beeaecb
1 changed files with 6 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
control/walle.py
View File

@@ -64,7 +64,9 @@ class WallE:
distance = 1
up_down = distance * math.sin(angle)
left_right = distance * math.cos(angle)
minval = 50
maxval = 130
self.servo_controller.write(SERVO_ARM_L, map_range(up_down, -1.0, 1.0, minval, maxval))
self.servo_controller.write(SERVO_ARM_R, map_range(left_right, -1.0, 1.0, minval, maxval))
min_arm_r = 60
max_arm_r = 160 # 80
min_arm_l = 20
max_arm_l = 100 # 80
self.servo_controller.write(SERVO_ARM_L, map_range(up_down, -1.0, 1.0, min_arm_l, max_arm_l))
self.servo_controller.write(SERVO_ARM_R, map_range(left_right, -1.0, 1.0, min_arm_r, max_arm_r))