Ethercat学习-电机调试问题总结

已于 2023-03-12 00:03:57 修改
阅读量3.9k 收藏 29
点赞数 8
分类专栏： Ethercat 文章标签： 学习 单片机 stm32
于 2023-03-10 21:41:44 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/g360250466/article/details/129453810
版权

文章目录


主站硬件：STM32F405+LAN8720A

主站软件：SOEM

问题1：初始化不进入OP状态

现象描述：主站初始化过程中，打印信息显示状态一直在safe-op，AL-state（寄存器0x134）中的值为0，ESC中的配置信息正常打印

排查过程：如果AL-state有报错，那么应该先根据报错来进行排查。这次AL-state没有报错，正常来讲，流程正确的话应该进入OP状态的。个人理解，从safe-op到op状态，需要两个条件：1、发送状态切换请求；2、发送有效过程数据。

首先排查发送状态切换请求是否成功：通过wck的值就可以看到了。

其次排查过程数据发送：通过wireshake抓包可以看到过程数据的包，包长度正常，逻辑地址正常，内容可以忽略，因为现在还没开始填充，内容全是0。数据包有了，发送的长度也符合我们PDO所映射数据的长度，但是为什么通信不成功呢？进一步排查，FMMU映射是否正确，抓取FMMU映射的数据包，如下图所示：

在这里插入图片描述

在这里插入图片描述

物理地址0x1100是我配置的SM2的地址；物理地址0x1400是我配置的SM3的地址。按照习惯来，一般我们SM0、SM1、SM2、SM3分别对应的是邮箱输出（写）、邮箱输入（读）、过程数据输出（写）、过程数据输入（读）；可是这里是SM2对应的FMMU配置的是读，SM3对应的配置是写。问题应该是出在了这里。

通过源码来分析原因：

首先我们在初始化配置的时候，会调用ecx_config_init，会默认初始化SMtype，为1，2，3，4（表示邮箱输出（写）、邮箱输入（读）、过程数据输出（写）、过程数据输入（读））

ecx_config_init()
    .....
          if (context->slavelist[slave].mbx_l>0)
         {   
            context->slavelist[slave].SMtype[0] = 1;
            context->slavelist[slave].SMtype[1] = 2;
            context->slavelist[slave].SMtype[2] = 3;
            context->slavelist[slave].SMtype[3] = 4;
            context->slavelist[slave].SM[0].StartAddr = htoes(context->slavelist[slave].mbx_wo);
            context->slavelist[slave].SM[0].SMlength = htoes(context->slavelist[slave].mbx_l);
            context->slavelist[slave].SM[0].SMflags = htoel(EC_DEFAULTMBXSM0);
            context->slavelist[slave].SM[1].StartAddr = htoes(context->slavelist[slave].mbx_ro);
            context->slavelist[slave].SM[1].SMlength = htoes(context->slavelist[slave].mbx_rl);
            context->slavelist[slave].SM[1].SMflags = htoel(EC_DEFAULTMBXSM1);
            context->slavelist[slave].mbx_proto = 
            ecx_readeeprom(context, slave, ECT_SII_MBXPROTO, EC_TIMEOUTEEP);
         } 
    .....

但是在IOmap的时候，会调用ecx_readPDOmapCA来读取电机程序里的对象字典0x1C00、0x1C12、0x1C13,注意是，是电机MCU中的对象字典，不是ESC的EEPROM中的。0x1C00保存的就是SMtype，程序会根据读取到的数据来修改我们初始化好的SMtype的值，接下来IOmap中会配置SM2、SM3、FMMU，在进行SM2和SM3配置的时候是根据EEPROM的数据信息来配置，在进行FMMU配置的时候会通过SMtype来判断SM的方向，然后根据方向来配置FMMU的方向。通过Twincat上位机，发现电机中0x1c00中的值是2，1，3，4；正好和习惯的配置相反，然而提供的ESC中的xml的配置却是和习惯的相同，这就造成了SM和FMMU配置的方向不正确。最终通过将程序改为如下解决了问题，烧录验证，可以跳转到OP状态。

/* 修改后的ecx_readPDOmapCA 函数 */
int ecx_readPDOmapCA(ecx_contextt *context, uint16 Slave, int *Osize, int *Isize)
{
   int wkc, rdl;
   int retVal = 0;
   uint8 nSM, iSM, tSM;
   int Tsize;
   uint8 SMt_bug_add;
   
   *Isize = 0;
   *Osize = 0;
   SMt_bug_add = 0;
   rdl = sizeof(ec_SMcommtypet); 
   context->SMcommtype->n = 0;
   /* read SyncManager Communication Type object count Complete Access*/
   wkc = ecx_SDOread(context, Slave, ECT_SDO_SMCOMMTYPE, 0x00, TRUE, &rdl, context->SMcommtype, EC_TIMEOUTRXM);
   /* positive result from slave ? */
   if ((wkc > 0) && (context->SMcommtype->n > 2))
   {
      /* make nSM equal to number of defined SM */
      nSM = context->SMcommtype->n - 1;
      /* limit to maximum number of SM defined, if true the slave can't be configured */
      if (nSM > EC_MAXSM)
      {
         nSM = EC_MAXSM;
         ecx_packeterror(context, Slave, 0, 0, 10); /* #SM larger than EC_MAXSM */         
      }
      /* iterate for every SM type defined */
      for (iSM = 2 ; iSM <= nSM ; iSM++)
      {
         /* 如果电机代码里1C00中的配置与电机SSC中的xml配置的不一样，以XML中为准 */
        if(context->slavelist[Slave].SMtype[iSM] != context->SMcommtype->SMtype[iSM])
            tSM = context->slavelist[Slave].SMtype[iSM];
//          tSM = context->SMcommtype->SMtype[iSM];

// start slave bug prevention code, remove if possible            
         if((iSM == 2) && (tSM == 2)) // SM2 has type 2 == mailbox out, this is a bug in the slave!
         {
            SMt_bug_add = 1; // try to correct, this works if the types are 0 1 2 3 and should be 1 2 3 4
         }
         if(tSM)
         {
            tSM += SMt_bug_add; // only add if SMt > 0
         }
// end slave bug prevention code
         
          /* 源代码中的话，屏蔽掉这句话 */
//         context->slavelist[Slave].SMtype[iSM] = tSM;
         /* check if SM is unused -> clear enable flag */
         if (tSM == 0)
         {
            context->slavelist[Slave].SM[iSM].SMflags =
               htoel( etohl(context->slavelist[Slave].SM[iSM].SMflags) & EC_SMENABLEMASK);
         }
         if ((tSM == 3) || (tSM == 4))
         {
            /* read the assign PDO */
            Tsize = ecx_readPDOassignCA(context, Slave, ECT_SDO_PDOASSIGN + iSM );
            /* if a mapping is found */
            if (Tsize)
            {
               context->slavelist[Slave].SM[iSM].SMlength = htoes((Tsize + 7) / 8);
               if (tSM == 3)
               {
                  /* we are doing outputs */
                  *Osize += Tsize;
               }
               else
               {
                  /* we are doing inputs */
                  *Isize += Tsize;
               }
            }   
         }   
      }
   }

   /* found some I/O bits ? */
   if ((*Isize > 0) || (*Osize > 0))
   {
      retVal = 1;
   }
   return retVal;
}

int ecx_readPDOmap(ecx_contextt *context, uint16 Slave, int *Osize, int *Isize)
{
   int wkc, rdl;

   

int retVal = 0;
   uint8 nSM, iSM, tSM;
   int Tsize;
   uint8 SMt_bug_add;
   
   *Isize = 0;
   *Osize = 0;
   SMt_bug_add = 0;
   rdl = sizeof(nSM); nSM = 0;
   /* read SyncManager Communication Type object count */

   wkc = ecx_SDOread(context, Slave, ECT_SDO_SMCOMMTYPE, 0x00, FALSE, &rdl, &nSM, EC_TIMEOUTRXM);

   /* positive result from slave ? */
   if ((wkc > 0) && (nSM > 2))
   {
      /* make nSM equal to number of defined SM */
      nSM--;
      /* limit to maximum number of SM defined, if true the slave can't be configured */
      if (nSM > EC_MAXSM)
         nSM = EC_MAXSM;
      /* iterate for every SM type defined */
      for (iSM = 2 ; iSM <= nSM ; iSM++)
      {
         rdl = sizeof(tSM); tSM = 0;
         /* read SyncManager Communication Type */
         wkc = ecx_SDOread(context, Slave, ECT_SDO_SMCOMMTYPE, iSM + 1, FALSE, &rdl, &tSM, EC_TIMEOUTRXM);
         if (wkc > 0)
         {
           /* 如果电机代码里1C00中的配置与电机SSC中的xml配置的不一样，以XML中为准 */
          if(context->slavelist[Slave].SMtype[iSM] != tSM)
            tSM = context->slavelist[Slave].SMtype[iSM];
// start slave bug prevention code, remove if possible            
            if((iSM == 2) && (tSM == 2)) // SM2 has type 2 == mailbox out, this is a bug in the slave!
            {   
               SMt_bug_add = 1; // try to correct, this works if the types are 0 1 2 3 and should be 1 2 3 4
            }
            if(tSM)
            {   
               tSM += SMt_bug_add; // only add if SMt > 0
            }
            if((iSM == 2) && (tSM == 0)) // SM2 has type 0, this is a bug in the slave!
            {   
               tSM = 3;
            }
            if((iSM == 3) && (tSM == 0)) // SM3 has type 0, this is a bug in the slave!
            {   
               tSM = 4;
            }
// end slave bug prevention code            
             /* 源代码中的话，屏蔽掉这句话 */
//            context->slavelist[Slave].SMtype[iSM] = tSM;
						
            /* check if SM is unused -> clear enable flag */
            if (tSM == 0)
            {
               context->slavelist[Slave].SM[iSM].SMflags = 
                  htoel( etohl(context->slavelist[Slave].SM[iSM].SMflags) & EC_SMENABLEMASK);
            }
            if ((tSM == 3) || (tSM == 4))
            {
               /* read the assign PDO */
               Tsize = ecx_readPDOassign(context, Slave, ECT_SDO_PDOASSIGN + iSM );
               /* if a mapping is found */
               if (Tsize)
               {
                  context->slavelist[Slave].SM[iSM].SMlength = htoes((Tsize + 7) / 8);
                  if (tSM == 3)
                  {  
                     /* we are doing outputs */
                     *Osize += Tsize;
                  }
                  else
                  {
                     /* we are doing inputs */
                     *Isize += Tsize;
                  }   
               }   
            }   
         }   
      }
   }

   /* found some I/O bits ? */
   if ((*Isize > 0) || (*Osize > 0))
   {
      retVal = 1;
   }
      
   return retVal;
}

除此之外，ecx_config_init函数中也做了一点改动，这里主要是将EEPROM中读取到的值给到SMtype，之前是用的默认的值

         /**************  ecx_config_init *************/
          /* SII SM section */
            nSM = ecx_siiSM(context, slave, context->eepSM);
            if (nSM>0)
            {   
               context->slavelist[slave].SM[0].StartAddr = htoes(context->eepSM->PhStart);
               context->slavelist[slave].SM[0].SMlength = htoes(context->eepSM->Plength);
               context->slavelist[slave].SM[0].SMflags = 
                  htoel((context->eepSM->Creg) + (context->eepSM->Activate << 16));
               
               /*****读取EEPROM内存中的SM类型 */
               context->slavelist[slave].SMtype[0] = context->eepSM->PDIctrl;
               /*************/

               SMc = 1;
               while ((SMc < EC_MAXSM) &&  ecx_siiSMnext(context, slave, context->eepSM, SMc))
               {
                  context->slavelist[slave].SM[SMc].StartAddr = htoes(context->eepSM->PhStart);
                  context->slavelist[slave].SM[SMc].SMlength = htoes(context->eepSM->Plength);
                  context->slavelist[slave].SM[SMc].SMflags = 
                     htoel((context->eepSM->Creg) + (context->eepSM->Activate << 16));
                  /*****读取EEPROM内存中的SM类型 */
                  context->slavelist[slave].SMtype[SMc] = context->eepSM->PDIctrl;
                  /*************/
                  SMc++;

               }   
            }
问题2：PDO通讯数据不对

测试与电机通讯，发现对象字典写不进去，例如工作模式6060、6040。仔细检查PDO配置的代码，代码没问题。链接TWinCAT，可以看到1600的部分的内容确实是我程序里写的内容。但是1C12中的内容却是1700。在主站初始化的时候去读取1C12中的数据来计算IOmap的输出数据长度。debug的时候看到读取到的1C12的数据也1600，映射长度也是程序里设置的长度。说明当时确实是将1600成功写入了1C12。但是现在TWinCAT中看到的是1700，说明数据后来又被改回来了 ，至于是SOEM改的还是电机自己改的，还不太清楚。尝试将程序里的1600也改为1700，问题解决。另外关于PDO的映射有时候映射的数据需要补位一个无意义的映射，目前还不清楚这个补位的原则和道理。

0的部分的内容确实是我程序里写的内容。但是1C12中的内容却是1700。在主站初始化的时候去读取1C12中的数据来计算IOmap的输出数据长度。debug的时候看到读取到的1C12的数据也1600，映射长度也是程序里设置的长度。说明当时确实是将1600成功写入了1C12。但是现在TWinCaT中看到的是1700，说明数据后来又被改回来了 ，至于是SOEM改的还是电机自己改的，还不太清楚。尝试将程序里的1600也改为1700，问题解决。另外关于PDO的映射有时候映射的数据需要补位一个无意义的映射，目前还不清楚这个补位的原则和道理。

最美的愿望一定最疯狂
关注
  • 8
    点赞
  • 踩
  • 29
    收藏
    觉得还不错? 一键收藏
  • 28
    评论
专栏目录
倍福PLC--EtherCAT伺服断网络之后一直无法OP,通过PLC程序方式让从站伺服进入OP状态。.
weixin_41883890的博客
04-28 247
倍福PLC–EtherCAT伺服断网络之后一直无法OP,通过PLC程序方式让从站伺服进入OP状态。
IgH EtherCAT master-ethercatpack.7z
10-16
自己调试Ethercat过程中碰到的问题及解决办法 1. libethercat\std 目录 编译Igh生成的ethecat库 2. libethercat\include Igh Master Ethercat库包含的头文件 3. scripts/ 自动生成从站信息的相关脚本文件，...
EtherCAT从站状态机分析：PREOP to SAFEOP过程
热门推荐
JavanChen的博客
11-15 1万+
///////////////////////////////////////////////////////////////////////////////////////// /** \return AL Status Code (see ecatslv.h ALSTATUSCODE_....) \brief This function is called in case o...
EtherCAT Diagnostics 诊断
最新发布
ZLY729439517的博客
04-05 1177
EtherCAT 通常具有“即扫即用”的特性，扫描网络、启动系统，所有组件就运行起来了。绝大多数情况下不需要设置任何参数。 但是在有些情况下会出现一些网络故障，具体是什么原因呢？掌握诊断的方法能够然我们快速的找到问题并解决问题。本文是从EtherCAT原理上开始讲起，刨析本质让你一目了然，帮助你快速掌握EtherCAT总线诊断的方方面面。
IgH详解九、EtherCAT PDO原理（1）
EtherCAT
05-07 7973
过程数据对象 (PDO) 过程数据对象（PDO）是EtherCAT 从站在每个周期内传输的过程数据，是应用程序期望循环更新或发送到从站的用户数据（比如每个周期下发伺服的位置）。因此，EtherCAT 主站在启动阶段对每个 EtherCAT 从站进行参数化，以定义要与该从站传输或从该从站传输的过程数据（以位/字节为单位的大小、源位置、传输类型） PDO的配置（PDO通过邮箱SDO配置，SDO如何下发数据见上一篇文章） 寄存0x1c12 RxPDO 0x1c13 TxPDO 下面以一次实际配置过程来
Ethernet & EtherCAT and EtherCAT State Transition
PI_sunyang的博客
08-14 2954
EtherCAT状态机 EtherCAT有如下几种状态，Init、PreOP、SafeOP、OP和bootstrap。EtherCAT状态机模块负责控制EtherCAT状态机在以上几种状态间跳转。EtherCAT主函数名称为ECAT_Main()，可以在定时器中断函数或程序主函数，周期性运行。该函数主要包含以下功能：1、读取中断标志寄存器ALEventReg的值，根据值来判断是什么触发的中断，中断
TwinCAT在init-＞pre op -＞safe op-＞op模式切换时的error caode说明
weixin_42915969的博客
04-01 5631
TwinCAT在模式切换时的error caode说明
在Qt中使用EtherCAT-SOEM的初始化中，状态机卡在PreOp-＞Save-Op过程中，出现State=0x12, Error=0x001e错误的解决办法
zeal_for_rov的博客
12-15 4465
1.在调试EtherCAT软件过程中，一直出现配置从站进不了Save_op状态，通过下函数检查从站状态： //使用的从站编号为1 只有1个从站 ec_slave[1].state = EC_STATE_SAFE_OP; ec_writestate(1); //设置到安全模式 ec_statecheck(1, EC_STATE_SAFE_OP, EC_TIMEOUTSTATE * 4); printf("Slave %d State=0x%2.2x StatusCode=0x%4
EtherCAT 同步模式
weixin_42118352的博客
07-25 6517
1.因为需要高同步精度，选取的时间都是精确时间戳2.sync同步报文是周期性从主时钟向从时钟以广播的形式发出3.时钟偏差延时的计算在从时钟中进行，所以需要把t1，t2，t3，t4四个时间戳信息都发往从时钟，所以需要follow_up报文和delay_resp报文的存在3.2IEEE1588verision2报文介绍。同步不准的第2个原因即使没有抖动（Jitter），受实际硬件传播延时的影响，最末端的从站接受数据帧的时间必然晚于第一个从站的接收到该数据帧时间。...
高创直线电机伺服调试手册
04-11
高创直线电机伺服调试手册
基于stm32构建EtherCAT主站，采用了开源的soem方案
12-05
基于stm32构建EtherCAT主站，将soem方案移植到了stm32上。基本功能测试正常，可以驱动一部分的伺服电机，但也存在一些bug。整体移植方式应该是正确的，具体移植方式将写于CSDN博客中。
用ethercat（igh）编辑的一个控制伺服电机的例子motor_control.zip
12-23
用ethercat（igh）编辑的一个控制伺服电机的例子，还不太成熟，还在调试中，可以在此基础上进行自己改进。
Ezi-SERVO-HS_Poobo
03-31
高分辨率编码器空心轴电机闭环步进系统高精度位置控制 高扭矩，低温 支持EtherCAT，Ethernet，CC-Link等总线 介绍了关于Ezi-SERVO-HS_Poobo的详细说明，提供电气连接的技术资料的下载。
EtherCAT状态机----Kithara RTS
Studying……
12-12 5511
本文摘自Kithara RTS官网对EtherCAT状态机的介绍 The EtherCAT state machine EtherCAT状态机 EtherCAT defines 5 different states BOOT, INIT, PREOP, SAFEOP and OP.These are identified by the Kithara constants KS_ECAT_ST
EtherCAT用TwinCAT 3跑DC报0x2C或者0x1A错误码
PI_sunyang的博客
12-21 3090
EtherCAT用TwinCAT 3跑DC报0x2C或者0x1A DC报错 ///////////////////////////////////////////////////////////////////////////////////////// /** \brief Checks communication and synchronisation variables and update AL status / AL status code if an error has occurr
EtherCAT IgH常用命令行使用记录
Rot_Tianers
05-07 1727
该命令显示主站和从站的信息，且其生成的PDO信息可以直接被应用层的ecrt_slave_config_pdos()函数调用。用来请求从站转换状态，可选参数有INIT、PREOP、BOOT、SAFEOP、OP。显示当前支持的命令行指令，当前总共提供了 28 个命令行指令。以文本信息输出总线上连接的所有从站设备连接拓扑图。显示当前主站和从站设备的连接状态和信息。显示当前从站设备的连接状态和信息。显示当前ighH主站的版本信息。
EtherCAT从站学习笔记
qq_34814786的博客
12-02 2223
EtherCAT从站学习笔记 0.写在最前 从上学期间开始接触EtherCAT协议，直到工作后，做的都是跟EtherCAT主站相关的工作，对于从站只知道大概的架构，其余的知之甚少，且一直对从站较为感兴趣，这段时间抽空周末时间研究了下从站，之前一些不懂的地方也搞懂了，写点文档粗略地记录下，不对的地方也请各路大神指正。 主要研究了AX58100+STM32的实现方式，稍微也看了下瑞萨RZT1平台的实现方式，资料下载地址如下： AX58100：AX58100 - 2/3端口EtherCAT从站控制芯片(ESC)
EtherCAT IGH 命令行介绍
u014077947的博客
10-24 4974
EtherCAT IGH 命令行介绍
ros下用ethercat控制电机
05-25
在ROS中使用EtherCAT控制电机需要遵循以下步骤： 1. 安装EtherCAT Master：在ROS中使用EtherCAT需要安装EtherCAT Master。可以使用EtherLab或SOEM等EtherCAT Master工具。在Ubuntu中可以使用以下命令进行安装： ``` sudo apt-get install ethercat sudo apt-get install etherlabmaster ``` 2. 配置EtherCAT硬件：将EtherCAT硬件连接到计算机上，并确保它被正确识别。可以使用以下命令来检查硬件是否被正确识别： ``` sudo ethercat slaves ``` 3. 编写ROS节点：使用ROS节点来控制电机。可以使用ROS中的Industrial Ethernet（IndE）软件包来实现控制。该软件包提供了一系列功能，如EtherCAT Master和ROS节点之间的通信，以及实时控制电机。 4. 编写电机控制程序：使用C++或Python编写电机控制程序。在程序中使用ROS节点和IndE软件包提供的功能来实现控制。 5. 调试和测试：在调试和测试过程中，可以使用ROS中的RViz或rqt工具来可视化控制结果，并检查是否正确实现了电机控制。 总的来说，使用EtherCAT控制电机需要一定的硬件和软件基础。在ROS中使用EtherCAT控制电机需要对ROS和EtherCAT有一定的了解。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 28
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值