一种全向移动轮式机器人平台及控制方法技术

本发明专利技术公开了一种全向移动轮式机器人平台及控制方法，全向移动轮式机器人平台，包括设置有安装孔的底盘平台，其特征在于，还包括三个均匀排列的麦克纳姆轮且两两之间夹角为120°，每个麦克纳姆轮通过电机驱动，每个电机与控制器相连，控制器接收控制指令参数，通过系统运动学方程得到三个电机的控制速度，输出信号给电机驱动器分别控制三个电机的转速。采用三个电机控制三个麦克纳姆轮作为主动轮，无从动轮，能够灵活的完成全向运动，具有适应性强、灵敏度高、稳定性好、转动灵活等优点，满足系统运动对复杂环境的要求。

【技术实现步骤摘要】

本专利技术涉及一种全向移动轮式机器人平台及控制方法。
技术介绍
麦克纳姆轮的概念是由瑞典麦克纳姆公司提出的，其主要由两部分组成，一部分为电机控制的轮毂，另一部分为沿着轮毂外缘按照一定角度均匀分布的多个被动辊子。麦克纳姆轮结构紧凑，运动灵活，是很成功的一种全方位轮，但是现有技术中，为了实现全方位移动功能，需至少采用4个麦克纳姆轮进行组合，比如，专利号201010145736.X公开了一种多功能智能助立助行机器人，采用四个麦克纳姆轮，专利号201610725467.1公开了一种电控式滑撬直升机自动移库装置，所述凹形平台底部的四个角均安装有所述麦克纳姆轮。采用4个麦克纳姆轮进行组合，轮子分布面积过大而无法减小移动平台的尺寸，并且轮子的分布也导致了系统缺乏灵活性，不适合小尺寸机器人的平台设计，不仅成本高、结构复杂，而且控制精度低。
技术实现思路
针对上述问题，本专利技术提供一种全向移动轮式机器人平台及控制方法，采用三个电机控制三个麦克纳姆轮作为主动轮，无从动轮，能够灵活的完成全向运动，具有适应性强、灵敏度高、稳定性好、转动灵活等优点，满足系统运动对复杂环境的要求。为实现上述技术目的，达到上述技术效果，本专利技术通过以下技术方案实现：一种全向移动轮式机器人平台，包括设置有安装孔的底盘平台，其特征在于，还包括三个均匀排列的麦克纳姆轮且两两之间夹角为120°，每个麦克纳姆轮通过电机驱动，每个电机通过驱动器与控制器相连，控制器输出信号给电机驱动器分别控制三个电机的转速。优选，设三个均匀排列的麦克纳姆轮的中心为O点，第i个麦克纳姆轮的转动中心为Oi′，i＝1,2,3，xoy是中心为O的直角坐标系，x′oi′y′是圆心为轮毂中心Oi′的直角坐标系，r为麦克纳姆轮的半径，αi是第i个麦克纳姆轮的辊子的偏向角，βi是与x轴的夹角，(lix,liy,θi)是x′oi′y′坐标系在xoy中的位姿描述，lix＝licosβi,liy＝lisinβi，θi是第i个麦克纳姆轮的轮子轴线与x轴方向夹角，则全向移动平台的运动的速度矢量即为O点的速度矢量，设为[vx,vy,ω]T，vx是x轴速度,vy是y轴速度,ω是转向速度，则三个电机的转速矢量[ω1,ω2,ω3]T：控制器输出PWM脉冲信号给电机驱动器分别控制三个电机的转速。优选，所述底盘平台呈圆形。优选，所述传感器单元包括霍尔电流传感器、陀螺仪传感器、角度传感器和超声波传感器。相对应的，一种全向移动轮式机器人平台的控制方法，其特征在于，包括如下步骤：步骤1、输入全向移动平台的运动的速度矢量[vx,vy,ω]T，vx是x轴速度,vy是y轴速度,ω是转向速度；步骤2、计算三个电机的转速矢量[ω1,ω2,ω3]T：式中，设三个均匀排列的麦克纳姆轮的中心为O点，第i个麦克纳姆轮的转动中心为Oi′，i＝1,2,3，xoy是中心为O的直角坐标系，x′oi′y′是圆心为轮毂中心Oi′的直角坐标系，r为麦克纳姆轮的半径，αi是第i个麦克纳姆轮的辊子的偏向角，βi是与x轴的夹角，(lix,liy,θi)是x′oi′y′坐标系在xoy中的位姿描述，lix＝licosβi,liy＝lisinβi，θi是第i个麦克纳姆轮的轮子轴线与x轴方向夹角；步骤3、控制器根据三个电机的转速矢量[ω1,ω2,ω3]T，输出对应频率的PWM脉冲信号给电机驱动器；步骤4、电机驱动将其转换成控制电机转速的双相四线式脉冲信号输出到电机。本专利技术的有益效果是：第一、在结构上：突破了移动平台传统的四轮式(双驱动+双万向)及三轮式(双驱动+单万向)结构，采用三轮完全对称式驱动。相比较之下，传统的四轮式结构有着轮子分布面积过大而无法减小平台尺寸的缺陷，并且轮子的分布也导致了系统缺乏灵活性，不适合小尺寸机器人的平台设计；传统的三轮式结构是目前机器人平台应用较为广泛的一种结构，但在复杂的环境中，由于结构的限制也会导致运动缺乏灵活性，对于一些紧急事故，无法做到完全有效避免或解决；而本申请的基于麦克纳姆轮的三轮式结构，三个驱动模块采用完全均匀对称式分布，其平台占用面积可以大大缩小，可以作为小型机器人平台设计开发的一个优秀选择方案，而麦克纳姆轮独特的运动结构，也保证了系统运动上的灵活性。第二、在运动上：通过对本设计的系统运动学方程分析可知，系统可以在不改变正面方向的状态下，完成任意方向的运动，且不需要转向行为，这就避免了传统运动结构遇到障碍或其他紧急情况需要花时间转向来躲避障碍的问题，实现了事故的灵活处理。另一方面，本设计不同于传统结构在转向时会发生一定位移，并且占用较长时间，在转向过程中，基于均匀对称分布的驱动结构，系统可以完成绕自身中心的转动，这就大大的缩短了转向时间，消除了转向过程中遇到障碍的问题，提高了系统的灵活性。第三、在控制上：由于系统结构的限制，本设计在控制上要比传统结构复杂得多，但同时控制精度也要高得多。通过对系统运动学方程的分析可知，只要给定系统的目标速度矢量或转向角速度，系统就可以按照设定的速度及方向运动，结合角度传感器及控制器的定时器，就可以让系统实现任意方向前进指定距离或者任意方向转动指定角度，加上系统采用的是步进电机驱动，控制精度也将大大提高，这就使得系统具有了完全可控性，让后期平台的拓展开发更加方便灵活。附图说明图1是麦克纳姆轮的结构示意图；图2是本专利技术一种全向移动轮式机器人平台的结构示意图；图3是本专利技术第i个麦克纳姆轮与系统运动中心的运动关系示意图；图4是本专利技术第i个麦克纳姆轮的部分参数关系示意图；图5是本专利技术实施例中一种全向移动轮式机器人平台的具体结构示意图。具体实施方式下面结合附图和具体的实施例对本专利技术技术方案作进一步的详细描述，以使本领域的技术人员可以更好的理解本专利技术并能予以实施，但所举实施例不作为对本专利技术的限定。一种全向移动轮式机器人平台，包括设置有安装孔的底盘平台，优选，底盘平台呈圆形，底盘平台通过安装孔安装其他配件。还包括三个均匀排列的麦克纳姆轮且两两之间夹角为120°，如图1和2所示，麦克纳姆轮主要包括两部分，一部分为电机控制的轮毂，另一部分为沿着轮毂外缘按照一定角度均匀分布的多个被动辊子。每个麦克纳姆轮通过电机驱动，系统采用三个电机控制三个麦克纳姆轮作为主动轮，无从动轮，三个麦克纳姆轮按照圆周方向均匀排列，三个电机安装时轴心交于底盘中心，且两两之间夹角为120°。该结构在运动过程中，适应性强、灵敏度高、稳定性好、转动灵活等优点，在此基础上，该结构还可以在不改变前视角度的情况下，实现任意方向的运动，具有极大的灵活性，满足系统运动对复杂环境的要求。具体的控制通过控制器实现，即每个电机通过驱动器与控制器相连，控制器输出信号给电机驱动器分别控制三个电机的转速。下面进行具体的运动学分析：在本设计中，为了得到一般情况下的三轮全方位系统运动学方程，设三个麦克纳姆轮的布局形式是任意的，每个轮子在系统中既有相对于系统中心的位置，也有各自的姿态角度。如图3和4所示，图中各参数及系统各部分运动参数定义如下：设三个均匀排列的麦克纳姆轮的中心(也即系统运动中心)为O点，第i个麦克纳姆轮的转动中心为Oi′，i＝1,2,3，xoy是中心为O的直角坐标系，x′oi′y′是圆心为轮毂中心Oi′的直角坐标系，r为麦克纳姆轮的半径，αi是第i本文档来自技高网...

【技术保护点】
一种全向移动轮式机器人平台，包括设置有安装孔的底盘平台，其特征在于，还包括三个均匀排列的麦克纳姆轮且两两之间夹角为120°，每个麦克纳姆轮通过电机驱动，每个电机通过驱动器与控制器相连，控制器输出信号给电机驱动器分别控制三个电机的转速。

【技术特征摘要】
1.一种全向移动轮式机器人平台，包括设置有安装孔的底盘平台，其特征在于，还包括三个均匀排列的麦克纳姆轮且两两之间夹角为120°，每个麦克纳姆轮通过电机驱动，每个电机通过驱动器与控制器相连，控制器输出信号给电机驱动器分别控制三个电机的转速。2.根据权利要求1所述的一种全向移动轮式机器人平台，其特征在于，设三个均匀排列的麦克纳姆轮的中心为O点，第i个麦克纳姆轮的转动中心为O′i，i＝1,2,3，xoy是中心为O的直角坐标系，x′o′iy′是圆心为轮毂中心O′i的直角坐标系，r为麦克纳姆轮的半径，αi是第i个麦克纳姆轮的辊子的偏向角，βi是与x轴的夹角，(lix,liy,θi)是x′o′iy′坐标系在xoy中的位姿描述，lix＝licosβi,liy＝lisinβi，θi是第i个麦克纳姆轮的轮子轴线与x轴方向夹角，则全向移动平台的运动的速度矢量即为O点的速度矢量，设为[vx,vy,ω]T，vx是x轴速度,vy是y轴速度,ω是转向速度，则三个电机的转速矢量[ω1,ω2,ω3]T：ω1ω2ω3=1-rsinαcos(θ1-α1)sinα1sin(θ1-α1)sinα1l1sin(θ1-α1-βi)sinα1cos(θ2-α2)sinα2sin(θ2-α2)sinα2l2sin(θ2-α2-β2)sinα2cos(θ3-α3)sinα3sin(θ3-α3)sinα3l3sin(θ3-α3-β3)sinα3vxvyω]]>控制器输出PWM脉冲信号给电机驱动器分别控制三个电机的转速。3.根据权利要求1所述的一种全向移动轮式机器人平台，其特征在于，所述底盘平台呈圆形。4.根据...

【专利技术属性】
技术研发人员：王程程，刘小峰，周小芹，蒋爱民，徐宁，
申请(专利权)人：河海大学常州校区，
类型：发明
国别省市：江苏;32