ecki/Robotics-at-Home-with-Raspberry-Pi-Pico
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Ch-10 TR feedback

Browse Source
This commit is contained in:
Danny Staple
2022-12-17 16:05:25 +00:00
parent b2228889e8
commit 45ba981386
4 changed files with 20 additions and 19 deletions
Download Patch File Download Diff File Expand all files Collapse all files
ch-10/1-proportional-distance-control/code.py
+6 -6
View File
@@ -14,22 +14,22 @@ class PController:
## We'll set up a single distance sensor, and keep a set distance from an object
robot.left_distance.distance_mode = 1
robot.left_distance.start_ranging()
robot.right_distance.distance_mode = 1
robot.right_distance.start_ranging()
distance_set_point = 10
distance_controller = PController(-0.1)
while True:
if robot.left_distance.data_ready:
distance = robot.left_distance.distance
if robot.right_distance.data_ready:
distance = robot.right_distance.distance
error = distance_set_point - distance
speed = distance_controller.calculate(error)
if abs(speed) < 0.2:
if abs(speed) < 0.3:
speed = 0
uart.write(f"{error},{speed}\n".encode())
print(f"{error},{speed}")
robot.set_left(speed)
robot.set_right(speed)
robot.left_distance.clear_interrupt()
robot.right_distance.clear_interrupt()
time.sleep(0.05)