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

已于 2023-03-12 00:03:57 修改
阅读量4k 收藏 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
    收藏
    觉得还不错? 一键收藏
  • 30
    评论
专栏目录
倍福PLC--EtherCAT伺服断网络之后一直无法OP,通过PLC程序方式让从站伺服进入OP状态。.
weixin_41883890的博客
04-28 346
倍福PLC–EtherCAT伺服断网络之后一直无法OP,通过PLC程序方式让从站伺服进入OP状态。
在Qt中使用EtherCAT-SOEM的初始化中，状态机卡在PreOp-＞Save-Op过程中，出现State=0x12, Error=0x001e错误的解决办法
zeal_for_rov的博客
12-15 4516
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
TwinCAT在init-＞pre op -＞safe op-＞op模式切换时的error caode说明
weixin_42915969的博客
04-01 5765
TwinCAT在模式切换时的error caode说明
EtherCAT IGH 驱动一个步进电机
u014077947的博客
10-22 4651
EtherCAT IGH 驱动一个步进电机。
Ethernet & EtherCAT and EtherCAT State Transition
PI_sunyang的博客
08-14 2979
EtherCAT状态机 EtherCAT有如下几种状态，Init、PreOP、SafeOP、OP和bootstrap。EtherCAT状态机模块负责控制EtherCAT状态机在以上几种状态间跳转。EtherCAT主函数名称为ECAT_Main()，可以在定时器中断函数或程序主函数，周期性运行。该函数主要包含以下功能：1、读取中断标志寄存器ALEventReg的值，根据值来判断是什么触发的中断，中断
EtherCAT 同步模式
weixin_42118352的博客
07-25 6621
1.因为需要高同步精度，选取的时间都是精确时间戳2.sync同步报文是周期性从主时钟向从时钟以广播的形式发出3.时钟偏差延时的计算在从时钟中进行，所以需要把t1，t2，t3，t4四个时间戳信息都发往从时钟，所以需要follow_up报文和delay_resp报文的存在3.2IEEE1588verision2报文介绍。同步不准的第2个原因即使没有抖动（Jitter），受实际硬件传播延时的影响，最末端的从站接受数据帧的时间必然晚于第一个从站的接收到该数据帧时间。...
EtherCAT IGH 命令行介绍
u014077947的博客
10-24 5117
EtherCAT IGH 命令行介绍
EtherCAT状态转换
tangtang_yue的博客
06-23 4525
原文地址：http://blog.csdn.net/huangxianxinalice/article/details/9896953 [cpp] view plain copy ////////////////////////////////////////////////////////////////////////////////////
IgH EtherCAT master-ethercatpack.7z
10-16
自己调试Ethercat过程中碰到的问题及解决办法 1. libethercat\std 目录 编译Igh生成的ethecat库 2. libethercat\include Igh Master Ethercat库包含的头文件 3. scripts/ 自动生成从站信息的相关脚本文件，...
高创直线电机伺服调试手册
04-11
高创直线电机伺服调试手册
基于stm32构建EtherCAT主站，采用了开源的soem方案
12-05
基于stm32构建EtherCAT主站，将soem方案移植到了stm32上。基本功能测试正常，可以驱动一部分的伺服电机，但也存在一些bug。整体移植方式应该是正确的，具体移植方式将写于CSDN博客中。
KRONES-伺服电机驱动控制.pdf
11-28
同步电机可以实现同步操作，具有较高的控制灵活性，但可能会有高涌入电流和加热问题。伺服电机，作为同步电机的一种，不仅可以同步运行，还能进行精确的位置控制，具备高动态性能。然而，它也存在发热严重、接线复杂...
EtherCat基恩士PLC与我司BDHDE通信控制
最新发布
06-20
首先，硬件系统包括基恩士的PLC、EtherCat模块、驱动器和电机，以及相应的软件如KV STUDIO Ver.10G用于编程和调试。确保所有设备已正确连接，如USB线、EtherCAT口和外部电源。 安装设备描述文件（ESI）是集成过程的...
IgH详解八、EtherCAT SDO原理
EtherCAT
04-27 8694
主站通过使用 SDO对对象字典进行读取/写入操作,完成对从站设备进行参数设置､状态监视等｡ 从站SDO的读写是非实时的，所以需要多次访问来确保数据操作的正确性。 如下图写入操作，主站把数据发送到从站，从站返回WC确保数据收到，经过几个周期后主站发起响应查询，看从站是否有正确的写入数据。 从从站读取数据主站同样需要发起多次访问，以确保数据正确读取 下面我们看下SDO是怎么封装到EtherCAT中的？ 邮箱协议 从站的SM0，SM1同步管理做为邮箱通信使用，当有邮箱数据时会.
IgH设置EtherCAT数据流程
chuhan0732的博客
01-22 1876
1. IgH设置EtherCAT数据流程 在启动IgH协议栈后，协议栈会自动的把EtherCAT从站初始化到PREOP模式，从PREOP状态迁移到SAFEOP状态，需要设置PDO、DC等数据。以山洋电机为例数据设置流程如图 1.1所示： 图 1.1 PREOP状态迁移流程 IgH应用实现流...
SOEM 源码解析 ecx_config_init
qq_25047389的博客
11-01 1139
寄存器 0x0800。寄存器 0x0120。寄存器 0x0007。
工控协议解读之EtherCAT协议硬核分析(转自知乎“智能制造之家“)
qq_43599327的博客
09-07 7732
EtherCAT协议
1.ethercat基本概念
weilan0818的博客
05-24 827
EtherCAT(以太网控制自动化技术)是一个开放框架，以以太网为基础的现场总线系统。是实时以太网的一种。实时以太网是常规以太网技术的延伸，以便满足工业控制领域的实时性数据通信要求。实时以太网有powerlink，profinet，sercosⅢ，ethercat等等。基于TCP/IP的实现:Modbus/TCP, Ethernet/IP基于以太网的实现:powerlink, profinet RT修改以太网的实现:EtherCAT, Sercos3, profinet IRT。
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有一定的了解。

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

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

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值