大疆M3508、M2006电机的CAN总线知识与配置方法

sw


M3508与M2006

目录:

0x00需要额外的CAN收发器!!!
0x01硬件层面分析
-为什么需要CAN收发器
-120Ω的终端电阻呢?
0x02软件配置简析
-如何把通信频率设定为1MHz?
-CAN过滤器配置
-消息的接收与发送
0x03总结

前言:

两个月前的一篇文章:PID与三环控制发布以后,有不少朋友在微信上交流大疆M3508、M2006的使用问题,其中有一个方面值得单独拿出来聊一聊:CAN通信

对于很多朋友,包括我自己,使用大疆的M3508、M2006无刷直流电机和C610、C620电调是第一次接触到CAN通信。大疆的这几款产品原本设计的非常容易上手,应该几天就能熟练使用。但是由于C610、C620电调选用了CAN总线通信,给不少人带来了困扰。然而使用这几个电机并不需要把CAN通信了解得有多么深。

困扰往往来自:

CAN总线之前用得比较少

现有CAN通信资料少而且复杂

本文仅涉及必备知识,甚至尽量避开复杂的通信原理,力求浅显易懂。

0x00需要额外的CAN收发器!!!

这件事要放到前面去说,因为已经有几位朋友的经历指出了其必要性。

如果我们有一块STM32开发板,也有电调电机和电源。那么我们的STM32引脚与电调的CANH和CANL之间是不能直接相连的。

需要购买如下图所示的CAN收发器,作为两者连接的桥梁。一般我用的是TJA1050芯片的模块。


CAN收发器是使用电机的必备硬件条件,一定要先确定自己有这个东西。至于原因,咱们接下来说明。

0x01硬件层面分析为什么需要CAN收发器

通过分析硬件层面我们能知道为什么需要额外的CAN收发器。请看下图:


从图中我们能看出,STM32拥有的外设叫做:CAN控制器,它负责CAN通信的筛选、优先级、仲裁等问题。相当于咱们的邮局,帮忙盖个邮戳,分分类。通过复用GPIO以后,它延伸出两个引脚:CAN_RX和CAN_TX,类比串口我们知道一个负责收一个负责发。

实际上,这两个引脚上传输的数据已经是CAN报文了,该有的格式它都有,STM32的CAN回环模式就相当于直接把CAN_RX和CAN_TX相连,就可以收到自己发的消息。

问题是,CAN在设计的时候为了消除共模干扰,特地选用了差分信号(也叫差模信号)传输。咱们的C610、C620电调,接收发送的就是差分信号。这才是CAN收发器的作用:

把来自STM32的信号转换成差分信号让电调听得懂,把来自电调的差分信号转换成STM32听得懂的信号。

请注意:

连接CAN_RX和CAN_TX引脚与CAN收发器的引脚时,并不需要像串口一样交叉。直接将RX连接到标有RX的引脚,TX类似。

120Ω的终端电阻呢?

不知道朋友们有没有注意到C610、C620电调上都有一个开关,C620的在侧面,旁边写着CANRESISTOR,这也是CAN总线的设计要求。

根据咱们学的《电路理论》这门课,当信号波长小于电路尺寸的时候,我们就不能把电路当成集中电路来分析。对于can总线是一样的,由于电调采用1MHz的通信频率,为了防止一些不必要的干扰,我们需要在CAN总线的两端分别用120Ω电阻跨接起来。比如之前图中的两端可以认为是咱们的CAN收发器是一端,下面的电调是另一端。

对于只有一个电调的情况下,可以打开电调上的电阻,然后直接和CAN收发器连接,这样虽然少了一端的终端电阻,但实际上可以运行。如果同时控制两个及以上的电调,那就可以打开其中两个的终端电阻,构成总线的两端。当然也可以手动组成如下图的总线结构并且关闭电调上的终端电阻,图中还加入了电容进行滤波。


0x02软件配置简析

其实,看完硬件部分就已经可以正常使用电调电机了,因为大疆官方例程中已经把CAN通信配置好了,直接可以使用。

但是如果涉及非常多的设备同时控制,比如超过四个电机的情况下,或者还有其他的外设要通过CAN总线相连,简单了解软件配置也是很有好处。

而且,我发现很多朋友是在做RoboMaster比赛,全面的了解软硬件还是十分必要的,如果出现问题也有利于排查,不至于浪费大量时间。

接下来我们还是使用咱们的老朋友:大疆官方M2006例程、M3508例程来作为样本。主要探究以下问题:

通信频率如何设定为1MHz

CAN过滤器的配置

报文的接收与发送

两个文件:bsp_和

如何把通信频率设定为1MHz?

以下是文件中截取的代码(有删改):

CAN_HandleTypeDefhcan1;/*CAN1initfunction*/voidMX_CAN1_Init(void){=CAN1;=3;//分频系数设置为3=CAN_MODE_NORMAL;=CAN_SJW_1TQ;//=================请看这里=CAN_BS1_9TQ;=CAN_BS2_4TQ;//=====================这里//省略一些。。。。。HAL_CAN_Init(hcan1);}

注意,大疆的例程是为大疆的开发板所编写,其主控芯片是STM32F429,在这里F4与F1的时钟频率差别会影响到配置的具体参数。

咱们重点来看分频系数的确定以及标出的两行。

STM32F4一般来说主频率会配置到168MHz,经过4分频之后得到了42MHz的APB1时钟,CAN控制器正是从APB1上获取时钟。代码中=3;正是将42MHz的时钟进行3分频,得到了14MHz的时钟。这就是真正被使用的频率。接着我们看传输一个bit需要哪几部分:


所以,传输一位的时间可以看作T=(1+BS1+BS2)*tq,tq(timequantum)。所以在例程里就是1+9+4=14个tq。而tq刚好是CAN时钟频率14MHz的倒数,tq=(1/14MHz),T=14*tq,得T=(1/1MHz),同样f=1/T=1MHz。由此获得了我们需要的频率。

同理,如果是F1,APB1时钟一般是36MHz,那么我们设置分频系数为4,BS1=5,BS2=3,也能得到1MHz。

CAN过滤器配置

其实一般来说并不需要注意CAN过滤器得配置,因为官方例程也没怎么配置,大可直接套用。

过滤器是针对接收信息进行筛选得部件,因为CAN总线上得消息往往比较复杂,通过过滤器可以选出想要接受的消息。大致过程是过滤器会对所有收到的报文按照咱们设定的规则进行筛选,如果符合要求就会放入FIFO缓冲区保存下来。而这个规则就是报文的id信息。为了实现复杂的id筛选,引入了id寄存器和id掩码寄存器,其配合过程非常的。。精彩。有兴趣可以了解一下。

下面的代码摘自文件bsp_(有删改):

voidmy_can_filter_init_recv_all(CAN_HandleTypeDef*_hcan){CAN_FilterConfTypeDefCAN_FilterConfigStructure;staticCanTxMsgTypeDefTx1Message;staticCanRxMsgTypeDefRx1Message;CAN_=0;CAN_=CAN_FILTERMODE_IDMASK;CAN_=CAN_FILTERSCALE_32BIT;CAN_=0x0000;CAN_=0x0000;CAN_=0x0000;CAN_=0x0000;CAN_=CAN_FilterFIFO0;CAN_=14;CAN_=ENABLE;HAL_CAN_ConfigFilter(_hcan,CAN_FilterConfigStructure);}

这里我们发现不论是id还是掩码都是0,也就是接收总线上的所有报文。那么在多电机的情况下如何区分消息的发出者呢?

消息的接收与发送

我们先看看接收,以下选自bsp_(有删改):

voidHAL_CAN_RxCpltCallback(CAN_HandleTypeDef*_hcan){switch(_hcan-pRxMsg-StdId){caseCAN_2006Moto1_ID://0x201caseCAN_2006Moto2_ID://0x202caseCAN_2006Moto3_ID://0x203caseCAN_2006Moto4_ID://0x204{staticu8i;i=_hcan-pRxMsg-StdId-CAN_2006Moto1_ID;get_moto_measure(moto_chassis[i],_hcan);}break;}

这是CAN的接收中断回调函数,在来到这个函数之前,获得的报文已经被储存在pRxMsg指向的结构体当中。switch语句通过判别StdId来确定是不是电机发来的报文,并且判断是哪个电机。而这个StdId咱们并不陌生,它是前面所说的FilterId的一部分。

官方手册中提到在同一个CAN总线上,最多可以接入8个电调,通过电调的自动分配他们分别是地址0x201~0x208。

再看发送:

voidset_moto_current(CAN_HandleTypeDef*hcan,s16iq1,s16iq2,s16iq3,s16iq4){hcan-pTxMsg-StdId=0x200;hcan-pTxMsg-IDE=CAN_ID_STD;hcan-pTxMsg-RTR=CAN_RTR_DATA;hcan-pTxMsg-DLC=0x08;hcan-pTxMsg-Data[0]=(iq18);hcan-pTxMsg-Data[1]=iq1;hcan-pTxMsg-Data[2]=(iq28);hcan-pTxMsg-Data[3]=iq2;hcan-pTxMsg-Data[4]=iq38;hcan-pTxMsg-Data[5]=iq3;hcan-pTxMsg-Data[6]=iq48;hcan-pTxMsg-Data[7]=iq4;HAL_CAN_Transmit(hcan,100);}

按照手册,我们能看出,如果要给编号为0x201~0x204的电调发信息,要把发送中的StdId设置为0x200,若是要给0x205~0x208的四个电调发信息,则要设置为0x1FF。

后面依照手册填充数据然后发送,过程比较简单。

0x03总结

这里放上前一篇文章链接:PID和三环控制-以大疆M3508、M2006为例

更多嵌入式,电机控制相关文章请移步公众号,来找我聊聊天吧:


公众号

技术新人,水平有限,还请各位朋友多多指教。如果对文章有任何的疑问或者发现错误请一定指出!


欢迎转载,请注明作者与原文地址:

文章版权声明:除非注明,否则均为纵投光影网原创文章,转载或复制请以超链接形式并注明出处。

上一个 锐取信息:如何保养和清洗录播镜头

下一个 「图文+视频」C4D野教程:实景照片合成动画制作案例