EtherCAT 开源主站 IGH 在 linux 开发板的移植和伺服通信测试

特立独行的猫a 2024-07-15 16:07:06 阅读 67

手边有一套正点原子linux开发板imax6ul,一直在吃灰,周末业余时间无聊,把EtherCAT的开源IGH主站移植到开发板上玩玩儿,搞点事情做。顺便学习研究下EtherCAT总线协议及其对伺服驱动器的运动控制过程。实验很有意思,这里总结下实验过程,分享给有需要的小伙伴。

前言

igh EtherCAT Master是一个用于控制EtherCAT网络的软件模块,它提供了主站功能。主站负责与从站进行通信和同步,控制从站的操作。igh EtherCAT Master具有丰富的功能和灵活的配置选项,可以满足不同应用场景的需求。它提供了一系列的API和工具,使得开发者可以方便地进行EtherCAT网络的开发和调试。

igh EtherCAT Master是用的最多且实时性最好的 EtherCAT 开源主站。很多公司项目软件主站都是用的它,有很多软件专利可以挖掘。一些公司的机器人主控四肢电机驱动器通信和运动板卡,采用的也是IgH 。基于IgH作产品开发,基本能满足大部分使用场景。

关于EtherCAT主站协议栈,目前有两大主流开源代码为SOEM(即支持Linux,又支持windows )和IgH EtherCAT Master只支持Linux )。

本文以IgH最新稳定版本1.6来移植,简单记录下IgH EtherCAT Master在嵌入式系统中的移植过程及主从站伺服驱动器通信测试。( [Linux 内核版本:Linux-4.1.15] )。

IgH官方介绍:

EtherCAT-Master | EtherLab

整个交叉编译过程很顺利,没遇到一点儿报错。本次移植仅是测试,简单起见使用通用的网卡驱动,性能上肯定不是最好。要想高性能一方面需要给内核打实时性补丁,一方面还需对特定的网卡驱动进行优化适配。源码里自带了一些网卡驱动,如8139和e1000网卡驱动,Igb(Intel Gigabit )以太网驱动程序。

8139和e1000是两种常见的网卡芯片,分别由Realtek和Intel生产。Realtek 8139(也称为RTL8139)是Realtek生产的一款常用的乙太网网卡芯片,广泛应用于早期的计算机和嵌入式系统中。Intel e1000系列是Intel生产的一组高性能千兆位乙太网控制器芯片,包括e1000、e1000e和82574等型号,适用于桌面计算机、服务器和嵌入式系统。这两种网卡芯片均具有集成的MAC(Media Access Control)功能,用于管理数据链路层的访问和控制,以及PHY(Physical Layer)功能,用于处理物理层的信号传输和解调。它们同时具备MAC和PHY功能。

移植准备

IGH最新稳定版1.6源码下载地址:

https://gitlab.com/etherlab.org/ethercat/-/archive/stable-1.6/ethercat-stable-1.6.tar.gz

准备Linux-4.1.15内核源码,(编译驱动模块需要) 我的路径:

<code>/root/test/imax6ul/linux

开发板提供的gcc交叉编译工具链:

/opt/fsl-imx-x11/4.1.15-2.1.0/environment-setup-cortexa7hf-neon-poky-linux-gnueabi

如果还想要给内核打上实时性补丁包,可以在这找到:Index of /pub/linux/kernel/projects/rt/4.14/

#为内核源码打上实时补丁

cd linux

patch -p 1 -i ../patch-4.10.199-rt97.patch

至此,准备工作完成。 

源码编译过程

先加载编译环境变量,直接执行以下指令即可。

source /opt/fsl-imx-x11/4.1.15-2.1.0/environment-setup-cortexa7hf-neon-poky-linux-gnueabi

执行完成后, arm-poky-linux-gnueabi-gcc已经加入到环境变量中了。可以在命令行输出echo $CC试试看,输出了arm-poky-linux-gnueabi-gcc,说明环境已经生效了。

 编译主站程序和协议栈

<code># EtherCAT 源码存放目录为:/root/test/ethercat/ethercat-stable-1.6

# Linux-4.1.15 源码存放目录为:/root/test/imax6ul/linux/ linux-4.1.15

tar -zxvf ethercat-stable-1.6.tar.gz# 解压源码 /root/test/ethercat/ethercat-stable-1.6

cd ethercat-stable-1.6

# --prefix是指定你下面make install时的安装目录,--with-linux-dir是指定你的linux内核目录

./configure --prefix=/root/test/ethercat/output --with-linux-dir=/root/test/imax6ul/linux --enable-8139too=no --enable-generic=yes --host=arm-poky-linux-gnueabi

make# 编译主站和协议栈源码

make install #安装到指定目录

经过上面的交叉编译,只是编译出了主站协议栈库和自带主站工具及程序,但是这还不算完。

ethercat:可执行程序是用于配置和管理 EtherCAT 主站(IGH 主站)的命令行工具。

ethercatctl:是一个用于控制 EtherCAT Master 运行状态的命令行工具。它提供了启动、停止、重启 EtherCAT Master 等操作的命令,用于管理 EtherCAT Master 的运行。

经过上面的编译,编译出来的内容如下图所示:

库和头文件: 

linux内核驱动模块还没出来,所以直接是运行不起来的,还需要编译出内核网络驱动模块。

编译内核驱动模块

<code>#编译网卡驱动模块

# 指定交叉编译工具,编译modules

make ARCH=arm CROSS_COMPILE=arm-poky-linux-gnueabi- modules # 编译通过会对应生成ethercat-stable-1.6/devices/ec_generic.ko和ethercat-stable-1.6/master/ec_master.ko

sudo make install# 在该目录下生成output目录

成功编译出了ec_master.ko 和 ec_generic.ko的linux驱动模块。 

ec_master.ko:用于支持 EtherCAT 主站运行的 Linux 内核模块。它实现了 EtherCAT 主站协议栈,允许在 Linux 系统上与 EtherCAT 从站设备进行实时通信和数据交换。主要负责存储一些ethercat从站信息,管理domains域,管理从站配置等有关于ethercat系统的资源,在/etc/sysconfig/ethercat中配置的MASTER0_DEVICE会作为该模块参数传入主站模块,最终成为主站模块的mac使用网络地址,即master->macs;

ec_generic.ko,经由系统网络栈利用标准以太网 (Ethernet) 的网络驱动程序。

ec_generic,这个通用的驱动文件是在TCP/IP协议栈接口之上进行调用的,所以会走TCP/IP协议栈,会影响实时性。正式用应优化网卡驱动,在网卡驱动上直接支持IgH接口。

放到板子上运行

复制ec_generic.ko和ec_master.ko到/lib/modules/内核版本号,复制ethercat到usr/local/bin目录下。安装通用网卡驱动,配置rules,创建设备号。

操作步骤

<code># 在/root/test/ethercat目录下创建modules文件夹,并复制ec_generic.ko和ec_master.ko到modules下

mkdir -p output/modules

cp devices/ec_generic.ko output/modules/

cp master/ec_master.ko output/modules/

# 将output文件夹打包,传输到开发板(nfs/tftp/scp)

tar -cjf output.tar.bz2 output/

-------------------------------------------------------------------------------------------------------------------------------------

# 开发板上执行

tar -jxvf output.tar.bz2

cp output/modules/ec_generic.ko /lib/modules/4.1.15

# 复制ec_master.ko到/lib/modules/内核版本号/

cp output/modules/ec_master.ko /lib/modules/4.1.15 # 内核版本可以通过uname -r 查看

depmod

ln -fs output/etc/init.d/ethercat /etc/init.d/ # 创建链接,相比于复制节省内存空间

ln -fs output/bin/ethercat /usr/local/bin/

mkdir /etc/sysconfig

ln -fs output/etc/sysconfig/ethercat /etc/sysconfig/

# 配置rules,创建设备号

echo KERNEL==\"EtherCAT[0-9]*\", MODE=\"0664\" > /etc/udev/rules.d/99-EtherCAT.rules

# 获取板子MAC地址

ifconfig

# eth2 Link encap:以太网 硬件地址 00:0c:29:01:69:aa

-------------------------------------------------------------------------------------------------------------------------------------

# 启动EtherCAT

# 配置主站的MAC地址

modprobe ec_master main_devices=1E:ED:19:27:1A:B3

# 启动ethercat

/etc/init.d/ethercat start

# 安装通用网卡驱动

insmod output/modules/ec_generic.ko

# 通过ethercat查看信息

Ethercat --help

运行测试

通过网线直连ethercat主从站,从站启动完成后,启动ethercat。

/etc/init.d/ethercat start

下面就可以使用 ethercat 工具来进行一些操作了。

sudo ethercat cstruct

ethercat 命令行

EtherCAT 命令行在 《EtherCAT IGH 1.52.pdf》中的 <7.1 Command-line Tool> 也有很详细的一个介绍。在编译和安装IGH的时候,如果不修改默认的编译参数,那么就是会提供 EtherCAT 命令行工具的。每个主站的实例都有生成一个字符设备,名字为:/dev/EtherCATx, 其中 x ∈ {0 . . . n}为主站实例的索引。

常用命令介绍

ethercat master

该命令行用来显示主站和以太网设备信息。

列出主站状态:

ethercat slaves

列出连接的从站:

ethercat cstruct

ethercat sdos

该命令行用来输出当前驱动器支持的所有的SDO信息。

举例:

@:~$ ethercat upload 0x2001 0x0000

0x03e8 1000

解析:读取从站0中索引号为 0x2001(16位),子索引号为00(8位)的SDO条目。返回的参数值为 1000。

注意:必须有从站连接才能使用此命令,不运行应用程序也可以使用。

 ethercat download

该命令行用以向指定的从站 SDO 中的子索引中写入相应的参数值。

例子:

向从站0的索引号为0x6060(16位),子索引号为00(8位)的地址写入参数值"0x08"。

@:~$ sudo ethercat download -t int16 -p 0 0x6060 00 08

有的SDO 可能是由于厂家的限制,不能写入参数。

@:~$ sudo ethercat download -t uint16 0x2008 0x0000 0x000f

SDO transfer aborted with code 0x08000021: Data cannot be transferred or stored to the application because of local control

注意:必须有从站连接才能使用此命令,不运行应用程序也可以使用。 

@:~$ ethercat sdos

SDO 0x1000, "Device type"

0x1000:00, r-r-r-, uint32, 32 bit, "Device type"

SDO 0x1001, "Error register"

0x1001:00, r-r-r-, uint8, 8 bit, "Error register"

SDO 0x1008, "Device name"

0x1008:00, r-r-r-, string, 72 bit, "Device name"

SDO 0x1009, "Hardware version"

0x1009:00, r-r-r-, string, 24 bit, "Hardware version"

SDO 0x100a, "Software version"

0x100a:00, r-r-r-, string, 32 bit, "Software version"

SDO 0x1010, "store parameters"

0x1010:00, r-r-r-, uint8, 8 bit, "SubIndex 000"

0x1010:01, rwrwrw, uint32, 32 bit, "save all parameters"

0x1010:02, rwrwrw, uint32, 32 bit, "save communication parameters"

0x1010:03, rwrwrw, uint32, 32 bit, "save application parameters"

0x1010:04, rwrwrw, uint32, 32 bit, "save manufacturer defined parameters"

..............

SDO 0x6007, "Abort_connection_option_code"

0x6007:00, rwrwrw, int16, 16 bit, "Abort_connection_option_code"

SDO 0x603f, "errorcode"

0x603f:00, r-r-r-, uint16, 16 bit, "errorcode"

SDO 0x6040, "controlword"

0x6040:00, rwrwrw, uint16, 16 bit, "controlword"

SDO 0x6041, "statusword"

0x6041:00, r-r-r-, uint16, 16 bit, "statusword"

..............

ethercat pdos

该命令行用来显示出同步管理器的参数和PDO分配和映射信息。

ethercat upload

该命令行用以读取指定从站相应PDO设定的参数值。

其他一些命令,参考:EtherCAT IGH 命令行介绍_igh ethercat-CSDN博客

@:~$ ethercat --help

alias Write alias addresses.

config Show slave configurations.

crc CRC error register diagnosis.

cstruct Generate slave PDO information in C language.

data Output binary domain process data.

debug Set the master's debug level.

domains Show configured domains.

download Write an SDO entry to a slave.

eoe Display Ethernet over EtherCAT statictics.

foe_read Read a file from a slave via FoE.

foe_write Store a file on a slave via FoE.

graph Output the bus topology as a graph.

ip Set EoE IP parameters.

master Show master and Ethernet device information.

pdos List Sync managers, PDO assignment and mapping.

reg_read Output a slave's register contents.

reg_write Write data to a slave's registers.

rescan Rescan the bus.

sdos List SDO dictionaries.

sii_read Output a slave's SII contents.

sii_write Write SII contents to a slave.

slaves Display slaves on the bus.

soe_read Read an SoE IDN from a slave.

soe_write Write an SoE IDN to a slave.

states Request application-layer states.

upload Read an SDO entry from a slave.

version Show version information.

xml Generate slave information XML.

Global options:

--master -m <master> Comma separated list of masters

to select, ranges are allowed.

Examples: '1,3', '5-7,9', '-3'.

Default: '-' (all).

--force -f Force a command.

--quiet -q Output less information.

--verbose -v Output more information.

--help -h Show this help.

Numerical values can be specified either with decimal (no

prefix), octal (prefix '0') or hexadecimal (prefix '0x') base.

Call 'ethercat <COMMAND> --help' for command-specific help.

测试效果

网上有一组测试效果,连接五个从站,主站单次收发数据的平均耗时以及实时性。测试主站单次收发数据的平均耗时的程序每隔 100 μs 发送并接收一次过程数据,如此每循环 10000 次记录一下当前时间,相邻两次记录的时间间隔减去其间空闲时间 100 μs × 10000 = 1 s 再除以收发次数 10000 便得到单次收发数据的平均耗时,使用三种不同的网卡驱动,三种情形下的大致结果如下表:

主站测试代码

<code>#include <errno.h>

#include <signal.h>

#include <stdio.h>

#include <string.h>

#include <sys/resource.h>

#include <sys/time.h>

#include <sys/types.h>

#include <unistd.h>

/****************************************************************************/

#include "ecrt.h"

/****************************************************************************/

// Application parameters

#define FREQUENCY 100

#define PRIORITY 1

// Optional features

#define CONFIGURE_PDOS 1

/****************************************************************************/

// EtherCAT

static ec_master_t *master = NULL;

static ec_master_state_t master_state = {};

static ec_domain_t *domain1 = NULL;

static ec_domain_state_t domain1_state = {};

static ec_domain_t *domain2 = NULL;

static ec_domain_state_t domain2_state = {};

static ec_slave_config_t *sc;

static ec_slave_config_state_t sc_ana_in_state = {};

// Timer

static unsigned int sig_alarms = 0;

static unsigned int user_alarms = 0;

/****************************************************************************/

// process data

static uint8_t *domain1_pd = NULL;

static uint8_t *domain2_pd = NULL;

#define BusCouplerPos 0, 0

#define TI_AM3359ICE 0xE000059D, 0x54490001

// offsets for PDO entries

static unsigned int off_dig_out2;

static unsigned int off_dig_in2;

static unsigned int counter = 0;

static unsigned int blink = 0x00;

/*****************************************************************************/

#if CONFIGURE_PDOS

ec_pdo_entry_info_t slave_0_pdo_entries[] = {

{0x7010, 0x00, 32},

{0x6000, 0x00, 4*8},

};

ec_pdo_info_t slave_0_pdos[] = {

{0x1601, 1, slave_0_pdo_entries + 0},

{0x1a00, 1, slave_0_pdo_entries + 1},

};

static ec_sync_info_t slave_0_pdo_syncs[] = {

{2, EC_DIR_OUTPUT, 1, slave_0_pdos + 0},

{3, EC_DIR_INPUT, 1, slave_0_pdos + 1},

{0xff}

};

#endif

/*****************************************************************************/

void check_domain1_state(void)

{

ec_domain_state_t ds;

ecrt_domain_state(domain1, &ds);

if (ds.working_counter != domain1_state.working_counter)

printf("Domain1: WC %u.\n", ds.working_counter);

if (ds.wc_state != domain1_state.wc_state)

printf("Domain1: State %u.\n", ds.wc_state);

domain1_state = ds;

}

/*****************************************************************************/

void check_domain2_state(void)

{

ec_domain_state_t ds;

ecrt_domain_state(domain2, &ds);

if (ds.working_counter != domain2_state.working_counter)

printf("Domain2: WC %u.\n", ds.working_counter);

if (ds.wc_state != domain2_state.wc_state)

printf("Domain2: State %u.\n", ds.wc_state);

domain2_state = ds;

}

/*****************************************************************************/

void check_master_state(void)

{

ec_master_state_t ms;

ecrt_master_state(master, &ms);

if (ms.slaves_responding != master_state.slaves_responding)

printf("%u slave(s).\n", ms.slaves_responding);

if (ms.al_states != master_state.al_states)

printf("AL states: 0x%02X.\n", ms.al_states);

if (ms.link_up != master_state.link_up)

printf("Link is %s.\n", ms.link_up ? "up" : "down");

master_state = ms;

}

/*****************************************************************************/

void check_slave_config_states(void)

{

ec_slave_config_state_t s;

ecrt_slave_config_state(sc, &s);

if (s.al_state != sc_ana_in_state.al_state)

printf("AnaIn: State 0x%02X.\n", s.al_state);

if (s.online != sc_ana_in_state.online)

printf("AnaIn: %s.\n", s.online ? "online" : "offline");

if (s.operational != sc_ana_in_state.operational)

printf("AnaIn: %soperational.\n",

s.operational ? "" : "Not ");

sc_ana_in_state = s;

}

/*****************************************************************************/

void cyclic_task()

{

// receive process data

ecrt_master_receive(master);

ecrt_domain_process(domain1);

ecrt_domain_process(domain2);

// check process data state (optional)

check_domain1_state();

check_domain2_state();

// if (counter) {

// counter--;

// } else { // do this at 1 Hz

counter = FREQUENCY;

// calculate new process data

blink ++;

// check for master state (optional)

check_master_state();

// check for islave configuration state(s) (optional)

check_slave_config_states();

//printf("AnaIn: value=0x%x\n", EC_READ_U32(domain2_pd + off_dig_in2));

printf("AnaIn: value=0x%x\n", EC_READ_U32(domain2_pd + off_dig_in2));

//printf("AnaIn: value=0x%x\n", EC_READ_U32(domain2_pd + off_dig_in2 + 4));

EC_WRITE_U32(domain1_pd + off_dig_out2, blink);

//printf("AnaIn: value=0x%x\n", EC_READ_U32(domain1_pd + off_dig_out2));

// }

// send process data

ecrt_domain_queue(domain1);

ecrt_domain_queue(domain2);

ecrt_master_send(master);

}

/****************************************************************************/

void signal_handler(int signum) {

switch (signum) {

case SIGALRM:

sig_alarms++;

break;

}

}

/****************************************************************************/

int main(int argc, char **argv)

{

struct sigaction sa;

struct itimerval tv;

master = ecrt_request_master(0);

if (!master)

return -1;

domain1 = ecrt_master_create_domain(master);

if (!domain1)

return -1;

domain2 = ecrt_master_create_domain(master);

if (!domain2)

return -1;

#if CONFIGURE_PDOS

if (!(sc = ecrt_master_slave_config(

master, BusCouplerPos, TI_AM3359ICE))) {

fprintf(stderr, "Failed to get slave configuration.\n");

return -1;

}

if (ecrt_slave_config_pdos(sc, EC_END, slave_0_pdo_syncs)) {

fprintf(stderr, "Failed to configure PDOs.\n");

return -1;

}

printf("Configuring PDOs...\n");

// Create configuration for bus coupler

off_dig_out2 = ecrt_slave_config_reg_pdo_entry(sc,

0x7010, 0, domain1, NULL);

if (off_dig_out2 < 0)

return -1;

off_dig_in2 = ecrt_slave_config_reg_pdo_entry(sc,

0x6000, 0, domain2, NULL);

if (off_dig_in2 < 0)

return -1;

#endif

printf("Activating master...\n");

if (ecrt_master_activate(master))

return -1;

if (!(domain1_pd = ecrt_domain_data(domain1))) {

return -1;

}

if (!(domain2_pd = ecrt_domain_data(domain2))) {

return -1;

}

sa.sa_handler = signal_handler;

sigemptyset(&sa.sa_mask);

sa.sa_flags = 0;

if (sigaction(SIGALRM, &sa, 0)) {

fprintf(stderr, "Failed to install signal handler!\n");

return -1;

}

printf("Starting timer...\n");

tv.it_interval.tv_sec = 0;

tv.it_interval.tv_usec = 1000000 / FREQUENCY;

tv.it_value.tv_sec = 0;

tv.it_value.tv_usec = 2000;

if (setitimer(ITIMER_REAL, &tv, NULL)) {

fprintf(stderr, "Failed to start timer: %s\n", strerror(errno));

return 1;

}

printf("Started.\n");

while (1) {

pause();

while (sig_alarms != user_alarms) {

cyclic_task();

user_alarms++;

}

}

return 0;

}

/****************************************************************************/

/***********IGH demo编译*****************/

arm-linux-gnueabi-gcc main.c -o ethercat_test -I../../ethercat/include/ -L../..ethercat/lib -lethercat

IGH在Linux应用空间的其他使用

参考EtherCAT源码下的example。

git clone https://gitee.com/wllw7176/MyEthercat-IGH-1.5.2.git

 参考EtherCAT二次开发的源代码

其他资源

EtherCAT使用与解析-ethercat系统内核模块加载与初始化操作_ec_generic.ko-CSDN博客

https://www.cnblogs.com/wujingcqu/p/16295570.html

https://blog.51cto.com/u_15858333/6406909

IgH详解 一、概述-CSDN博客

EtherCAT设备协议详解二、EtherCAT状态机及配置流程-CSDN博客

在x86-64和arm64 Linux上调试IgH EtherCAT主站软件以及实现星形走线连接多从站 - 知乎

ethercatpack/mytest/test_ethercat.c · wllw7176_gitee/MyEthercat-IGH 1.5.2 - Gitee.com

https://pwl999.blog.csdn.net/article/details/109397917

IgH EtherCAT主站开发案例分享——基于NXP i.MX 8M Mini - 知乎

开源工业以太网现场总线协议栈汇总_soes从站模拟器-CSDN博客

raspberry pi RT-Linux平台搭建IgH环境_一种用于igh的网络驱动系统及方法与流程-CSDN博客

EtherCAT主站IgH解析(一)--主站初始化、状态机与EtherCAT报文_igh ethercat-CSDN博客

EtherCAT IGH 命令行介绍_igh ethercat-CSDN博客

LinuxCNC搭配Igh EtherCat Master开源Ethercat主站通讯控制测试_linuxcnc igh-CSDN博客

【虹科干货】使用Profishark进行EtherCAT主站性能测试 – 宏网络安全信息门户网站2

基于Zynq平台的igh EtherCAT主站的配置和使用方法,包括Preempt RT和Xenomai两种实时内核的介绍和配置示例_ethercat1.5.2中文-CSDN博客

https://www.cnblogs.com/tdyizhen1314/p/17628400.html



声明

本文内容仅代表作者观点,或转载于其他网站,本站不以此文作为商业用途
如有涉及侵权,请联系本站进行删除
转载本站原创文章,请注明来源及作者。