Using GCA and GCF causes weird stuff to happen when buttons are added.
This commit is contained in:
@@ -39,22 +39,23 @@ class RobotDisplay:
|
||||
self.pose_uv = np.array([np.cos(angle_rads), np.sin(angle_rads)])
|
||||
|
||||
def draw(self):
|
||||
plt.gca().clear()
|
||||
self.ax.clear()
|
||||
if self.arena:
|
||||
for line in self.arena["arena"]:
|
||||
plt.gca().plot(
|
||||
self.ax.plot(
|
||||
[line[0][0], line[1][0]], [line[0][1], line[1][1]], color="black"
|
||||
)
|
||||
for line in self.arena["target_zone"]:
|
||||
plt.gca().plot(
|
||||
self.ax.plot(
|
||||
[line[0][0], line[1][0]], [line[0][1], line[1][1]], color="red"
|
||||
)
|
||||
if len(self.pose_coords) > 0:
|
||||
plt.quiver(self.pose_coords[0], self.pose_coords[1], self.pose_uv[0], self.pose_uv[1], color="blue")
|
||||
self.ax.quiver(self.pose_coords[0], self.pose_coords[1], self.pose_uv[0], self.pose_uv[1], color="blue")
|
||||
|
||||
async def main(self):
|
||||
plt.ion()
|
||||
await self.ble_connection.connect()
|
||||
self.fig, self.ax = plt.subplots()
|
||||
try:
|
||||
request = json.dumps({"command": "arena"}).encode()
|
||||
print(f"Sending request for arena: {request}")
|
||||
|
||||
@@ -13,6 +13,8 @@ class Simulation:
|
||||
for n in range(population_size):
|
||||
self.poses[n] = random.uniform(0, arena.width), random.uniform(0, arena.height), random.uniform(0, 360)
|
||||
|
||||
def send_json(data):
|
||||
robot.uart.write((json.dumps(data)+"\n").encode())
|
||||
|
||||
async def command_handler(simulation):
|
||||
while True:
|
||||
@@ -20,27 +22,20 @@ async def command_handler(simulation):
|
||||
print("Receiving data...")
|
||||
try:
|
||||
data = robot.uart.readline().decode()
|
||||
except UnicodeError:
|
||||
print("Invalid data")
|
||||
continue
|
||||
try:
|
||||
request = json.loads(data)
|
||||
print(f"Received command: {request}")
|
||||
except ValueError:
|
||||
print("Invalid JSON")
|
||||
except (UnicodeError, ValueError):
|
||||
print("Invalid data")
|
||||
continue
|
||||
# {"command": "arena"}
|
||||
if request["command"] == "arena":
|
||||
response = {
|
||||
send_json({
|
||||
"arena": arena.boundary_lines,
|
||||
"target_zone": arena.target_zone,
|
||||
}
|
||||
robot.uart.write((json.dumps(response)+"\n").encode())
|
||||
})
|
||||
else:
|
||||
response = {
|
||||
send_json({
|
||||
"poses": simulation.poses.tolist(),
|
||||
}
|
||||
robot.uart.write((json.dumps(response)+"\n").encode())
|
||||
})
|
||||
await asyncio.sleep(0.1)
|
||||
|
||||
simulation= Simulation()
|
||||
|
||||
Reference in New Issue
Block a user