[发明专利]一种机器人全向运动控制系统

摘要

本文提出了一种机器人全向运动控制系统。所述机器人全向运动控制方法包括硬件执行平台以及软件控制方法。所述硬件执行机构包括多个无刷电机构成的全向运动机构以及硬件驱动平台。所述软件控制方法包括①中枢控制根据选择的运动模式解析外部控制器输入的方向以及速度信息；②无刷电机根据下发的解析后控制命令进行PID控制。所述的一种机器人全向运动控制方法具有模式多，反馈性强，响应速度快，对地面环境适应性高的特点，能够在各种环境下很好地控制机器人的全向运动。

主权项

一种机器人全向运动控制系统，其特征在于所述硬件执行机构包括多个无刷电机构成的全向运动机构以及硬件驱动平台：（1）所述多个无刷电机构成的全向运动机构实现机器人的方向以及速度控制，机器人为四腿机器人，每条腿由两个无刷电机构成，其中一个无刷电机用于控制对应的另外一个无刷电机的速度方向，另外一个无刷电机用于控制机器人单个腿的速度，包括前进速度以及后退速度；（2）所述硬件驱动平台包含中枢控制平台和电机控制系统，中枢控制平台接收外部控制器输入的机器人整体的运动方向以及运动速度信息，负责把机器人整体的速度和方向信息按照选择的模式解析成各个电机需要达到的位置、速度信息，并通过CAN总线下发给各个独立的电机控制系统，电机控制系统负责采集电机的位置、速度以及力矩信息，接收中枢控制平台下发的独立控制指令，采用PID算法，精确控制电机的位置、速度，同时电机控制系统负责上报电机的位置、速度以及力矩信息给中枢控制平台，再通过中枢控制平台输出信息给外部控制器；一种如权利要求1所述的机器人全向运动控制系统，其特征在于所述软件控制方法，包括以下内容：（1）所述中枢控制根据选择的运动模式解析外部控制器输入的机器人整体的方向以及速度信息，外部控制器输入的机器人整体的方向以及速度信息的格式为(ν, α, ϻ),其中ν指的机器人整体下一时刻的目标速度，α指的机器人整体下一时刻的目标角速度或者转弯半径，ϻ指的是机器人的运动模式，中枢控制器解析后下发的数据为(νn, θn)(n=1,2,3,4)，θ指的机器人四腿分别对应的方向控制的无刷电机速度；（2）所述无刷电机根据下发的解析后的控制命令进行PID控制，负责接收中枢控制器下发的(νn, θn)(n=1,2,3,4)的控制指令进行响应，对于方向控制的无刷电机驱动电路，采用PID控制器响应控制指令中的θn(n=1,2,3,4)；对于速度控制的无刷电机驱动电路，采用PID控制器响应控制指令中的νn(n=1,2,3,4)，如此协调响应，保证机器人的全向运动。