Stop teh collision avoider task - so the robot stops moving on error.

This commit is contained in:
Danny Staple 2022-12-28 16:52:08 +00:00
parent 6535128a06
commit 44509f515b
3 changed files with 6 additions and 3 deletions

View File

@ -78,12 +78,13 @@ class Simulation:
async def main(self):
asyncio.create_task(self.distance_sensors.main())
asyncio.create_task(self.collision_avoider.main())
collision_avoider = asyncio.create_task(self.collision_avoider.main())
try:
while True:
await asyncio.sleep(0.1)
send_poses(self.poses)
finally:
collision_avoider.cancel()
robot.stop()

View File

@ -132,13 +132,14 @@ class Simulation:
async def main(self):
asyncio.create_task(self.distance_sensors.main())
asyncio.create_task(self.collision_avoider.main())
collision_avoider = asyncio.create_task(self.collision_avoider.main())
try:
while True:
send_poses(self.poses)
await asyncio.sleep(0.05)
self.motion_model()
finally:
collision_avoider.cancel()
robot.stop()

View File

@ -148,13 +148,14 @@ class Simulation:
async def main(self):
asyncio.create_task(self.distance_sensors.main())
asyncio.create_task(self.collision_avoider.main())
collision_avoider = asyncio.create_task(self.collision_avoider.main())
try:
while True:
send_poses(self.poses)
await asyncio.sleep(0.05)
self.motion_model()
finally:
collision_avoider.cancel()
robot.stop()