[发明专利]一种用于机器人的控制器、控制方法及机器人

说明书

本申请公开了一种用于机器人的控制器、控制方法及机器人。该控制器包括传感器模块、处理模块和通信模块，所述传感器模块与所述处理模块通过SPI接口连接，所述处理模块与所述通信模块通过TTL串口连接；所述传感器模块包括：第一传感器和第二传感器，所述第一传感器用于检测机器人的加速度运动状态和方向运动状态，所述第二传感器用于修正机器人运动时产生的累计偏差。本申请解决了机器人控制器领域存在的机器人姿态控制的技术问题。

技术领域

本申请涉及机器人领域，具体而言，涉及一种用于机器人的控制器、控制方法及机器人。

背景技术

机器人，是自动执行工作的机器装置，机器人控制器是影响机器人性能的关键部分之一。机器人行走过程中的平衡是很难解决的问题，而姿态检测是其中不可或缺的一个环节。

发明人发现，目前的机器人控制器领域存在机器人姿态控制精度不高的问题。

针对相关技术机器人运动姿态控制的问题，目前尚未提出有效的解决方案。

发明内容

本申请的主要目的在于提供一种用于机器人的控制器、控制方法及机器人，以解决机器人姿态控制精度不高的问题。

为了实现上述目的，根据本申请的一个方面，提供了一种用于机器人的控制器。

根据本申请的控制器包括：传感器模块、处理模块和通信模块，所述传感器模块与所述处理模块通过SPI接口连接，所述处理模块与所述通信模块通过TTL串口连接；所述传感器模块包括：第一传感器和第二传感器，所述第一传感器用于检测机器人的加速度运动状态和方向运动状态，所述第二传感器用于修正机器人运动时产生的累计偏差。

进一步的，所述第一传感器包括：加速度传感器和陀螺仪，所述加速度传感器用于测量所述机器人的加速度运动状态，所述陀螺仪用于测量所述机器人的方向运动状态。

进一步的，所述第二传感器包括磁力计，所述磁力计用于修正机器人运动时产生的累计偏差。

进一步的，所述处理模块包括单片机，所属单片机用于处理所述传感器模块检测到的所述机器人的运动状态信息。

进一步的，所述通信模块包括：FPGA处理器，用于与所述机器人系统总线通信。

为了实现上述目的，根据本申请的另一方面，提供了一种机器人，包括：用于机器人的控制器。

为了实现上述目的，根据本申请的另一方面，提供了一种用于机器人的控制方法，包括：传感器模块、处理模块和通信模块的机器人控制器中执行控制操作，所述方法包括以下步骤：

所述处理模块通过SPI接口读取所述传感器模块获取的第一姿态数据；

所述处理模块处理第一姿态数据，得到第二姿态数据；

在所述处理模块的第一串口判断所述处理模块是否接收到所述第二姿态数据；

如果在所述处理模块的第一串口判断所述处理模块接收到所述第二姿态数据，则在所述处理模块的定时器控制第一串口判断所述处理模块是否向所述通信模块发送所述第二姿态数据；

如果判断所述处理模块向所述通信模块发送所述第二姿态数据，则所述处理模块更新第二串口中的数据；

所述处理模块通过所述第二串口发送所述第二姿态数据至所述通信模块；

所述通信模块传送所述第二姿态数据至机器人系统总线；

所述机器人系统总线传送给机器人大脑控制器；

所述机器人大脑控制器执行所述第二姿态数据中对应的指令后调整机器人的运动状态。

进一步的，在所述获取第一姿态数据中，包括：