Stop teh collision avoider task - so the robot stops moving on error.
This commit is contained in:
@@ -78,12 +78,13 @@ class Simulation:
|
|||||||
|
|
||||||
async def main(self):
|
async def main(self):
|
||||||
asyncio.create_task(self.distance_sensors.main())
|
asyncio.create_task(self.distance_sensors.main())
|
||||||
asyncio.create_task(self.collision_avoider.main())
|
collision_avoider = asyncio.create_task(self.collision_avoider.main())
|
||||||
try:
|
try:
|
||||||
while True:
|
while True:
|
||||||
await asyncio.sleep(0.1)
|
await asyncio.sleep(0.1)
|
||||||
send_poses(self.poses)
|
send_poses(self.poses)
|
||||||
finally:
|
finally:
|
||||||
|
collision_avoider.cancel()
|
||||||
robot.stop()
|
robot.stop()
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@@ -132,13 +132,14 @@ class Simulation:
|
|||||||
|
|
||||||
async def main(self):
|
async def main(self):
|
||||||
asyncio.create_task(self.distance_sensors.main())
|
asyncio.create_task(self.distance_sensors.main())
|
||||||
asyncio.create_task(self.collision_avoider.main())
|
collision_avoider = asyncio.create_task(self.collision_avoider.main())
|
||||||
try:
|
try:
|
||||||
while True:
|
while True:
|
||||||
send_poses(self.poses)
|
send_poses(self.poses)
|
||||||
await asyncio.sleep(0.05)
|
await asyncio.sleep(0.05)
|
||||||
self.motion_model()
|
self.motion_model()
|
||||||
finally:
|
finally:
|
||||||
|
collision_avoider.cancel()
|
||||||
robot.stop()
|
robot.stop()
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@@ -148,13 +148,14 @@ class Simulation:
|
|||||||
|
|
||||||
async def main(self):
|
async def main(self):
|
||||||
asyncio.create_task(self.distance_sensors.main())
|
asyncio.create_task(self.distance_sensors.main())
|
||||||
asyncio.create_task(self.collision_avoider.main())
|
collision_avoider = asyncio.create_task(self.collision_avoider.main())
|
||||||
try:
|
try:
|
||||||
while True:
|
while True:
|
||||||
send_poses(self.poses)
|
send_poses(self.poses)
|
||||||
await asyncio.sleep(0.05)
|
await asyncio.sleep(0.05)
|
||||||
self.motion_model()
|
self.motion_model()
|
||||||
finally:
|
finally:
|
||||||
|
collision_avoider.cancel()
|
||||||
robot.stop()
|
robot.stop()
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user