姿态算出来了:屏幕上三个数,pitch、roll、yaw,手一动它跟着动,放回桌上它稳住。可它只是三个数知道现在歪成什么样,和真的转过去之间,还差一个身体。 给这个身体,就是云台要干的事
|
姿态算出来了:屏幕上三个数,pitch、roll、yaw,手一动它跟着动,放回桌上它稳住。可它只是三个数——知道“现在歪成什么样”,和“真的转过去”之间,还差一个身体。 给这个身体,就是云台要干的事。云台这个词听着专业,说白了只有一句话:让某个东西按照你要的角度转过去,并且停在那儿。 从姿态到一个会转的身体把这条链子上的环节摆出来,一共四步: 姿态 pitch / roll / yaw —— 我现在朝哪 目标角 我想让它朝哪 —— 由控制决定 执行器 真的转过那个角度 —— 电机 + 驱动器 + 机械 反馈 它到底转到位了没有 —— 传感器或内部机构 前面那几篇做的姿态估计,站在“姿态”这一格;云台这一段要做的,是后面三格。 这四格里最容易漏掉的是最后一格。 少了对“有没有转到位”的回答,前面三格都只是愿望:你让它转 30 度,它是不是真的到了 30 度、有没有被负载拽回去、会不会慢慢丢步,没人知道。 三种执行器,三种“回答方式”同类的问题,三种电机用三种不同的方式回答,这也是它们最本质的区别:
这张表解释了后面很多事情的由来:舵机最省事,因为它把反馈做在里面了;步进最“听话”,代价是它不会告诉你它丢了步;无刷最难用,但也最强——它本身不认“角度”,只认“该出多大力”。 关节稳住了,镜头不一定稳这是云台里最容易漏掉、也最容易做错的一点。举一个单轴的例子: 云台的关节相对车身保持在 30 度,车身向右转 10 度。关节的角度确实没变——舵机内部那个位置环一点没失效,它忠实地把“关节相对车身 30 度”守住了。可镜头相对外界,也跟着右转了 10 度。 因为舵机稳住的是关节相对车身的角度,不是镜头相对世界的朝向。这两件事在车身不动的时候是同一个数,车身一动就分家了。 所以要稳镜头,反馈量必须是镜头姿态。两条路:把 IMU 装在镜头上,直接读它的朝向;或者用“车身姿态 + 关节角度”算一个镜头姿态再回送。只用车身 IMU 去算一个反向补偿,那是在对底座运动做前馈——开环,残差、延迟、机械柔性都补不掉。 顺带纠正两个说法:
四层“转弯”:方向在哪一层翻的做云台几乎一定会踩方向问题,而且不止一个地方会翻。这条链子上有四层坐标系,每动一次结构,都可能翻一层:
每一层单独规定、单独验证,别指望“整体看起来对”。实践里最省事的做法是:每接一层,先做一个只动这一层的单轴测试——车只往前开,看串口打印的轮速符号;板子平放、往左倾、往前倾,看三个数变的是哪两个;镜头对准一个固定目标,用手把云台转过去,看画面往哪边走。一次只验一层,翻在哪层一目了然。 这四层对不上,表现出来是同一个症状:“它在往反方向补,越补越歪”。 分不清是哪一层翻的,就只能在整条链路上瞎试。 小车自己也是一种“身体”这条链子在前面出现过:小车用两个轮子的差速来转向的时候,走的就是同一个形状: 目标 我要往哪走、走多快 执行器 两个电机 + 驱动 反馈 编码器数出来的轮速 云台只是把同样的链子换了一副机械:轴变了、负载变了、“到位”的含义也从“走到那条线上”变成“指向那个方向”。 但苛刻程度不一样。小车在地面上走,位置差几厘米没人看得出来;云台要对准一个方向,误差直接体现在画面上。小车的负载是稳定的;云台的负载会反抗——风、重力、被线拽着的那点力。小车的目标基本不变;云台的目标可能每一拍都在跟着姿态动。 所以学云台不是从零开始学一门新技术,而是把同一条链子,接到一副更讲究的机械上,并且把最后一格“反馈”真正做扎实。 云台是按“轴”分的“云台”不是一种具体的产品,而是一类东西,按它能转几个方向来分:
一个轴就是“单轴云台”,两个轴就是“双轴云台”,三个都做就是“三轴云台”。航拍里说“三轴稳定”,说的就是这三个方向都单独做了补偿。 轴数要看任务。 只做上下俯仰的摄像头,单轴就够;要左右扫视又要上下看的,双轴最省事;要画面在任何晃动下都保持水平,才需要三轴。多一个轴,就多一套电机、多一个控制环、多一份重量和供电。 按用途分:稳定、跟踪、指向、扫描、随动除了按轴分,还有另一种分法更影响代码怎么写:按它要做成什么事来分。 先说统一的那一层:云台只做一件事——让镜头(或激光、天线)的指向跟着一条期望姿态轨迹走。这条轨迹可以是固定的常量,也可以随时间变;而底盘的运动是扰动,控制器要尽量让它别把镜头带偏。
表里的「世界」指绝对方向。这里有个前提得先说清楚:六轴 IMU 只用重力就能把俯仰和横滚锁在世界上,航向没有绝对参考,会漂——它锁住的是「相对启动那一刻」,不是「相对真北」。要真把航向也锁在世界系,得补一个航向参考:磁力计、视觉、双天线 GNSS,或者轮速差速。 表里最容易被当成「两种东西」的是前两行。它们不是二选一,而是同一个控制器的两种工况,还能同时出现:
所以别把「稳定」和「跟踪」当成两台不同的云台。真正的区别只有两条:参考轨迹是怎么产生的——是常量、是程序给的、还是外部每拍算出来的;以及扰动能不能测量或估计——底盘晃动可以用 IMU 测出来再补,风很难测,而目标每帧才估出来的话,那条轨迹本身就带着延迟和噪声。 考核上也各有侧重:看稳定,量的是扰动抑制和稳态误差;看跟踪,量的是跟踪误差和滞后。但两者都要稳、都要准。 所以动手之前要回答的不是「要它动还是不动」,而是三个问题:期望轨迹从哪来、相对谁固定、扰动测不测得到。 “稳定”不等于把三个角都归零这是新手最容易写错的地方。稳定云台要守住的是一个相对世界的常量姿态,这个常量不一定是零。 镜头本来就要俯 10 度看地面,稳定状态是“俯角一直保持在 10 度”,不是“俯角回到 0”。要是把目标直接设成 pitch = 0,表现就是镜头自己慢慢抬起来,或者一直跟你的手较劲。正确做法是启动那一刻把当前姿态记成基准,之后守的是这个基准,而不是 0。 两级环:内层抵扰动,外层给目标落到代码上,上面那三种工况常见的一种分法是串成两级环:内层增稳环抵掉外界晃动,外层跟踪环算出“目标角应该是多少”。两级的节拍不一样——内层要快,外层跟着目标的更新率走。这只是常见的一种分层,不是所有云台都必须这么搭;它讲的是云台这一级的环路,别和驱动器内部那套电流环、速度环、位置环混在一起。 要多稳、多准、多快,比“装的是什么”更决定选谁另一件事是负载的要求有多高,而不是负载“是什么”。同样是挂摄像头:只是让人大致看看方向,转过去就行,抖一点没关系;要拿它做视觉追踪、把快速移动的目标一直框在画面中间,抖动和延迟会直接让目标跑出画面——这种场合用的是闭环的无刷云台。挂激光或天线同理,指向偏一点,链路和精度就露出来了。所以用舵机还是用无刷,不由“装的是什么”决定,而由“要多稳、多准、多快”决定。 相对谁固定:参考系是一条链刚才那三个问题里,相对谁固定和扰动测不测得到是两件事:前者定的是期望姿态以谁为基准,后者说的是这个基准本身稳不稳、测不测得到。但它们落到电路上都要回答同一个问题——反馈量从哪来。而真实情况不是一个“谁”,而是一条链: 世界 ── 车体(IMU) ── 云台基座 ── 关节一(编码器) ── 关节二(编码器) ── 载荷(?) 每一段箭头都是一次坐标变换。这些变换要么被测量,要么被消除,两者必居其一:
闭环点选在哪,哪一段的误差才有可能被压住。 传感器装得越靠近负载,反馈就越接近负载的真实朝向,中间那些装配误差、齿轮间隙、支架柔性,至少能被闭环看见、再压掉一部分;只装在基座上,后面整条链的误差全都进不了反馈,只能靠前馈猜或者靠标定。这就是不少专业云台把 IMU 贴在负载附近、而不是只贴基座的原因——但它不是唯一做法,贴哪儿要看结构、控制带宽和成本,也要看传感器本身的安装误差和光轴标定做得怎么样。 载荷不同,“对准”的定义就不同同一个云台,上面装什么,决定你闭环的到底是哪个量:
所以代码里那个“姿态”,并不等于负载真正的指向——中间隔着一个测量轴和指向轴不共线的偏差。这个偏差算法消不掉,只能标定:让负载对准一个远处的已知点,把此刻的姿态读数记成零位,之后所有目标角都相对这个零位算。专业上叫 boresight(光轴对准)。 前面那节讲的四层坐标系,正是这条链上没有传感器的那几段最容易翻车的地方。 三种云台,差在哪舵机云台结构最简单的一种:一个(或两个)舵机,加上支架。 舵机是一个跨度很大的家族,从塑料齿轮的玩具级,到金属齿轮、大扭矩、带数字控制的那一档,价钱能差几十倍。装到云台和机械臂上的,用的是后一档,而且越来越多是总线舵机:一根线把所有关节串起来,用指令给角度,还能读回当前角度、设定速度和加速度。
步进云台用步进电机的那一种。它把“角度”变成了“数步子”:常见步距角 1.8 度,也就是一圈 200 步;驱动器再细分之后,一个整步被切成更小的微步。1.8 度配 16 细分,一个 STEP 就是 0.1125 度。
无刷云台航拍里见到的那种“镜头一动不动、机身怎么晃都稳”的云台,用的基本是无刷电机加专门的驱动器。
同一个执行器,买哪一档上面两节说的是电机和控制原理,但真正决定你要写多少代码的,是买什么。 舵机这边从“手里的玩具舵机”到“能读回角度的总线舵机”,中间隔着好几档:
再往上就是“舵机 + 控制器”的一体化关节(里面已经把减速箱、驱动器、编码器装在一起),机械臂上常见的那类东西。 同一台步进电机,市面上从“裸电机”到“一体化控制板”也有好几种买法,买法不同,你要写的代码差得很远:
无刷那边的买法同样分几档,而且这里有一个必须早点知道的区别——它给的是油门,还是角度:
这条路的关键判断是:要做云台,不要拿动力电调凑。 它省的是电调和电机之间那点匹配工作,却没给你“角度”这个入口——而云台要的恰恰是角度。 所以“控制复杂度”这一栏不是固定的:想学原理、想完全掌控、想省钱,就买裸的,自己发脉冲、自己写曲线;想快点把云台做起来、想少踩丢步和闭环的坑,就买带控制器或一体化的套件,把“定速、定加速度、定位”这些交给板子。 两种买法各有代价:自己写,可能要花几天调加减速,但出问题你知道该看哪一行;买套件,半小时能转起来,但它是黑盒,协议、上限和异常处理都要按说明书来。具体某个套件支持哪些模式、能设哪些参数,以它的上位机和说明书为准——这一条比背任何参数都重要。 三个执行器的“入口”,是我前面学过的哪个外设把这张表和前面学过的东西对上,会发现路是通的:
所以“会不会用云台”这件事,很大一部分是“会不会把已有的外设接到一个会动的机械上”。 定时器、GPIO、串口——这些前面的东西一个都少不了,多出来的是机械、负载和闭环。 目标角从哪里来链子里“目标角”那一格,是这一段的控制核心。三个来源,复杂度完全不同:
第三种就是闭环云台的核心:目标角不是定死的,而是每一拍重新算出来的。这里要分清两件事:期望姿态是外面给的——机身姿态加一个偏移,或者由目标位置反算出一个方向;误差是控制器拿期望姿态和当前姿态相减得到的。视觉伺服也可以直接拿图像上的偏差当控制量,那是另一种做法,不在这一条线上。这时候前面学的东西全都用上了——姿态估计给出“现在朝哪”,滤波决定这个反馈有多快、多稳,控制算法决定往哪边补多少。 顺带说一句判据:要不要闭环,看“错一点会怎样”。 只是让人看着调调方向,开环给个角度就行;要保证镜头一直指着某个目标,那误差会累积,就必须有反馈把它拉回来。 三种电机各自的行话买之前会碰到一堆词,先把最常出现的对上号: 舵机:扭矩(多少 kgf·cm,或换算成 N·m)、速度(转 60 度要多少秒)、塑料齿轮还是金属齿轮、模拟还是数字(数字的响应更快、也更费电)。往上还有总线舵机:串口或 CAN 一根线串多个关节,能读回当前角度、能设定速度与加速度,机械臂上常见。有个坑要提前知道:舵机一动就吃电流,几颗同时动很容易把电源拉低,单片机跟着复位——所以舵机的供电尽量不要和主板共用那一小段线,具体按模块说明接。 步进电机:两相四线、步距角、细分(驱动器把整步切成 1/8、1/16 这种更小的微步)、保持电流(停着不动也通电,所以会烫)。驱动器上通常有三根控制线:脉冲、方向、使能。要小心的还有共振区——某些速度下它自己就会抖,绕开或者加阻尼。 无刷电机:KV 值(每伏电压对应的转速)、电调(负责换相的那块东西)、有霍尔还是无感。这里最容易混的是两类用途完全不同的电机:动力电机高转速、小扭矩,配桨;云台电机低转速、大扭矩、外转子、绕线很多,就是为“慢慢转、带得动”设计的。同一个词在不同场景里指的是两种东西。 机械那几件事电气都能查手册,机械只能自己算。云台装上以后常见的四件事:
七个常见的想当然
先说明一点:下面把这三类叫三种常见实现方案,不是三种互斥的电机类别——同一个电机配上不同的驱动器,可能落在不同行里。 选型:七行对照
一句话的判据:只要小范围、少花钱、快点做出来,用舵机;要停得准、能整圈、愿意处理丢步和发热,用步进;要稳、要静、要带得动,才上无刷。 定下形式之后,再决定买裸电机还是带控制器的套件——这一步决定了你接下来是写时序,还是写指令。 任务决定形式把几个常见任务摆出来,答案基本就定了:
这张表不是标准答案,是起点:先把“要转多少、要多准、带多重、能不能接受抖”这四个问题回答清楚,形式自然会落到某一种上。 三种云台各自要碰的东西这一段的三种云台,技术上各自要碰的东西不一样,先摆清楚:
三条路的共同点只有一个:都要先回答“目标角度是多少、到位了没有”。 云台不是把电机装上就完事,它是一条从姿态出发、经过控制、落到机械上、再回到传感器的闭环。 最后橘猫说云台就是给姿态装一个身体:姿态、目标角、执行器、反馈,最容易漏的是最后一格——少了「到位了没有」,前面都只是愿望。分类看两件事:按轴分(俯仰、横滚、航向),按用途分要先问「相对谁固定」——增稳守一个常量、跟踪跟外部算出的时变值,两者能同时做,内环抵扰动、外环给目标角。三种执行器答「到位没有」的方式不同:舵机反馈做在里面,步进靠数脉冲、丢步会累积,无刷不认角度、只认连续量。选型一句话:小范围省钱求快用舵机,停得准能整圈用步进,要稳要静带得动才上无刷。 最后蜘蛛说“360度是360度的,但是怎么是一次性的啊” |
2022-05-14
2022-04-04
2021-11-29
2022-06-24
2021-11-25