【履历分享】CANOPEN协议驱动移植(基于CANfestival源码架构)
前言本次CANOPEN移植基于CANfestival开源代码，团体参考了如下文章：
基于STM32F4的CANOpen移植教程（超级具体）
谈谈本身对CANOPEN协议的驱动移植理解。每个移植CANOPEN协议的请务必认真阅读《周建功CANopen 轻松入门》，其中的内容生动形象，对你移植CANOPEN代码会有很大帮助。
CANopen的难点在于必要掌握的知识点比力多，如果没有移植过类似于Ethercat等协议，对新手来说并不算容易。如果移植过协议类驱动，那入手相对容易一些。
一、CANOPEN团体实现原理
带OS(操作体系)的团体实现原理
https://i-blog.csdnimg.cn/direct/dd5b748fdf9c46df98a49b704ebc8f82.png
不带OS的团体实现原理
https://i-blog.csdnimg.cn/direct/166e3457c6ef47d7948ac5ad8a8add10.png
不管是带OS照旧不带OS，都必要注意三个要点
1、CAN驱动收发实现
2、Timer定时器实现
3、Object Dictionary对象字典实现
这三点贯穿CANOPEN驱动调试整个过程，实现成功根本就不会有太大问题了，后续具体解说。
CANOPEN协议的报文格式和CAN的消息格式区别不大，唯一的区别在于COB-ID的区别，COB-ID由Funciton code（功能码）和NODE ID构成。
https://i-blog.csdnimg.cn/direct/53d378a786a8494d977b20fdc721e95f.png
这部分了解即可，比方0x580+NODE ID为SDO吸收，0x600+NODE ID为SDO发送。
https://i-blog.csdnimg.cn/direct/3089df7589ec4b899e77fc31d3b8b99f.png
由此引出三种模型
https://i-blog.csdnimg.cn/direct/f1e7ea4e260343c2a188054c5246c1a9.png
第一种是主从站模型，一主多从模型，网络管理基于此模型。
第二种是客户端/服务器模型，一般是主站作为客户端，从站作为服务器端，SDO传输基于此模型。
第三种是消费者/生产者模型，这在《周建功CANopen 轻松入门》中有很生动的解释，生产者数据发送之后，消费者只吸收不复兴，就像买菜一样，PDO运行基于此模型。
二、CANOPEN驱动收发
CANOPEN调用的接口
1、canSend(CAN_PORT notused, Message *m)
canSend是canfestival协议实现的关键底层接口函数，最终调用的是CAN的底层驱动发送接口。
检察Message结构体界说，如果原来就有CAN驱动发送接口，对接上即可，转换下并不难。
typedef struct {
UNS16 cob_id; /**< message's ID */
UNS8 rtr; /**< remote transmission request. (0 if not rtr message, 1 if rtr message) */
UNS8 len; /**< message's length (0 to 8) */
UNS8 data; /**< message's datas */
} Message;
如果原先没有CAN底层发送接口，那么建议先实现CAN收发，再来实现CANOPEN收发。AT91的实现如下
unsigned char canSend(CAN_PORT notused, Message *m)
/******************************************************************************
The driver send a CAN message passed from the CANopen stack
INPUT CAN_PORT is not used (only 1 avaiable)
Message *m pointer to message to send
OUTPUT 1 ifhardware -> CAN frame
******************************************************************************/
{
unsigned int mask;
AT91S_CAN_MB *mb_ptr = AT91C_BASE_CAN_MB0 + START_TX_MB;
if ((AT91F_CAN_GetStatus(AT91C_BASE_CAN) & TX_INT_MSK) == 0)
return 0; // No free MB for sending
for (mask = 1 << START_TX_MB;
(mask & TX_INT_MSK) && !(AT91F_CAN_GetStatus(AT91C_BASE_CAN) & mask);
mask <<= 1, mb_ptr++) // Search the first free MB
{
}
AT91F_CAN_CfgMessageIDReg(mb_ptr, m->cob_id, 0); // Set cob id
// Mailbox Control Register, set remote transmission request and data lenght code
AT91F_CAN_CfgMessageCtrlReg(mb_ptr, m->rtr ? AT91C_CAN_MRTR : 0 | (m->len << 16));
AT91F_CAN_CfgMessageDataLow(mb_ptr, *(UNS32*)(&m->data));// Mailbox Data Low Reg
AT91F_CAN_CfgMessageDataHigh(mb_ptr, *(UNS32*)(&m->data));// Mailbox Data High Reg
// Start sending by writing the MB configuration register to transmit
AT91F_CAN_InitTransferRequest(AT91C_BASE_CAN, mask);
return 1; // successful
}
2、canReceive(Message *m)
CANOPEN发送接口一般在CAN停止中实现，重要用来实现当收到CANOPEN消息后，进行CANOPEN的协议剖析，协议剖析的接口为canDispatch函数。
unsigned char canReceive(Message *m)
/******************************************************************************
The driver passes a received CAN message to the stack
INPUT Message *m pointer to received CAN message
OUTPUT 1 if a message received
******************************************************************************/
{
unsigned int mask;
AT91S_CAN_MB *mb_ptr = AT91C_BASE_CAN_MB0;
if ((AT91F_CAN_GetStatus(AT91C_BASE_CAN) & RX_INT_MSK) == 0)
return 0; // Nothing received
for (mask = 1;
(mask & RX_INT_MSK) && !(AT91F_CAN_GetStatus(AT91C_BASE_CAN) & mask);
mask <<= 1, mb_ptr++) // Search the first MB received
{
}
m->cob_id = AT91F_CAN_GetFamilyID(mb_ptr);
m->len = (AT91F_CAN_GetMessageStatus(mb_ptr) & AT91C_CAN_MDLC) >> 16;
m->rtr = (AT91F_CAN_GetMessageStatus(mb_ptr) & AT91C_CAN_MRTR) ? 1 : 0;
*(UNS32*)(&m->data) = AT91F_CAN_GetMessageDataLow(mb_ptr);
*(UNS32*)(&m->data) = AT91F_CAN_GetMessageDataHigh(mb_ptr);
// Enable Reception on Mailbox
AT91F_CAN_CfgMessageModeReg(mb_ptr, AT91C_CAN_MOT_RX | AT91C_CAN_PRIOR);
AT91F_CAN_InitTransferRequest(AT91C_BASE_CAN, mask);
return 1; // message received
}
3、can_irq_handler
can停止函数实现，当停止来临时判断，如果吸收到消息就进行canopen协议剖析。
void can_irq_handler(void)
/******************************************************************************
CAN Interrupt
******************************************************************************/
{
volatile unsigned int status;
static Message m = Message_Initializer; // contain a CAN message
status = AT91F_CAN_GetStatus(AT91C_BASE_CAN) & AT91F_CAN_GetInterruptMaskStatus(AT91C_BASE_CAN);
if(status & RX_INT_MSK)
{ // Rx Interrupt
if (canReceive(&m)) // a message received
canDispatch(&ObjDict_Data, &m); // process it
}
}
canDispatch原型如下：
void canDispatch(CO_Data* d, Message *m)
{
UNS16 cob_id = UNS16_LE(m->cob_id);
switch(cob_id >> 7)
{
case SYNC: /* can be a SYNC or a EMCY message */
if(cob_id == 0x080) /* SYNC */
{
if(d->CurrentCommunicationState.csSYNC)
proceedSYNC(d);
} else /* EMCY */
if(d->CurrentCommunicationState.csEmergency)
proceedEMCY(d,m);
break;
case TIME_STAMP:
case PDO1tx:
case PDO1rx:
case PDO2tx:
case PDO2rx:
case PDO3tx:
case PDO3rx:
case PDO4tx:
case PDO4rx:
if (d->CurrentCommunicationState.csPDO)
proceedPDO(d,m);
break;
case SDOtx:
case SDOrx:
if (d->CurrentCommunicationState.csSDO)
proceedSDO(d,m);
break;
case NODE_GUARD:
if (d->CurrentCommunicationState.csLifeGuard)
proceedNODE_GUARD(d,m);
break;
case NMT:
if (*(d->iam_a_slave))
{
proceedNMTstateChange(d,m);
}
break;
#ifdef CO_ENABLE_LSS
case LSS:
if (!d->CurrentCommunicationState.csLSS)break;
if ((*(d->iam_a_slave)) && cob_id==MLSS_ADRESS)
{
proceedLSS_Slave(d,m);
}
else if(!(*(d->iam_a_slave)) && cob_id==SLSS_ADRESS)
{
proceedLSS_Master(d,m);
}
break;
#endif
}
}
该函数对吸收到的信息首先进行COB-ID判断是什么类型，然后进行相应的报文处理。
各函数实现可以参考CANfestival中examples中的实现，带OS和不带OS的都有。
https://i-blog.csdnimg.cn/direct/54152a4dcbd348bbacc7529a48d54c86.png
三、Timer定时器
这是第二个重点，各驱动的实现各有差别，必要实现：
1、void initTimer(void) 初始化定时器
2、void setTimer(TIMEVAL value) 用于设置下一个定时器报警时间
3、TIMEVAL getElapsedTime(void) 该函数用于获取自前次调用以来所经过的时间。它通过复制运行中的计时器的值，然后计算当前计时器值与前次调用时计时器值之间的差别来实现。
4、void timer_can_irq_handler(void) 此函数处理定时器停止，定时时间到即处理，调用TimeDispatch函数更新栈中的时间信息。TimeDispatch函数原型如下：
void TimeDispatch(void)
{
TIMER_HANDLE i;
TIMEVAL next_wakeup = TIMEVAL_MAX; /* used to compute when should normaly occur next wakeup */
/* First run : change timer state depending on time */
/* Get time since timer signal */
UNS32 overrun = (UNS32)getElapsedTime();
TIMEVAL real_total_sleep_time = total_sleep_time + overrun;
s_timer_entry *row;
for(i=0, row = timers; i <= last_timer_raw; i++, row++)
{
if (row->state & TIMER_ARMED) /* if row is active */
{
if (row->val <= real_total_sleep_time) /* to be trigged */
{
if (!row->interval) /* if simply outdated */
{
row->state = TIMER_TRIG; /* ask for trig */
}
else /* or period have expired */
{
/* set val as interval, with 32 bit overrun correction, */
/* modulo for 64 bit not available on all platforms */
row->val = row->interval - (overrun % (UNS32)row->interval);
row->state = TIMER_TRIG_PERIOD; /* ask for trig, periodic */
/* Check if this new timer value is the soonest */
if(row->val < next_wakeup)
next_wakeup = row->val;
}
}
else
{
/* Each armed timer value in decremented. */
row->val -= real_total_sleep_time;
/* Check if this new timer value is the soonest */
if(row->val < next_wakeup)
next_wakeup = row->val;
}
}
}
/* Remember how much time we should sleep. */
total_sleep_time = next_wakeup;
/* Set timer to soonest occurence */
setTimer(next_wakeup);
/* Then trig them or not. */
for(i=0, row = timers; i<=last_timer_raw; i++, row++)
{
if (row->state & TIMER_TRIG)
{
row->state &= ~TIMER_TRIG; /* reset trig state (will be free if not periodic) */
if(row->callback)
(*row->callback)(row->d, row->id); /* trig ! */
}
}
}
该函数实现定时器调理功能：
计算自前次信号以来的时间偏移。
遍历全部定时器，根据是否已触发或周期到期更新状态和下次触发时间。
根据近来需触发的定时器设置体系就寝时间和现实定时器值。
再次遍历并调用已触发定时器的回调函数。可以参考
CANopen增补–时间计算出错
四、Object Dictionary对象字典
对象字典是毗连底层和应用层通讯的重要桥梁，没有对象字典就无法剖析SDO和PDO等报文。对象字典的天生依赖于如下python工具objdictedit，在canfestival源码里。
https://i-blog.csdnimg.cn/direct/3bd5ba7a0b6c4a4d92568201e1a3604b.png
根据sdo和pdo的要求进行配置，注意主站必要配置成client，从站配置成server。pdo配置，主站的tpdo和从站的rpdo cob-id要一致，主站的rpdo和从站的tpdo要一致，否则无法获取到数据。
https://i-blog.csdnimg.cn/direct/fc24151ea5bf4e6b9a47db01007dbff4.png
配置完成后点击建立词典即可天生Master.c和Master.h文件。
https://i-blog.csdnimg.cn/direct/2ab17ad6774f4aff95a8223dc58ac04c.png
必要注意，天生后的文件大概还必要进行二次修改，不肯定可以直接使用。Master.c最后一句是毗连主函数和对象字典的关键。以是肯定要匹配上。
main.c函数，引用对象字典Master_Data
https://i-blog.csdnimg.cn/direct/64d8b2bb58a14e9d88b4aebccd2b2ddf.png
Master.c函数Master_Data界说
https://i-blog.csdnimg.cn/direct/a02210f33984468781ca56d8d6b0d3fd.png
Co_Data这个结构体包含了对象字典剖析后的关键信息，在调试过程中也可以检察，好比是否存在越界，空指针等问题。具体的不再赘述，可以参考网上相关文章。
struct struct_CO_Data {
/* Object dictionary */
UNS8 *bDeviceNodeId;
const indextable *objdict;
s_PDO_status *PDO_status;
TIMER_HANDLE *RxPDO_EventTimers;
void (*RxPDO_EventTimers_Handler)(CO_Data*, UNS32);
const quick_index *firstIndex;
const quick_index *lastIndex;
const UNS16 *ObjdictSize;
const UNS8 *iam_a_slave;
valueRangeTest_t valueRangeTest;
/* SDO */
s_transfer transfers;
/* s_sdo_parameter *sdo_parameters; */
/* State machine */
e_nodeState nodeState;
s_state_communication CurrentCommunicationState;
initialisation_t initialisation;
preOperational_t preOperational;
operational_t operational;
stopped_t stopped;
void (*NMT_Slave_Node_Reset_Callback)(CO_Data*);
void (*NMT_Slave_Communications_Reset_Callback)(CO_Data*);
/* NMT-heartbeat */
UNS8 *ConsumerHeartbeatCount;
UNS32 *ConsumerHeartbeatEntries;
TIMER_HANDLE *ConsumerHeartBeatTimers;
UNS16 *ProducerHeartBeatTime;
TIMER_HANDLE ProducerHeartBeatTimer;
heartbeatError_t heartbeatError;
e_nodeState NMTable;
/* NMT-nodeguarding */
TIMER_HANDLE GuardTimeTimer;
TIMER_HANDLE LifeTimeTimer;
nodeguardError_t nodeguardError;
UNS16 *GuardTime;
UNS8 *LifeTimeFactor;
UNS8 nodeGuardStatus;
/* SYNC */
TIMER_HANDLE syncTimer;
UNS32 *COB_ID_Sync;
UNS32 *Sync_Cycle_Period;
/*UNS32 *Sync_window_length;;*/
post_sync_t post_sync;
post_TPDO_t post_TPDO;
post_SlaveBootup_t post_SlaveBootup;
post_SlaveStateChange_t post_SlaveStateChange;
/* General */
UNS8 toggle;
CAN_PORT canHandle;
scanIndexOD_t scanIndexOD;
storeODSubIndex_t storeODSubIndex;
/* DCF concise */
const indextable* dcf_odentry;
UNS8* dcf_cursor;
UNS32 dcf_entries_count;
UNS8 dcf_status;
UNS32 dcf_size;
UNS8* dcf_data;
/* EMCY */
e_errorState error_state;
UNS8 error_history_size;
UNS8* error_number;
UNS32* error_first_element;
UNS8* error_register;
UNS32* error_cobid;
s_errors error_data;
post_emcy_t post_emcy;
#ifdef CO_ENABLE_LSS
/* LSS */
lss_transfer_t lss_transfer;
lss_StoreConfiguration_t lss_StoreConfiguration;
#endif
};
五、CANOPEN应用层接口
上述移植完成后驱动大部分内容已经完成，接下来就是应用层调用什么接口进行主从站的通讯。在例子中可以看到，主站进入工作状态y以及设置NodeID，必要调用如下接口
1、setState设置状态
setState(&ObjDict_Data, Initialisation); // Init the state
setNodeId (&ObjDict_Data, 0x7F);
setState(&ObjDict_Data, Operational); // Put the master in operational mode
2、masterSendNMTstateChange设置从站状态
UNS8 masterSendNMTstateChange(CO_Data* d, UNS8 nodeId, UNS8 cs)
{
Message m;
MSG_WAR(0x3501, "Send_NMT cs : ", cs);
MSG_WAR(0x3502, " to node : ", nodeId);
/* message configuration */
m.cob_id = 0x0000; /*(NMT) << 7*/
m.rtr = NOT_A_REQUEST;
m.len = 2;
m.data = cs;
m.data = nodeId;
return canSend(d->canHandle,&m);
}
可以发现最终都是调用canSend进行底层报文发送出去。
3、masterSendNMTnodeguard用来设置从站节点保卫历程，设置成功后可以收到从站的心跳报文。
4、sendsdo用来发送服务数据对象sdo下令，直接调用即可。
5、过程数据对象发送pdo比力特殊，有好几种通讯方式。选择FEh大概FFh后，再设置Event timer，tpdo就会自动发送。（注意：TPDO和RPDO是相对于自身来界说的,T发送，R吸收）。
https://i-blog.csdnimg.cn/direct/c86c8803431f4b22aaacf4d041fa73dd.png
6、写字典和读字典setODentry和getODentry，可以用来改变对象字典中的参数，Pdo过程中的数据通报等，注意各输入参数的界说。
六、CANOPEN 驱动移植履历
1、timer定时器调试过程中必要注意时间溢出问题，避免出现定时不准，如果不重新开定时器也可以用体系时钟。把timer到场监控内容，调试过程中必要注意是否制止。
2、canfestival默认是开启串口Log的，可以借助串口工具进行开发。
https://i-blog.csdnimg.cn/direct/d844e5f0752b4e56ae6db659bcab39b9.png
研发阶段结束后必要关闭，避免打印的延时。
#define DEBUG_WAR_CONSOLE_ON
#define DEBUG_ERR_CONSOLE_ON
3、借助支持canopen协议的工具可以直接看到传输的协议内容，对于调试有很大帮助，建议备一个，如果着实没有就接串口。
https://i-blog.csdnimg.cn/direct/541fbecbfaf14f1a82534bab95f75c60.png
4、有些canfestival源码大概存在bug，根据现实情况依然必要检察源码进行修改，不要觉得源码必然靠谱。
5、canSend转换到can底层传输肯定要注意RTR，数据帧用的比力多，但是肯定不能省。
6、想到再增补。
总结
CANOPEN协议移植重要调试时间花在timer定时器、can发送和停止实现和对象字典的实现上，其他接口都是同一通用的，只要知道调用哪个接口就可以实现。时间匆匆讲的不是很具体，有什么问题可以留言。
免责声明：如果侵犯了您的权益，请联系站长，我们会及时删除侵权内容，谢谢合作！更多信息从访问主页：qidao123.com:ToB企服之家，中国第一个企服评测及商务社交产业平台。
页:
[1]