官方网站-首页

【导语】人形机器人作为当前科技发展的热点方向，集成了机械、电气控制、通信与AI等多领域技术。其核心在于电机的精准控制，实现多自由度(dù)运(yùn)动(dòng)。瑞(ruì)萨(sà)电(diàn)子(zi)的(de)RZ T2H产(chǎn)品(pǐn)以(yǐ)其(qí)强(qiáng)大(dà)的(de)多(duō)核(hé)异(yì)构(gòu)与(yǔ)外(wài)设(shè)能(néng)力(lì)，仅(jǐn)凭(píng)一(yī)颗(kē)芯(xīn)片(piàn)即(jí)可(kě)实(shí)现(xiàn)9个(gè)自(zì)由(yóu)度(dù)的(de)运(yùn)动(dòng)控(kòng)制(zhì)，为(wèi)人(rén)形(xíng)机(jī)器(qì)人(rén)及(jí)其(qí)他(tā)自(zì)动(dòng)化(huà)场(chǎng)景(jǐng)提(tí)供(gōng)了高效解决方案。本文将深入探讨RZ T2H的性能特点、应用场景及其在人形机器人电机控制中的独特优势。

人形机器人是目前最受市场关注的科技发展方向之一。人形机器人集机械、电气控制、通信、AI于一体，是典型的多领域综合技术。

人形机器人各个关节的活动，本质上还是控制电机转动，由电能转化为可控的机械能。多自由度意味着多电机控制。瑞萨电子的RZ T2H产品，可以实现用一颗芯片，实现9个自由度的运动控制。

RZ T2H可以应用于关节式机器人、协作机器人、生产线上的AGV/AMR、PLC、CNC数控机(jī)床(chuáng)、柔(róu)性(xìng)机(jī)器(qì)人(rén)等(děng)场景。

其性能如下：

四个Arm Cortex-A55核，最高频率1.2GHz

每个CPU有32KB L1的I-Cache和D-Cache

共享1MB L3 Cache

内置高精度（±1.0%）高速片上振荡器

1.6V至5.5V的宽工作电压范围消除了在5V系统中使用电平转换器/稳压器的需求

两个Arm Cortex-R52核，最高频率1GHz

每个CPU有16KB的L1 Cache

每个CPU有512KB ATCM和64KB BTCM

内置高精度（±1.0%）高速片上振荡器

1.6V至5.5V的宽工作电压范围消除了在5V系统中使用电平转换器/稳压器的需求

对于外设：

内置高精度（±1.0%）高速片上振荡器

1.6V至5.5V的宽工作电压范围消除了在5V系统中使用电平转换器/稳压器的需求

支持EtherCAT，Profinet RT/IRT， Ethernet I/P，CC link IE Basic，TSN， OPC UA over TSN等工业通信协议

图1 RZ T2H框图

瑞萨电子提供了一套9轴demo，其硬件框架如下：

图2 RZ T2H 9轴展示硬件框图

硬件包括：

1块RZ T2H EVK板，9块逆变板分别驱动9个电机，1块BUS母板用于接插逆变板。

图3 RZ T2H 9轴展示软件框图

9轴(zhóu)展(zhǎn)示(shì)的(de)软(ruǎn)件(jiàn)框(kuāng)架(jià)为(wèi)：

由(yóu)R52_0核(hé)来(lái)控(kòng)制(zhì)9路电(diàn)机(jī)，R52_1作(zuò)为(wèi)EtherCAT从(cóng)站(zhàn)，从(cóng)主站(zhàn)接(jiē)收(shōu)控(kòng)制(zhì)指(zhǐ)令(lìng)，并(bìng)传(chuán)输(shū)现(xiàn)场(chǎng)运(yùn)行(xíng)数(shù)据(jù)到(dào)主站，4个A55核运行Linux系统，和EtherCAT主站应用内软件。由于T2H强大的多核异构和外设能力，可以实现R核处理实时控制，而让A核做复杂的主站控制，这种驱控一体的应用设计。

具体实施：

下图是硬件接线实物图。

图4 RZ T2H 9轴实物图

右侧电机型号是多摩川TSM3101 N2001 E020，24V交流伺服电机。

左侧是运行在PC端的RZ/T2H Motion Control Utility，可以对9路电机分别采用电流环、位置环控制，也可以同时控制9路电机旋转。

A55与R52_1之间的EtherCAT通信，如下图的示意。同时，还可以通过T2H的网口连接更多的EtherCAT Slave设备，组成子网。

图5 EtherCAT通信拓扑结构

R52_0与R52_1核间通信采用OpenAMP或者RZ T2H自带的Mailbox and Semaphore机制。当然，OpenAMP也是基于RZ T2H Mailbox and Semaphore实现，该功能实现多核之间通信。

对于核间通信，数据Copy性能如下：

注：

测量1：发送端从0x101e0000拷贝16KB数据到共享地址 0x101a1000，non-cache操作。

测量2：接收端从共享地址0x101a1000拷贝16KB数据到0x101c0000，non-cache操作。

核间中断是2us。

同时，如下图所示，瑞萨提供了A55工作于Linux，一个R52核工作于FreeRTOS，另一个R52核工作于Baremetal下的数据共享例程。

图6 丰富多样的参考例程

Q

为什么一个R52核就可以控制9路电机？

A：得益于LLPP（Low-Latency Peripheral Port）总线和强大的外设。如下图所示，两个R52核可同时访问LLPP，且这两个核的TCM容量较大，让执行程序在TCM中运行，运算和控制速度更快。

图7 RZ T2H LLPP架构

T2H系列的ELC（Event Link Contrller）功能，让同步逻辑变得更加简单，代码中无需通过中断回调的方式去触发，只用ELC硬件同步即可，代码变得更加简单高效。

在9轴展示例程中，硬件上，CR52 CPU0通过LLPP总线访问9个(gè)GPT单(dān)元(yuán)，进(jìn)而(ér)输(shū)出(chū)用(yòng)于(yú)驱(qū)动(dòng)电(diàn)机(jī)的PWM信号。9路SCIE接口采集9路增量编码器信号，获取电机位置信息，9路DSMIF接口采集电机的U/V/W 3相电流信号(hào)。

代(dài)码内部逻辑包含了PID控制算法、电流环控制算法、加速度、速度、位置计算、对控制台命令协议的解析（如果不用控制台，可以直接在代码中固定相关参数）。对于电机控制用到的三角函数计算，RZ T2H有TFU单元（Trigonometric Function Unit），加速数学计算。