24、机器人空间建模与姿态追踪全解析

机器人空间建模与姿态追踪全解析

1. 建立与机器人的连接及数据传输

在与机器人进行交互时，我们需要确保能够建立和关闭连接，并且可以向机器人发送数据。以下是实现这些功能的代码：

async def close(self):
    await self.ble_client.disconnect()

async def send_uart_data(self, data):
    await self.ble_client.write_gatt_char(self.tx_gatt, data)

上述代码中， close 方法用于断开与机器人的蓝牙连接，而 send_uart_data 方法则用于向机器人发送数据，它会等待数据发送完成，并使用正确的 UUID 进行 UART 传输。

2. 在计算机屏幕上显示机器人数据

我们可以使用 matplotlib 库将机器人的数据显示在计算机屏幕上。具体步骤如下：
1. 创建 display_from_robot.py 文件并导入必要的库 ：

import asyncio
import json
import matplotlib.pyplot as plt
from robot_ble_connection import BleConnection