人形機器人是目前最受市場關注的科技發展方向之一。人形機器人集機械、電氣控制、通信、AI于一體，是典型的多領域綜合技術。

人形機器人各個關節的活動，本質上還是控制電機轉動，由電能轉化為可控的機械能。多自由度意味著多電機控制。瑞薩電子的RZ T2H產品，可以實現用一顆芯片，實現9個自由度的運動控制。

RZ T2H可以應用于關節式機器人、協作機器人、生產線上的AGV/AMR、PLC、CNC數控機床、柔性機器人等場景。

其性能如下：

四個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軸展示的軟件框架為：

由R52_0核來控制9路電機，R52_1作為EtherCAT從站，從主站接收控制指令，并傳輸現場運行數據到主站，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個GPT單元，進而輸出用于驅動電機的PWM信號。9路SCIE接口采集9路增量編碼器信號，獲取電機位置信息，9路DSMIF接口采集電機的U/V/W 3相電流信號。

代碼內部邏輯包含了PID控制算法、電流環控制算法、加速度、速度、位置計算、對控制臺命令協議的解析（如果不用控制臺，可以直接在代碼中固定相關參數）。對于電機控制用到的三角函數計算，RZ T2H有TFU單元（Trigonometric Function Unit），加速數學計算。