四足机器狗整机关节控制-CAN/FD总线架构及分析

写在最前面

四足机器狗的控制已经成熟到顶了,没什么好写的。为了系列文章的完整性还是简单写一下,主要重点做CAN总线性能瓶颈分析,以及升级到CANFD后如何进行优化设计。

更多机器人本体控制总线分析,请关注系列文章:

《具身神经-机器人运控通讯架构与实现系列》

典型的四足机器狗控制架构(MIT Cheetah)

开源的MIT Cheetah四足机器狗可以说现存主流机器狗方案的鼻祖

采用了4条CAN2.0总线,分别控制4条腿,每条腿3个关节电机(包括后续小米的铁蛋,都是同样的方案)。
图源:王崇卫 《MIT四足机器人MIT Cheetah的硬件框架》

电机控制需求

整机4条腿,每条腿3个关节,总共12个关节电机

电机控制频率1KHz

关节控制命令:8字节

关节状态上报:5字节

CAN2.0总线负载率计算

关节电机采用CAN2.0 1Mbps波特率,每条总线控制3个电机

|-------------|----------|----------|--------------|
| CAN数据长度 | 单帧耗时 | 帧/每秒 | 总线占用时间/S |
| 8字控制命令 | ~110us | 1000*3 | 330ms |
| 5字节电机回复 | ~85us | 1000*3 | 255ms |
| 合计 ||| ~585ms |

总线负载率:约58.5%

总线通讯帧率: 6000帧/秒

其他条件不变,如果电机回复状态也采用8字节,总线负载率约为 66%

为保证CAN总线实时性,减少竞争,负载率不能过高(一般控制在50%-80%)。MIT方案控制CAN总线负载率在60%左右,是比较合理的。

以上计算和分析也解释了为什么使用CAN2.0总线的机器狗,几乎都采用4组CAN总线,一条总线控制一条腿的3个电机。(再多确实CAN2.0总线带宽不够了)

基于CANFD优化控制方案

虽然采用4路CAN2.0总线控制12关节的方案在四足机器狗领域应用以及非常成熟。但随着机器狗功能性越来越多样化,背挂执行器和传感器的增加,使得4路CAN2.0总线还是力不从心。

1M/5M CANFD单路可控2条腿

如果通讯协议不变,仅升级CAN2.0 1Mbps波特率到CANFD 1M/5M波特率

单路CANFD总线可轻松控制2条腿,6个电机,下面计算负载率(为了考虑余量,电机回复也采用8字节)。

|-------------|----------|----------|--------------|
| CAN数据长度 | 单帧耗时 | 帧/每秒 | 总线占用时间/S |
| 8字控制命令 | ~50us | 1000*6 | 300ms |
| 8字节电机回复 | ~50us | 1000*6 | 300ms |
| 合计 ||| ~600ms |

总线负载约:60%

总线通讯帧率:1.2万帧/秒

可以看出升级到CANFD 1M/5M 波特率后,单路总线控制6电机也完全没有压力。

如果还是采用4条CANFD总线,剩余2条可以考虑接其他外挂的机械手等执行器,也可以考虑做控制冗余。

相关推荐
sxgzzn8 小时前
能源行业智能监测产品与技术架构解析
架构·数字孪生·无人机巡检
小邓吖9 小时前
自己做了一个工具网站
前端·分布式·后端·中间件·架构·golang
Java烘焙师10 小时前
架构师必备:灰度方案汇总
架构·数仓
王锋(oxwangfeng)12 小时前
企业出海网络架构与数据安全方案
网络·架构·自动驾驶
麦聪聊数据12 小时前
利用SQL2API模式重构微服务中的数据查询层
数据库·sql·低代码·微服务·架构
郝学胜-神的一滴13 小时前
Python List操作:+、+=、extend的深度解析
开发语言·数据结构·python·程序人生·架构·list
小北的AI科技分享14 小时前
GPU并行计算架构在AI与科学计算中的性能优势
架构··
九皇叔叔14 小时前
【03】微服务系列 之Nacos 注册中心(服务注册)
java·微服务·nacos·架构·注册中心·服务注册
国科安芯14 小时前
航空级PMSM驱动系统中MCU的故障诊断与容错控制策略研究
单片机·嵌入式硬件·安全·架构·制造·安全性测试
Prince-Peng15 小时前
技术架构系列 - 详解Redis
数据结构·数据库·redis·分布式·缓存·中间件·架构