[发明专利]一种可实时显示机器人形态的系统及方法

摘要

本发明公开了一种可实时显示机器人形态的系统及方法，其中可实时显示机器人形态的系统包括姿态传感器、多个关节舵机、MCU、显示设备和电池，其中姿态传感器、多个关节舵机、MCU、显示设备均连接MCU；其中实时显示机器人形态的方法，包括如下步骤：(1)姿态传感器获取并提供机器人身体部位的实时状态值给MCU；(2)多个关节舵机获取并提供机器人各个关节的实时运动角度数值给MCU；(3)MCU根据身体状态值和实时运动角度数值计算模拟出机器人当前的实时运动状态；(4)显示设备将MCU计算模拟出的机器人的实时运动状态进行实时显示。本发明可实时显示机器人形态，而且机器人形态的数据可进一步用于其他分析和应用。

主权项

1.一种可实时显示机器人形态的系统进行实时显示机器人形态的方法，所述可实时显示机器人形态的系统，包括：一姿态传感器，所述姿态传感器设置在机器人的身体部位，用于提供机器人身体部位的实时状态值；多个关节舵机，多个所述关节舵机分别设置在机器人的各个关节上，用于提供机器人各个关节的实时运动角度数值；一MCU，连接所述姿态传感器和所述关节舵机，用于采集来自所述姿态传感器的身体状态值和来自所述关节舵机的实时运动角度数值，并根据身体状态值和实时运动角度数值计算模拟出机器人当前的实时运动状态；一显示设备，连接MCU,用于将MCU计算模拟出的机器人的实时运动状态进行实时显示；一电池，连接MCU，用于提供能量；进行实时显示机器人形态的方法,其特征在于，包括如下步骤：(1)姿态传感器获取并提供机器人身体部位的实时状态值给MCU；(2)多个关节舵机获取并提供机器人各个关节的实时运动角度数值给MCU；(3)MCU根据身体状态值和实时运动角度数值计算模拟出机器人当前的实时运动状态；通过如下方法来计算模拟出机器人当前的实时运动状态：首先以机器人的身体部位为算法基础坐标点，以姿态传感器发送的实时状态值设置XYZ空间坐标，然后获取离机器人身体最接近的第一组关节舵机的当前运动角度数值，确定该第一组关节舵机相对机器人身体部位的位置；然后再获取与所述第一组关节舵机接近的第二组关节舵机的当前运动角度数值，确定该第二组关节舵机相对机器人身体部位的位置；然后再依次确定再获取与所述第二组关节舵机接近的第三组关节舵机的当前运动角度数值，确定该第三组关节舵机相对机器人身体部位的位置，依次类推直至确定所有关节舵机相对机器人身体部位的位置，从而计算模拟出机器人的实时运动姿态；(4)显示设备将MCU计算模拟出的机器人的实时运动状态进行实时显示。