当前位置:首页 > 工业控制 > 工业控制
[导读]为了解决自平衡人形机器人多关节协调控制问题,提高系统控制品质,借鉴计算机系统结构中的分层结构体系思想,提出了一种新的自平衡人形机器人动作控制器的实现方法,并根据该动作控制器设计出了一种相应的控制方法,可帮助机器人系统较好地实现任务的自组织分配,使机器人的平衡控制达到了很好的效果。

自平衡人形机器人的多关节协调控制一直是机器人学研究的难点和热点,目前采用的最多的是在大的反馈控制环路中对机器人进行关节空间的控制,这种控制方式结构紧凑,实时性强,但在以控制器为核心的辐射式控制链路上,所有信息的交换都集中在机器人主控制器上,当机器人处于复杂的环境中时,可能会有过多的信息需要处理,这种复杂程度往往是不可预知的,因此机器人的稳定性也不能保证。
    机器人主控制器是机器人的核心处理器,是提高人形机器人的信息处理能力的主要部件。其主要任务是控制机器人在空间的运动位置、姿态、轨迹、操作顺序和操作时间,因此必须保证主控制器能够为解决复杂信息处理而稳定可靠地工作。机器人动作控制器是为解决机器人动作控制而设计的,它将主处理器发出任务处理命令分配到3个16位超低功耗单片机(MSP430F149)上去执行,实现多层次的控制管理。该人形机器人具有多关节,多自由度,自平衡的控制需求,需要动作控制器在机器人系统控制中起到关键性的作用。

1 动作控制器的设计
1.1 体系结构
   
自平衡人形机器人需要获取不可预知的环境信息以及自身姿态信息进行综合运算并及时进行自身姿态的调整。机器人的这种行为特点决定了机器人的整体控制结构要采用反馈控制。如图1所示,描述了这种反馈控制结构的硬件实现。
    同时,在图1中可见从机器人主控制器到执行元件(舵机)之间,有一层动作控制器的结构。这一层结构的任务是实现控制命令到舵机控制信号之间的功能转换,这种体系结构的设计,就是借鉴计算机系统结构中的分层结构体系思想。采用这种分层的结构,实现了软件和硬件、命令和动作的相对隔离。其突出的优点体现在能够使主控制器专注于数据的处理,而对下行设备只负责发送指令,对于硬件的复杂的操作时序,由动作控制器负责产生。


1.2 实现过程
1.2.1 硬件实现

    为满足机器人整体控制体系结构中指令到执行的层次性要求,动作控制器需要完成命令解析,信号驱动等任务。如图2描述了动作控制器内部的结构,其主要由串行总线、3个可并行工作的16位单片机、信号驱动部分构成。这种结构能够从总线接收命令,单片机进行指令解析并输出控制电信号,外部电路对控制信号驱动放大,从而分别实现对执行舵机的控制。图3为动作控制器中一个单片机工作模块的硬件原理图。


    动作控制器主要由3个MSP430F149并行工作,每个MSP430F149控制8个舵机,总共实现对24个舵机的控制。每个MSP430F149有定时器TA和定时器TB两个模块,其中定时器TA通过比较模式输出2路PWM波控制2个舵机,定时器TB通过比较模式输出6路PWM波控制6个舵机。而且定时器工作在比较模式下时,能在一次设置完成后,不需要CPU干预的情况下持续进行PWM输出,同时保证各路信号之间没有干扰,因此一路比较输出即可独立控制一个舵机,动作控制器可实现对多达24个舵机的控制,对多关节人形机器人提供足够的控制通道。
    采用比较输出PWM波形的方法相比较采用中断方式的控制方法,具有简单,输出PWM波形稳定,整个控制系统的鲁棒性高等特点。该课题也曾采用过中断控制方式,但用示波器观察输出的PWM波形,波形极不稳定。而且中断嵌套过多之后,单片机程序很容易跑飞,完全不能满足控制系统的稳定性要求。而采用文中所述动作控制器的设计方法后,比较输出的PWM波波形稳定,而且单片机也没出现死机或跑飞的现象。
    MSP430F149输出为3.3 V TTL电平,而舵机控制信号要5 V TTL电平,在实际电路设计中要进行电平转换。考虑到舵机的控制信号对功率没有要求,必要加专用驱动芯片,而采用CMOS工艺的CD4081四2输入与门进行电平转换,利用其门电路输入电压门限宽的特点即可解决电平转换的问题。
    舵机动态工作时,需要脉冲式的电流,通过普通的电源供电,实验表明:由于舵机瞬时供电不足,致使舵机力矩不够,运动不能达到预先的姿态效果,在反复探索后,决定采用电容的快速放电特性来提供瞬时大电流,由于舵机数量大,设计时在舵机电源处并接大容量电容,总容量0.22F×6。正常小电流工作时,电容被充电处于饱和,当需要瞬时大电流时,电容能快速放电,从而保证舵机正常稳定的工作。
    3个MSP430F149分别控制部分关节上的舵机,这要求3个MSP430F149充分协调一致的工作。因此采用总线通信方式,将3个MSP430F149挂接到串行通信总线上,并留出总线接口,以接收主控制器的命令。
1.2.2 软件实现
   
动作控制器的软件设计,是以硬件为基础,接收主控制器的命令,对命令进行解析,并控制产生具体的PWM波形对舵机进行动作控制。图4描述了动作控制器中软件的实现流程。


    机器人的动作方式,方向,幅度等全部是由主控制器通过对外部信息的获取而产生的输出,这种输出是基于命令格式的,而机器人最终的一切行为都是一系列舵机的配合运转,从命令到执行,这其中就是动作控制器起到了关键作用。
    基于上述要求,动作控制器的首要任务就是接收命令。虽然在硬件上采用了多机通信的模式,但并不采用传统的通信协议(每个从机都具有一个独立的地址),而是对动作控制器上的3个MSP430F149定义完全相同的地址,这样就会使其接收到完全相同的命令。这样进行设计,原因在于要保证舵机响应的同时性,即是机器人动作的协调性提出的要求。如表1示例了主控制器与动作控制器的命令传输格式。来自主控制器的命令是一个数组序列,动作控制器上的每个MSP430F149都能完全接收到全部序列,而每个MSP430F149根据预先定义只使用这个序列中特定的子序列,这个子序列就是对应于这个MSP430F149所控制的舵机的命令,这样就可以保证同时性。


    动作控制器的最终目的是产生PWM波,而这是通过写MSP430F149片内TA、TB模块的寄存器实现的。在解析函数进行一系列的解析运算后,产生出各舵机所需的PWM波形的脉冲宽度值,将这些值写入到相应的寄存器中,就可以产生需要的PWM波。

2 实验及结论
   
根据文中提出的动作控制器的设计思想与方法,制作出机器人动作控制器。按照设计的基本思想对动作控制器进行测试,测试中采用一个MSP430F425作为机器人主控制器,下行控制一个十二个关节的简易人形机器人。在MSP430F425中规划好机器人的步态,同时根据规划好的步态参数发送舵机动作命令。
    实验中,首先实测舵机的精度,通过向特定定时器通道预装不同值,测量舵机响应角度,并以此数据拟合出舵机响应角度方程。实验中由于采用的MSP430F425资源有限,方程仅进行了线性拟合。
    表2为测试机器人上一处关节的舵机测定数据,根据此数据拟合出以下方程:


    舵机实际角度α=(X-3 000)/20+75.5运用拟合出的方程进行命令到舵机角度的解析,得到表3所示数据


    从表中数据可以看出,在舵机的性能范围内(舵机的精度为0.5°~1°),控制是精确的。
    同时,在舵机响应的及时性方面,也得到了保证。从主控制器发送命令到舵机响应开始运动共经历了命令传输、命令解析两大时间段。
    命令传输在特定的速率下传输完所有命令数据用时4.5 ms,而命令解析即单片机内程序执行,其用时远小于1 ms。相比较,舵机的机械响应时间在百ms级,因此动作控制器保证了响应的及时性。
    实验证明,在设计思想指导下的硬件和软件实现,充分符合既定的目标,体现在机器人的多关节能够协调动作,预先规划的步态能够很好的表现出来。
    在机器人的实际控制系统中,动作控制器作为主控制器(ARM 9)的下级从属设备,完成其特定的管理范围内工作。在这种分层控制的体系结构下,自平衡的检测与控制达到了理想的效果。

3 结束语
   
由于自平衡人形机器人具有内在不稳定性和结构的复杂性,国内外机器人爱好者对其控制策略进行了多方面的探索,但通常都是采用反馈控制环路或者是分层体系结构的方法。采用这些传统的方式大体都是中央处理器(ARM、DSP等)接收收集到的信息,进行处理,再根据获取的信息运用一定的算法控制执行元件(舵机、直流电机等)。这类体系结构一般以惟一的处理器为核心,与外界直接进行信息交换,但其处理器的工作量大,在大量的处理中实时性难以保证。
    而本设计对应的双足自平衡人形机器人采用了这两种经典结构的复合,其中执行控制器、主控制器和执行电机之间体现出了明显的层次结构,这种设计减轻了各层次的任务难度,明显提高了设备调试或故障排查效率,充分体现出这种体系结构的优越性。

本站声明: 本文章由作者或相关机构授权发布,目的在于传递更多信息,并不代表本站赞同其观点,本站亦不保证或承诺内容真实性等。需要转载请联系该专栏作者,如若文章内容侵犯您的权益,请及时联系本站删除。
换一批
延伸阅读

9月2日消息,不造车的华为或将催生出更大的独角兽公司,随着阿维塔和赛力斯的入局,华为引望愈发显得引人瞩目。

关键字: 阿维塔 塞力斯 华为

加利福尼亚州圣克拉拉县2024年8月30日 /美通社/ -- 数字化转型技术解决方案公司Trianz今天宣布,该公司与Amazon Web Services (AWS)签订了...

关键字: AWS AN BSP 数字化

伦敦2024年8月29日 /美通社/ -- 英国汽车技术公司SODA.Auto推出其旗舰产品SODA V,这是全球首款涵盖汽车工程师从创意到认证的所有需求的工具,可用于创建软件定义汽车。 SODA V工具的开发耗时1.5...

关键字: 汽车 人工智能 智能驱动 BSP

北京2024年8月28日 /美通社/ -- 越来越多用户希望企业业务能7×24不间断运行,同时企业却面临越来越多业务中断的风险,如企业系统复杂性的增加,频繁的功能更新和发布等。如何确保业务连续性,提升韧性,成...

关键字: 亚马逊 解密 控制平面 BSP

8月30日消息,据媒体报道,腾讯和网易近期正在缩减他们对日本游戏市场的投资。

关键字: 腾讯 编码器 CPU

8月28日消息,今天上午,2024中国国际大数据产业博览会开幕式在贵阳举行,华为董事、质量流程IT总裁陶景文发表了演讲。

关键字: 华为 12nm EDA 半导体

8月28日消息,在2024中国国际大数据产业博览会上,华为常务董事、华为云CEO张平安发表演讲称,数字世界的话语权最终是由生态的繁荣决定的。

关键字: 华为 12nm 手机 卫星通信

要点: 有效应对环境变化,经营业绩稳中有升 落实提质增效举措,毛利润率延续升势 战略布局成效显著,战新业务引领增长 以科技创新为引领,提升企业核心竞争力 坚持高质量发展策略,塑强核心竞争优势...

关键字: 通信 BSP 电信运营商 数字经济

北京2024年8月27日 /美通社/ -- 8月21日,由中央广播电视总台与中国电影电视技术学会联合牵头组建的NVI技术创新联盟在BIRTV2024超高清全产业链发展研讨会上宣布正式成立。 活动现场 NVI技术创新联...

关键字: VI 传输协议 音频 BSP

北京2024年8月27日 /美通社/ -- 在8月23日举办的2024年长三角生态绿色一体化发展示范区联合招商会上,软通动力信息技术(集团)股份有限公司(以下简称"软通动力")与长三角投资(上海)有限...

关键字: BSP 信息技术
关闭
关闭