RK3506G EVB1 实时内核与 CODESYS EtherCAT Quickstart
本文沉淀 RK3506G EVB1 从零搭建 PREEMPT_RT 实时内核、部署 CODESYS Runtime、并用 CODESYS IDE 连接调试的完整流程。全部步骤在 /home/user/SDK/rk3xxx 实测通过。
背景与结论速览
| 项目 | 状态 | 说明 |
|---|---|---|
| 实时内核 | 6.1.172-rt59 #9 SMP PREEMPT_RT | 独立 worktree,不动原版 kernel-6.1 |
| CPU1 隔离 | isolcpus=1 nohz_full=1 | 来自 U-Boot 环境变量,isolated=1 |
| cyclictest 基线 | 空载 Max 5µs / 加压 Max 26µs | 300 秒,CPU1,满足验收阈值 |
| 板载网卡 | 内建 STMMAC eth0 | RX Watchdog 已关闭;当前板端管理状态为 UP、物理链路为 NO-CARRIER,需现场确认从站供电、网线和链路 |
| CODESYS Runtime | 3.5.22.20 ARM SL | demo 模式,每约 2 小时需重启 |
| EtherCAT 主站 | IoDrvEtherCAT | 已建立 EtherCAT_Task;Cycle Time 以 CODESYS Monitor 为准 |
| EtherCAT 从站 | Panasonic MADHT1505BA1 | Alias 4、Position 0、Vendor 0x0000066f、Product 0x515050a1 |
前提条件
- SDK 根目录
/home/user/SDK/rk3xxx,目标板 RK3506G EVB1(SPI NAND) - 板级配置
device/rockchip/.chips/rk3506/rockchip_rk3506_g_evb1_defconfig,DTS 为rk3506g-evb1-v10 - ADB 工具
hadb(Linux 侧)与 Windows 侧adb.exe(platform-tools) - CODESYS Development System(3.5.14+)与两个压缩包:
ARM_SL.zip(板端 Runtime)、4.21.0.0.zip(IDE 设备描述) - 只刷 boot/uboot 分区,不刷 rootfs
第一步:构建 PREEMPT_RT 内核
原版 kernel-6.1 保持不动,用独立 worktree 承载实时补丁:
cd /home/user/SDK/rk3xxx
git -C kernel-6.1 worktree add ../kernel-6.1-rt -b rk3506-preempt-rt-6.1.172 4f67826192dc
在 worktree 上应用与基线匹配的 RT 补丁(本文使用 6.1.172-rt59),确认补丁 id 后再编译。
板级 defconfig 通过 fragment 引入实时与驱动配置,确认 rockchip_rk3506_g_evb1_defconfig 含:
RK_UBOOT_INI="RK3506MINIALL_RT.ini"
RK_KERNEL_CFG_FRAGMENTS="rockchip_rt.config"
RK_KERNEL_DTS_NAME="rk3506g-evb1-v10"
kernel-6.1-rt/arch/arm/configs/rockchip_rt.config 实测内容(核心项):
CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE=y
# CONFIG_HZ_PERIODIC is not set
CONFIG_NO_HZ_FULL=y
CONFIG_HZ_1000=y
CONFIG_PREEMPT_RT=y
CONFIG_USB_DWC2=y
CONFIG_PHY_ROCKCHIP_INNO_USB2=y
CONFIG_USB_GADGET=y
CONFIG_USB_LIBCOMPOSITE=y
CONFIG_USB_CONFIGFS=y
CONFIG_USB_CONFIGFS_F_FS=y
CONFIG_VDSO=y
CONFIG_MII=y
CONFIG_PHYLIB=y
CONFIG_MDIO_DEVICE=y
CONFIG_MDIO_BUS=y
CONFIG_MDIO_DEVRES=y
CONFIG_STMMAC_ETH=y
CONFIG_STMMAC_PLATFORM=y
CONFIG_DWMAC_ROCKCHIP=y
要点:USB 系列内建保证 ADB 可用;GMAC 系列内建是因为 rootfs 只带普通内核 6.1.172 的模块目录,RT 内核 6.1.172-rt59 加载不了任何 .ko,网卡驱动必须编进内核。
实时增强(当前已启用;调整后需重编并刷入 boot 分区):
# CONFIG_HZ_PERIODIC is not set
CONFIG_NO_HZ_FULL=y
CONFIG_RCU_NOCB_CPU=y
CONFIG_RCU_NOCB_CPU_DEFAULT_ALL=y
CONFIG_HZ_1000=y
CONFIG_PREEMPT_RT=y
编译并生成 boot 镜像:
cd /home/user/SDK/rk3xxx
./build.sh kernel-6.1-rt
产物 output/firmware/boot.img,只刷 boot 分区。
第二步:设备树修改
文件:kernel-6.1-rt/arch/arm/boot/dts/rk3506g-evb1-v10.dts
OTG0 是 EVB1 的调试 USB 口,使能其 DWC2 控制器以提供 ADB:
&u2phy_otg0 {
vbus-supply = <&vcc5v0_otg0>;
rockchip,gpio-vbus-det;
status = "okay";
};
&usb20_otg0 {
status = "okay";
};
以太网无需改动:共享文件 rk3506-evb1-v10.dtsi 已有 &gmac0 status="okay"(RMII、PHY 地址 1、复位脚声明)。注意遗留问题:原理图实际把 RMII0_RSTn 接在 GPIO0_C1,DTS 写的是 C2,靠 PHY 上拉工作,后续建议修正。
改完重复第一步的编译刷写。
第三步:U-Boot 配置与 CPU 隔离
为什么默认进不了命令行
SDK 默认 rk3506_tb.config 打开 CONFIG_SPL_KERNEL_BOOT=y,启动链路为 SPL 直接加载内核:
U-Boot SPL ... → Trying kernel ... → Jumping to Kernel via OP-TEE → Linux
整条链不经过 U-Boot proper,UART 上没有 => 命令行,bootdelay 不生效,按任何键都无法打断。修改前若直接上电,只能看到 SPL 与内核日志交替出现。
修改配置
修改 u-boot/configs/rk3506_tb.config:
# 让 SPL 进入 U-Boot proper,UART 才有命令行
# CONFIG_SPL_KERNEL_BOOT is not set
# 3 秒倒计时便于按任意键打断
CONFIG_BOOTDELAY=3
修改后启动链路变为 SPL → U-Boot proper → Linux,UART 出现 3 秒倒计时,按键即可打断。
与快速启动(Thunderboot)的关系
这套 SDK 默认就是按 Rockchip Thunderboot 快速启动配置的,证据链:
CONFIG_SPL_KERNEL_BOOT=y:SPL 完成 DDR 初始化(RK3506MINIALL_RT.ini的 RT DDR)后,直接解析 boot 分区的 FIT 镜像并跳转内核,跳过 U-Boot proper 整个阶段- boot 镜像由
device/rockchip/common/scripts/mk-fitimage.sh按device/rockchip/.chip/thunderboot.its打包成zboot.img(FIT:zImage + DTB + resource),zImage 换取更快的解压与加载 - 内核侧配合 thunderboot 的启动加速项(部分驱动异步 probe 等,以 SDK 实际配置为准)
两种模式机制差异:
| 项目 | SPL_KERNEL_BOOT=y(默认/最快) | SPL_KERNEL_BOOT=n(本 Quickstart) |
|---|---|---|
| 启动链 | SPL → 内核 | SPL → U-Boot proper → 内核 |
| bootargs 来源 | 编译进 U-Boot 的默认环境 | 环境变量区(setenv/saveenv 可改) |
| UART 命令行 | 无 | 有(BOOTDELAY 倒计时) |
| 启动耗时 | 最短 | 增加数秒 |
| 可调试性 | 只能改源码重编 | 现场改环境变量即可 |
调试期用后者;量产后若追求最快开机,改回 CONFIG_SPL_KERNEL_BOOT=y 重编,并提前把所需 bootargs 固化(编译默认环境或内核 DTS chosen 节点均可)。其余两个产物不受影响:boot.img 仍由 thunderboot.its 打包,MiniLoaderAll.bin 仍含 RT DDR。
编译与刷写
cd /home/user/SDK/rk3xxx
./build.sh uboot
刷写 output/firmware/MiniLoaderAll.bin 和 output/firmware/uboot.img 两个分区(不刷 rootfs)。
进入 U-Boot 命令行
- 重启板子,保持 UART 终端打开
- 看到 U-Boot proper 倒计时
Hit any key to stop autoboot: 3时按任意键 - 出现
=>即进入命令行,可执行printenv bootargs等命令
写入 CPU 隔离参数并持久化
setenv bootargs "${bootargs} isolcpus=1 nohz_full=1"
saveenv
reset
注意:环境变量保存在每块板的 SPI NAND 上,随板走、与固件无关。若 U-Boot 产物构建时配置里还残留 CONFIG_BOOTARGS,产物默认环境也会带隔离,刷完即生效,无需进 CLI。
第四步:启动验证
板端逐项确认:
uname -a # 期望 6.1.172-rt59 ... SMP PREEMPT_RT
cat /sys/kernel/realtime # 期望 1
cat /proc/cmdline # 期望含 isolcpus=1 nohz_full=1
cat /sys/devices/system/cpu/isolated # 期望 1
cat /sys/devices/system/cpu/nohz_full # 期望 1
ip link show dev eth0 # 确认 eth0 存在,并检查 LOWER_UP/NO-CARRIER 链路状态
dmesg | grep -i stmmac # GMAC 驱动探测日志
cat /sys/devices/system/cpu/cpufreq/policy0/scaling_cur_freq # 当前 1608000 kHz
若 isolated 为空,进 U-Boot CLI 执行 printenv bootargs 检查环境变量。
第五步:实时性基线测试
测试工具 cyclictest、stress-ng 已部署在板端 /userdata/rt-test/(来源:Buildroot 包 BR2_PACKAGE_RT_TESTS、BR2_PACKAGE_STRESS_NG,单独编译后推送,未刷 rootfs)。
空载基线(CPU1,FIFO 99,1ms 周期):
export LD_LIBRARY_PATH=/userdata/rt-test/lib
taskset -c 1 /userdata/rt-test/cyclictest -m -a 1 -p 99 -t 1 -i 1000 -D 300s
加压测试(另开一路,压力只打非隔离核):
taskset -c 0,2 /userdata/rt-test/stress-ng --temp-path /userdata/rt-test \
--cpu 2 --io 1 --vm 1 --vm-bytes 16M --timeout 300s --metrics-brief
已记录的 cyclictest 历史基线与验收标准(内核、启动参数或隔离策略变更后须重新执行本节测试,不应直接当作当前验收结果):
| 项目 | 实测 | 阈值 | 结论 |
|---|---|---|---|
| 空载 Avg | 0 µs | 约 1 µs | 通过 |
| 空载 Max | 5 µs | < 30 µs | 通过 |
| 加压 Max | 26 µs | < 70 µs | 通过 |
第六步:部署 CODESYS Runtime
解压 ARM_SL.zip 得到 ARM_SL/(含 codesyscontrol.bin、CODESYSControl*.cfg、libCmp*.so),推送到板端并启动:
hadb -s <序列号> push ARM_SL /userdata/
hadb -s <序列号> shell 'chmod 0755 /userdata/ARM_SL/codesyscontrol.bin'
cd /userdata/ARM_SL
nohup env LD_LIBRARY_PATH=/userdata/ARM_SL ./codesyscontrol.bin \
> codesyscontrol.stdout.log 2>&1 &
约 60 秒后确认:
pidof codesyscontrol.bin
netstat -lnt | grep -E "11740|4840"
grep ready /userdata/ARM_SL/codesyscontrol.log | tail -1
测试台安全配置:CODESYSControl_User.cfg 注释以下两行并重启 Runtime,避免非对称认证与未签名下载拦截:
;SECURITY.UserLogin_AuthenticationType=ONLY_ASYMMETRIC
;SECURITY.UnsignedApplicationFileTransfer=DENY
运行时管理规则:
- demo 模式约 2 小时,到期重启 Runtime 即恢复
- 重启前先
kill -9 $(pidof codesyscontrol.bin)并确认pidof为空,再启动;避免残留双实例导致 OOM。当前 Linux 可见内存约 99MiB,内存余量有限,OOM 可能连带杀掉adbd。 - 设备用户库为
.UserDatabase.csv(隐藏文件)。登录报”目标设备无有效用户验证”时优先核对用户名拼写,紧急情况可将其改名移除以回到免登录出厂状态 - 启动时将当时已存在的 Runtime 线程绑定到隔离核(重启后需重做):
taskset -a -pc 1 $(pidof codesyscontrol.bin)
CODESYS 在下载和运行应用后可能创建或自行调整辅助线程。不要仅以启动时的 taskset -a 结果判断全部线程;应在应用 RUN 后确认关键任务:
P=$(pidof codesyscontrol.bin)
for t in /proc/$P/task/*; do
[ "$(cat "$t/comm")" = EtherCAT_Task ] || continue
taskset -pc "${t##*/}" # 期望 CPU1
chrt -p "${t##*/}" # 期望 SCHED_FIFO
done
第七步:EtherCAT 实时性优化与 STMMAC RX Watchdog
适用范围:RK3506G EVB1、kernel-6.1-rt、6.1.172-rt59、普通内建 STMMAC 驱动和 CODESYS IoDrvEtherCAT。本节不使用 IgH ec_stmmac,因为它会与 CODESYS 对 eth0 的占用冲突。
当前物理从站为 Panasonic MADHT1505BA1,Alias 4、Position 0、Vendor 0x0000066f、Product 0x515050a1。该从站已通过 IgH 检出 CoE/PDO/DC 并完成运动与 1 ms 测试。CODESYS 工程下载后仍须以实际 OP/DC/WKC、无 Sync Manager watchdog 和 Task Monitor 数据作为 CODESYS 路径的验收依据。
为什么关闭 RX Watchdog
STMMAC 的 Receive Interrupt Watchdog Timer(RIWT)是一种 RX 中断合并机制。普通网络中它通过延迟 RX 通知来减少中断;但 EtherCAT 每周期报文少,CODESYS 任务在周期内同步发送和处理 PDO,RX 通知延迟会直接增加 EtherCAT_Task 的 Cycle Time。
在独立 RT 树的 drivers/net/ethernet/stmicro/stmmac/stmmac_main.c 的 stmmac_hw_init() 中,在 RIWT 判断前加入:
priv->plat->riwt_off = 1;
加入后 priv->use_riwt 不会启用,启动日志不再出现:
Enable RX Mitigation via HW Watchdog Timer
这表示驱动不再用 RIWT 延迟 RX 通知,并非禁用 EtherCAT 或禁用 GMAC。
已观测效果与边界
在 RK3506 当前工程中,仅刷入该驱动补丁对应的 boot.img 后,CODESYS Monitor 的 EtherCAT Cycle Time 出现明显下降,现场观察接近减半。该现象说明原先 RIWT 的 RX 通知等待是当前同步 EtherCAT 路径的重要组成部分。
此结论仅在 RK3506G EVB1 上验证。补丁位于通用 stmmac_main.c,所以凡是使用该 RT 内核树构建的 STMMAC 平台都会关闭 RIWT;不要将其表述为 RK3568 已验证结论,也不要修改 RK3568 示例文件。
代价是 GMAC RX IRQ 和 NAPI 处理次数可能上升。当前测试中 GMAC/DWC2 IRQ 不在隔离 CPU1,CPU1 仅保留本地 arch_timer,因此对 EtherCAT_Task 的直接 IRQ 干扰较小。高流量网络场景仍要重新评估 CPU0/CPU2 负载和最坏 jitter。
验证方法
- 确认驱动日志不包含 RIWT 启用提示:
dmesg | grep -F "Enable RX Mitigation via HW Watchdog Timer"
补丁生效时该命令应无输出。
-
在 CODESYS 中确认 EtherCAT 从站稳定 OP、无 Sync Manager watchdog,再于
Task Configuration → EtherCAT_Task → Monitor连续观察至少 3 至 5 分钟。 -
记录并比较补丁前后的
Avg/Min/Max Cycle Time与Min/Max Jitter。比较必须使用同一工程、同一 1 ms 周期、同一 PDO/轴配置和相近运行负载。
最近一次 EtherCAT 链路与从站 OP 有效时,RK3506G EVB1 + CODESYS + MADHT1505BA1 本机空载测得 Avg Cycle Time = 154µs、Max Cycle Time = 382µs。该数据仅作为当前工程、当前 Runtime 和当前从站配置下的本机基线;当前若 eth0 为 NO-CARRIER 或从站非 OP,不能据此认定实时链路仍处于可测状态,也不与其他参考文档或不同测试环境的数据直接比较。
EtherCAT 实时性优化命令清单
以下命令针对当前 RK3506G EVB1:CPU1 是实时核,CPU0/CPU2 是系统和外设核。先确认 CODESYS 工程中的 EtherCAT Master 已绑定 1 ms EtherCAT_Task,再做运行时优化和测量。
1. 确认实时内核与 CPU1 隔离
uname -a
cat /sys/kernel/realtime # 期望 1
cat /proc/cmdline # 期望含 isolcpus=1 nohz_full=1
cat /sys/devices/system/cpu/isolated # 期望 1
cat /sys/devices/system/cpu/nohz_full # 期望 1
如果 isolated 或 nohz_full 不是 1,先修正 U-Boot bootargs 并重启;不要在未隔离 CPU 上测 1 ms EtherCAT 实时性。
2. 锁定 CPU 最高频率
以下操作会修改运行时 cpufreq policy,RK3506 的三个 CPU 共用 policy0;重启后需要重新设置:
P=/sys/devices/system/cpu/cpufreq/policy0
MAX=$(cat "$P/scaling_max_freq")
echo performance > "$P/scaling_governor"
echo "$MAX" > "$P/scaling_min_freq"
cat "$P/related_cpus" # 期望 0 1 2
cat "$P/scaling_governor" # 期望 performance
cat "$P/scaling_min_freq" # 期望与 max 相同
cat "$P/scaling_max_freq"
cat "$P/scaling_cur_freq"
当前已验证最高频为 1608000 kHz。仅使用 performance 不能保证严格锁频,仍要确认 scaling_min_freq 等于 scaling_max_freq。
3. 启动 Runtime 并绑定当前线程到 CPU1
cd /userdata/ARM_SL
nohup env LD_LIBRARY_PATH=/userdata/ARM_SL ./codesyscontrol.bin \
> codesyscontrol.stdout.log 2>&1 &
sleep 2
taskset -a -pc 1 $(pidof codesyscontrol.bin)
taskset -a 只处理执行命令时已存在的线程。应用下载并进入 RUN 后,必须检查关键任务,而不是假设所有 CODESYS 辅助线程都固定在 CPU1:
P=$(pidof codesyscontrol.bin)
for t in /proc/$P/task/*; do
name=$(cat "$t/comm")
case "$name" in
EtherCAT_Task|MainTask)
tid=${t##*/}
echo "== $name (TID $tid) =="
taskset -pc "$tid" # 期望 affinity list: 1
chrt -p "$tid" # 期望 SCHED_FIFO
;;
esac
done
当前板端复核:EtherCAT_Task 为 CPU1、SCHED_FIFO、优先级 56;MainTask 为 CPU1、SCHED_FIFO、优先级 55。优先级由 CODESYS Runtime 和任务配置管理;不要在不理解 Runtime 内部依赖的情况下对全部线程强行执行 chrt。
4. 检查并迁移外设 IRQ
先观察 CPU1 上的网卡和 USB IRQ,arch_timer 是 CPU 本地时钟中断,不能迁移:
grep -E "arch_timer|dwc2|stmmac|ethernet|usb" /proc/interrupts
GMAC 和 DWC2 的外设 IRQ 不应持续递增在 CPU1 列。确认具体 IRQ 号是外设 IRQ 后,才可以把它迁到 CPU0 和 CPU2(掩码 0x5):
# <irq> 必须替换为已确认的 GMAC 或 DWC2 外设 IRQ;不要对 arch_timer 执行此命令。
echo 5 > /proc/irq/<irq>/smp_affinity
cat /proc/irq/<irq>/smp_affinity_list # 期望仅包含 0 和/或 2
IRQ affinity 是运行时设置,重启后应重新复核。当前实测 GMAC/DWC2 IRQ 已避开 CPU1,CPU1 保留本地 arch_timer。
5. 验证 RIWT 补丁与实时调度保护
# 补丁生效时应无输出
dmesg | grep -F "Enable RX Mitigation via HW Watchdog Timer"
# 默认实时任务保护:每 1 秒最多允许 FIFO/RR 合计运行 950 ms
cat /proc/sys/kernel/sched_rt_period_us # 1000000
cat /proc/sys/kernel/sched_rt_runtime_us # 950000
dmesg | grep -Ei "RT thrott|sched.*thrott" || true
不要为了缩短 Cycle Time 关闭实时任务保护。当前 EtherCAT 任务占用远低于 95%,且启动日志没有 RT throttling 事件;它不是当前瓶颈。
6. 从 CODESYS Monitor 取数
完成第八步的 IDE 连接、下载并启动应用后,在从站稳定 OP、无 Sync Manager watchdog 的条件下,于 Task Configuration → EtherCAT_Task → Monitor 连续运行至少 3 至 5 分钟,记录:
Avg/Min/Max Cycle TimeMin/Max Jitter- EtherCAT 从站 OP/DC/WKC 状态
不要用 Linux /proc/<pid>/task/<tid>/stat 的累计 CPU 时间代替 CODESYS Monitor 的 Avg Cycle Time;两者测量口径不同。
第八步:CODESYS IDE 连接
- Windows 安装设备描述:解压
4.21.0.0.zip,工具 → 设备存储库 → 安装,选择codesyscontrol.devdesc.xml - 新建工程,设备选
CODESYS Control for Linux ARM SL - USB 连接板子后执行转发:
.\adb.exe forward tcp:11740 tcp:11740
设备 → 通信设置:网关保持本机localhost:1217,选中网关后在设备侧地址填127.0.0.1:11740,设为活动路径- ADB 转发不传 UDP 广播,
扫描网络永远扫不到,必须手动填地址。 - 目标设备要求登录时,使用当前测试台凭据:用户名
test,密码Rockchip@123。该凭据仅适用于当前测试板,不得用于量产设备或其他项目。 登录 → 下载 → 启动,设备变绿RUN即链路全通。
第九步:CODESYS 运动控制与 IgH 测试模块
CODESYS SoftMotion 持续速度测试
适用条件:EtherCAT Master 已绑定 1 ms EtherCAT_Task,Panasonic MADHT1505BA1 稳定 OP,急停、机械限位和低速空载条件已确认。以下程序使用当前工程的轴变量 SM_Drive_ETC_Panasonic_MINAS_A5B,放入 PROGRAM EtherCAT_Test。
PROGRAM EtherCAT_Test
VAR
fbPower : MC_Power;
fbMoveVelocity : MC_MoveVelocity;
fbStop : MC_Stop;
rtStart : R_TRIG;
tRun : TON;
uiStep : UINT := 0;
xStartTest : BOOL := FALSE; (* 在线写 TRUE:开始 *)
xAbort : BOOL := FALSE; (* 在线写 TRUE:提前停止 *)
fVelocity : LREAL := 0.5; (* u/s;360 u/圈时约 12 分钟/圈 *)
fAccel : LREAL := 2.0; (* u/s² *)
fDecel : LREAL := 2.0; (* u/s² *)
fJerk : LREAL := 1000.0; (* u/s³ *)
tTestTime : TIME := T#5M; (* 连续运行 5 分钟 *)
END_VAR
(* 启动上升沿 *)
rtStart(CLK := xStartTest);
(* 每个 EtherCAT_Task 周期都必须调用 *)
fbPower(
Axis := SM_Drive_ETC_Panasonic_MINAS_A5B,
Enable := (uiStep >= 20) AND (uiStep < 70),
bRegulatorOn := (uiStep >= 20) AND (uiStep < 70),
bDriveStart := (uiStep >= 20) AND (uiStep < 70)
);
fbMoveVelocity(
Axis := SM_Drive_ETC_Panasonic_MINAS_A5B,
Execute := (uiStep = 30),
Velocity := fVelocity,
Acceleration := fAccel,
Deceleration := fDecel,
Jerk := fJerk,
Direction := positive
);
fbStop(
Axis := SM_Drive_ETC_Panasonic_MINAS_A5B,
Execute := (uiStep = 60),
Deceleration := fDecel,
Jerk := fJerk
);
tRun(
IN := (uiStep = 40),
PT := tTestTime
);
(* 任意时刻在线写 xAbort := TRUE,执行受控停止 *)
IF xAbort AND (uiStep >= 20) AND (uiStep < 60) THEN
uiStep := 60;
END_IF
CASE uiStep OF
0: (* 等待启动 *)
IF rtStart.Q THEN
uiStep := 20;
END_IF
20: (* CiA-402 伺服使能 *)
IF fbPower.Status THEN
uiStep := 30;
ELSIF fbPower.Error THEN
uiStep := 70;
END_IF
30: (* 仅发出一次速度运动命令 *)
IF fbMoveVelocity.Active THEN
uiStep := 40;
ELSIF fbMoveVelocity.Error THEN
uiStep := 60;
END_IF
40: (* 持续低速转动,5 分钟后自动停止 *)
IF tRun.Q THEN
uiStep := 60;
ELSIF fbMoveVelocity.Error THEN
uiStep := 60;
END_IF
60: (* 受控减速停止 *)
IF fbStop.Done OR fbStop.Error THEN
uiStep := 70;
END_IF
70: (* 撤销使能 *)
IF NOT fbPower.Status THEN
xStartTest := FALSE;
xAbort := FALSE;
uiStep := 0;
END_IF
END_CASE
在线置 xStartTest := TRUE 后开始,置 xAbort := TRUE 可提前受控停止。运动过程中在 Task Configuration → EtherCAT_Task → Monitor 记录 Cycle Time 和 Jitter。fVelocity、加减速度和 jerk 必须按机械安全条件调整,首次不得提高默认低速值。
如何理解 CODESYS Task Cycle Time
CODESYS Monitor 中的 Cycle Time(此处称执行时间)是 EtherCAT_Task 一次被调度后,从任务开始到任务结束的总软件处理时间,不是单向 EtherCAT 发送时间,也不是纯 EtherCAT 报文往返时间。
该时间通常包含:PLC/ST 程序、MC_Power/MC_MoveVelocity/MC_Stop 等 SoftMotion 功能块、CiA-402 状态处理、PDO 过程数据更新,以及 IoDrvEtherCAT/EtherCATStack 在任务内完成的收发和接收处理。若驱动在本周期同步等待接收 PDO,等待部分也会计入 Cycle Time。
| 指标 | 含义 | 不可替代的测量 |
|---|---|---|
CODESYS Cycle Time | 控制任务本周期总执行时间 | 不代表单向发送或纯报文往返时间 |
CODESYS Jitter | 任务实际开始时刻相对 1 ms 理论释放时刻的偏差 | 不代表任务执行时间 |
| IgH latency/period | IgH 测试线程的唤醒延迟与周期偏差 | 不代表 CODESYS SoftMotion 任务时间 |
| EtherCAT 报文往返时间 | 报文发送至接收返回的链路/从站时间 | 用 DC 时间戳或示波器测量 |
例如,运动时 Monitor 的 429 us 表示每个 1 ms 周期中 CODESYS 完成 EtherCAT 与运动控制处理的平均时间;其中可能包含收发等待,但不能直接解释为 EtherCAT 报文往返 429 us。
RK3506 IgH 测试模块
IgH 测试和 CODESYS EtherCAT 是替代路径,不能同时使用 eth0。运行 IgH 前停止 CODESYS Runtime;恢复 CODESYS 前卸载 IgH ec_generic、ec_master 模块。
| 测试模块 | 源码路径 | 作用与边界 |
|---|---|---|
| 位置运动测试 | /home/user/SDK/rk3xxx/external/rk_ethercat_release/demo/rk3506_madht1505ba1_position_test.c | CPU1、1 kHz、PDO/DC、CiA-402 位置控制;验证 Alias 4、Position 0 的 MADHT1505BA1 可完成小位移、返回原点和帧丢失检查。会驱动电机,须确认机械安全。 |
| 无运动 jitter 测试 | /home/user/SDK/rk3xxx/external/rk_ethercat_release/demo/rk3506_madht1505ba1_jitter_test.c | CPU1、1 kHz;10 秒预热后采样 EtherCAT PDO/DC 周期。控制字、模式、位置、速度和转矩命令保持 0,不驱动伺服,用于测量 latency、period 和最大周期偏差。 |
两个 IgH 测试程序均针对 MADHT1505BA1 的 Alias 4、Position 0 编写,并要求主站模块与运行内核 6.1.172-rt59 的 vermagic 一致。IgH jitter 结果不能替代 CODESYS Monitor 的 Cycle Time;CODESYS 运动结果也不能替代 IgH 调度 latency。
常见坑速查
| 现象 | 原因与处理 |
|---|---|
| eth0 不存在,dmesg 无 stmmac | GMAC 驱动必须是内建(=y),rootfs 模块目录与 RT 内核不匹配 |
isolated 为空 | U-Boot 环境变量未写,进 CLI setenv + saveenv |
| IDE 扫描不到设备 | ADB 只转发 TCP,必须手动填 127.0.0.1:11740 |
| 登录报用户验证无效 | 核对 .UserDatabase.csv 中用户名;或改名移除该文件回出厂免登录 |
| 板子 OOM、ADB 掉线 | Runtime 双实例叠加,kill -9 全部后只启一个 |
| Runtime 跑一会就停 | demo 模式 2 小时到期,重启即可 |
cyclictest 报 /dev/cpu_dma_latency 缺失 | 不影响 RT 计时,属 rootfs 裁剪,可忽略 |
| 重启后关键任务不在 CPU1 | 绑定是运行时操作;应用 RUN 后重新检查 EtherCAT_Task 的 affinity 与 SCHED_FIFO |