收发EtherCAT帧——ecx_inframe函数

2023-10-15 07:40

本文主要是介绍收发EtherCAT帧——ecx_inframe函数,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

ecx_inframe

非阻塞接收。

每个帧都存到对应index的buffer里。

若某帧之前已经存到buffer里,则该函数不调用ec_recvpkt,而是直接从buffer index恢复。

若请求的index不在buffer中,则该函数调用ec_recvpkt,来得到index对应的帧。

一共有3个选项

——1. 没有读帧,退出

——2. 读帧,但不对应于请求的index,存入buffer,退出

——3. 读帧,对应于index,存入buffer,在buffer status里设置complete flag,退出

入参1:port结构体

入参2:请求的帧的index

入参3:stack号,0代表primary,1代表secondary

出参:workcounter

int ecx_inframe(ecx_portt *port, int idx, int stacknumber)

先看

ec_bufT *rxbuf;
/** definition for frame buffers */
typedef uint8 ec_bufT[EC_BUFSIZE];//ec_bufT是uint8数组(元素个数为EC_BUFSIZE)/** standard frame buffer size in bytes */
#define EC_BUFSIZE         EC_MAXECATFRAME/** maximum EtherCAT frame length in bytes */
#define EC_MAXECATFRAME    1518

因此ec_bufT是uint8数组(元素个数为1518)

因此rxbuf是指向uint8数组(元素个数为1518) 的指针。

/** pointer structure to Tx and Rx stacks */
typedef struct
{/** socket connection used */int         *sock;/** tx buffer */ec_bufT     (*txbuf)[EC_MAXBUF];/** tx buffer lengths */int         (*txbuflength)[EC_MAXBUF];/** temporary receive buffer */ec_bufT     *tempbuf;         //tempbuf是指向uint8数组(元素个数1518)的指针/** rx buffers */ec_bufT   (*rxbuf)[EC_MAXBUF];//rxbuf是数组(元素个数16),数组里元素是指向ec_bufT的指针/** rx buffer status fields */int         (*rxbufstat)[EC_MAXBUF];/** received MAC source address (middle word) */int         (*rxsa)[EC_MAXBUF];
} ec_stackT;
ec_stackT *stack;

rxbuf是指针数组(元素个数16)。 

rxbuf = &(*stack->rxbuf)[idx];

如此看来rxbuf这个uint8数组的指针就定位到了idx序号的位置。

该函数首先判断请求接收的index是否已经放入到buffer中。idx首先需要是合法的,即需要小于16,至于为啥是这个数,以及这个数是啥意思我也不知道。猜测可能是该主站代码可以带动16个从站节点。其次需要这个idx对应的buffer的状态是Received, but not consumed。

  /* check if requested index is already in buffer ? */if ((idx < EC_MAXBUF) && ((*stack->rxbufstat)[idx] == EC_BUF_RCVD)){l = (*rxbuf)[0] + ((uint16)((*rxbuf)[1] & 0x0f) << 8);/* return WKC */rval = ((*rxbuf)[l] + ((uint16)(*rxbuf)[l + 1] << 8));/* mark as completed */(*stack->rxbufstat)[idx] = EC_BUF_COMPLETE;}
/** number of frame buffers per channel (tx, rx1 rx2) */
#define EC_MAXBUF          16
/** Possible buffer states */
typedef enum
{/** Empty */EC_BUF_EMPTY        = 0x00,/** Allocated, but not filled */EC_BUF_ALLOC        = 0x01,/** Transmitted */EC_BUF_TX           = 0x02,/** Received, but not consumed */EC_BUF_RCVD         = 0x03,/** Cycle completed */EC_BUF_COMPLETE     = 0x04
} ec_bufstate;

插一嘴,其实如何快速读C语言的声明,数据类型定义什么的,最好还是参考一下《征服C指针 【日】前桥和弥》P105~P142,该书整个第三章都可以参考。以后我会详细写一篇这方面的文章。

这个1518正好可以对应上EtherCAT报文的最大值1518

之后是计算workcounter,具体咋算的暂时没看懂

    l = (*rxbuf)[0] + ((uint16)((*rxbuf)[1] & 0x0f) << 8);/* return WKC */rval = ((*rxbuf)[l] + ((uint16)(*rxbuf)[l + 1] << 8));

然后将这个idx序号的buffer的状态更改为Cycle completed

    /* mark as completed */(*stack->rxbufstat)[idx] = EC_BUF_COMPLETE;

之后看else(idx大于等于16或者是idx序号对应的buffer的状态不是Received but not consumed)

调用ecx_recvpkt,非阻塞读buffer,帧可读的话ecx_recvpkt返回大于0的数,满足if条件,进入if

先将函数返回值设为EC_OTHERFRAME

/** return value unknown frame received */
#define EC_OTHERFRAME      -2

之后看

ehp =(ec_etherheadert*)(stack->tempbuf);

ehp是结构体指针,指向这个结构体

/** ethernet header definition */
PACKED_BEGIN
typedef struct PACKED
{/** destination MAC */uint16  da0,da1,da2;/** source MAC */uint16  sa0,sa1,sa2;/** ethernet type */uint16  etype;
} ec_etherheadert;
PACKED_END

先检查帧类型是否是EtherCAT帧,很简单只要看帧类型字段是否是0x88A4即可。

之后检查Datagram Header(其实看协议的帧结构,可以发现这里应该是EtherCAT header + Datagram Header)

/** EtherCAT datagram header definition */
PACKED_BEGIN
typedef struct PACKED
{/** length of EtherCAT datagram */uint16  elength;/** EtherCAT command, see ec_cmdtype */uint8   command;/** index, used in SOEM for Tx to Rx recombination */uint8   index;/** ADP */uint16  ADP;/** ADO */uint16  ADO;/** length of data portion in datagram */uint16  dlength;/** interrupt, currently unused */uint16  irpt;
} ec_comt;
PACKED_END

利用ecp这个结构体指针来访问Datagram Header里的各个元素,得到了EtherCAT datagram的长度和index序号。

接下来看刚刚得到的index序号和请求的index序号是否一致。

若一致将buffer去掉Ethernet Header后放入buffer,然后返回workcounter,然后将buffer的状态标记为Cycle completed,然后将源节点的MAC地址的中间那个字(中间的16位)记下来。

若不一致则继续看,判断是否这个idx号小于16且已经被发送给某个从节点了,如果不是的话就见鬼了(strange things happened),如果idx号小与16且已经发给某个从节点,将buffer去掉Ethernet Header后放入buffer,然后标记buffer的状态为Received, but not consumed,将源节点的MAC地址的中间那个字(中间的16位)记下来。

 

最后的最后,返回Workcounter值。

 

 

 

这篇关于收发EtherCAT帧——ecx_inframe函数的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/216316

相关文章

hdu1171(母函数或多重背包)

题意:把物品分成两份,使得价值最接近 可以用背包,或者是母函数来解,母函数(1 + x^v+x^2v+.....+x^num*v)(1 + x^v+x^2v+.....+x^num*v)(1 + x^v+x^2v+.....+x^num*v) 其中指数为价值,每一项的数目为(该物品数+1)个 代码如下: #include<iostream>#include<algorithm>

C++操作符重载实例(独立函数)

C++操作符重载实例,我们把坐标值CVector的加法进行重载,计算c3=c1+c2时,也就是计算x3=x1+x2,y3=y1+y2,今天我们以独立函数的方式重载操作符+(加号),以下是C++代码: c1802.cpp源代码: D:\YcjWork\CppTour>vim c1802.cpp #include <iostream>using namespace std;/*** 以独立函数

函数式编程思想

我们经常会用到各种各样的编程思想,例如面向过程、面向对象。不过笔者在该博客简单介绍一下函数式编程思想. 如果对函数式编程思想进行概括,就是f(x) = na(x) , y=uf(x)…至于其他的编程思想,可能是y=a(x)+b(x)+c(x)…,也有可能是y=f(x)=f(x)/a + f(x)/b+f(x)/c… 面向过程的指令式编程 面向过程,简单理解就是y=a(x)+b(x)+c(x)

利用matlab bar函数绘制较为复杂的柱状图,并在图中进行适当标注

示例代码和结果如下:小疑问:如何自动选择合适的坐标位置对柱状图的数值大小进行标注?😂 clear; close all;x = 1:3;aa=[28.6321521955954 26.2453660695847 21.69102348512086.93747104431360 6.25442246899816 3.342835958564245.51365061796319 4.87

OpenCV结构分析与形状描述符(11)椭圆拟合函数fitEllipse()的使用

操作系统:ubuntu22.04 OpenCV版本:OpenCV4.9 IDE:Visual Studio Code 编程语言:C++11 算法描述 围绕一组2D点拟合一个椭圆。 该函数计算出一个椭圆,该椭圆在最小二乘意义上最好地拟合一组2D点。它返回一个内切椭圆的旋转矩形。使用了由[90]描述的第一个算法。开发者应该注意,由于数据点靠近包含的 Mat 元素的边界,返回的椭圆/旋转矩形数据

Unity3D 运动之Move函数和translate

CharacterController.Move 移动 function Move (motion : Vector3) : CollisionFlags Description描述 A more complex move function taking absolute movement deltas. 一个更加复杂的运动函数,每次都绝对运动。 Attempts to

✨机器学习笔记(二)—— 线性回归、代价函数、梯度下降

1️⃣线性回归(linear regression) f w , b ( x ) = w x + b f_{w,b}(x) = wx + b fw,b​(x)=wx+b 🎈A linear regression model predicting house prices: 如图是机器学习通过监督学习运用线性回归模型来预测房价的例子,当房屋大小为1250 f e e t 2 feet^

JavaSE(十三)——函数式编程(Lambda表达式、方法引用、Stream流)

函数式编程 函数式编程 是 Java 8 引入的一个重要特性,它允许开发者以函数作为一等公民(first-class citizens)的方式编程,即函数可以作为参数传递给其他函数,也可以作为返回值。 这极大地提高了代码的可读性、可维护性和复用性。函数式编程的核心概念包括高阶函数、Lambda 表达式、函数式接口、流(Streams)和 Optional 类等。 函数式编程的核心是Lambda

PHP APC缓存函数使用教程

APC,全称是Alternative PHP Cache,官方翻译叫”可选PHP缓存”。它为我们提供了缓存和优化PHP的中间代码的框架。 APC的缓存分两部分:系统缓存和用户数据缓存。(Linux APC扩展安装) 系统缓存 它是指APC把PHP文件源码的编译结果缓存起来,然后在每次调用时先对比时间标记。如果未过期,则使用缓存的中间代码运行。默认缓存 3600s(一小时)。但是这样仍会浪费大量C

PHP7扩展开发之函数方式使用lib库

前言 首先说下什么是lib库。lib库就是一个提供特定功能的一个文件。可以把它看成是PHP的一个文件,这个文件提供一些函数方法。只是这个lib库是用c或者c++写的。 使用lib库的场景。一些软件已经提供了lib库,我们就没必要再重复实现一次。如,原先的mysql扩展,就是使用mysql官方的lib库进行的封装。 在本文,我们将建立一个简单的lib库,并在扩展中进行封装调用。 代码 基础