5iMX宗旨:分享遥控模型兴趣爱好

5iMX.com 我爱模型 玩家论坛 ——专业遥控模型和无人机玩家论坛(玩模型就上我爱模型,创始于2003年)
查看: 59629|回复: 204
打印 上一主题 下一主题

高端无刷云台控制器——驱动器源代码放出!!!

  [复制链接]
跳转到指定楼层
楼主
发表于 2013-3-8 11:10 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
本帖最后由 yjjxf 于 2013-3-12 22:16 编辑

       所谓的高端无刷云台,是指能达到像素级稳定效果的,采用MAXON无刷电机、光电码盘、驱动器、控制器组合成的稳定云台。一直以来,某款云台被过分神话了,我们从技术的角度,来分析无刷云台的技术含量、成本,为大家DIY提供方向。

        如下:本方案实现的5D2无刷直驱云台效果,5D2含17~40mm内变焦镜头重1.6kg,含云台一共3.2kg。

[/media]

[/media]
                              
MAXON电机图

光电码盘图

        首先,为了达到很高的稳定效果,采取闭环方式控制是必要的,因此,需要有一个高精度、高采样率的3轴陀螺(不包含加速度计)。和飞行需要较大的行程不同,我们采用了ADXRS623,最大行程150/秒,每度每秒会产生12mV的电压,精度高。A/D方面,采用AD7606作为采样,16位的采样精度(相当于0.006/秒的角速度分辨率),一般来说,做好陀螺的带宽配置、低通滤波,然后每秒5000次左右的采样就足够用了。

        原理图如下:

        而每一个无刷电机的控制,需要一个高精度的码盘和高刷新率的驱动器。目前市面没有专门针对云台而设计的小巧、精干的驱动器,因此驱动器的设计,是云台电子部分的一个重要部分。

        目前结构小巧、精度较高的是CUIINC的码盘。码盘的结构如下:

        码盘在一圈的转动中,能产生2048个脉冲。而A\B脉冲根据先后顺序,又可以提高精度到8192。即每一圈360度,可分为8192个刻度,于是位置测量精度为360/8192=0.04度。

        码盘的作用,不仅仅在于后期对各个轴角度的测量,而在于对电机换相的精确控制。对于高稳定性云台,根据陀螺的角速度反馈,需要给电机施加指定的恒定力矩,因此恒力矩的控制非常关键。在无刷控制方式中,我们通常采用SVPWM(空间电压矢量调制)技术,根据码盘确定的位置,对电机施加对应正交的换相信号,以保持指定的恒定力矩。

        关于SVPWM的资料,百度上可以找到很多:
        以及dsPIC30F这个芯片的datasheet里,甚至有很详细的源代码。

        因此,驱动器的方案就确定下来了,使用CPLD(复杂可编程逻辑器件),对码盘的脉冲进行精确计数处理,与ARM7处理器STM32进行通讯,并且将STM32计算好的脉冲PWM,输出到自举和MOS管器件。同时,还有数据通信的总线,也可以由CPLD轻松完成。

        原理图如下:


        关于数据通信的总线,此处单独说一下。在3轴云台中,包含IMU一个,驱动器三个,以及控制器(一般由YS-X4的主控板来完成),一共五个部件。每个控制周期中,IMU要将3个陀螺的角速度、温度信息传送到控制器,每个驱动器也要将当前的码盘位置传送到控制器(用于各轴角度计算、投影),控制器也要将每个驱动器要达到的目标转动力矩发送到各个驱动器。而总线为了避免占用更多滑环,只能使用时钟、信号两根线。为了到达很高的传输速率(完成所有传输为一个周期,每秒至少5000次),采用FPGA自己搭建状态机而实现总线是最合适的方案,可以大大优化有效时钟。从目前来看,自己搭建专用总线的传输速率和传输效率,高于CAN总线等通用总线。

        最后,控制器由YS-X4主板即可完成(原理图、PCB即将提供下 载),用户在开源的EVA项目中,即可完成各个轴的投影、PID控制等实现。由于底层已经由FPGA和驱动器的CPLD完成了所有的基础工作,开发者只需要关注功能上的应用即可。




          最后成本大家自己算,MAXON电机1000出头点,码盘小一百块,电子电路部分taobao可以查。

        今天因为要出差,先简单写到这里。有空了继续深入剖析云台技术,欢迎交流!


       3月11日更新驱动器源程序代码,运行于STM32上,这个应该很多朋友都很懂了。如果有基础的朋友,再配合将来我们提供的FPGA或硬件板,应该能直接出产品了。

        近期还会放出机械部分源图:

      


无刷云台IMU原理图.pdf (78.93 KB, 下载次数: 27853)
无刷云台驱动器下板原理图.pdf (60.47 KB, 下载次数: 36009)
无刷云台驱动器上板原理图.pdf (63.24 KB, 下载次数: 15898)

云台驱动器代码.c (13.72 KB, 下载次数: 24809)










评分

参与人数 13威望 +25 模币 +2 收起 理由
mask2021 + 2 + 2 很给力!
task00 + 2 我感动得内牛满面。。
shanliren314 + 2 很给力!
jmcjq + 2 很给力!
crazyboyyy + 2 很给力!

查看全部评分

欢迎继续阅读楼主其他信息

沙发
发表于 2013-3-8 11:11 | 只看该作者

3
发表于 2013-3-8 11:13 | 只看该作者

4
发表于 2013-3-8 11:13 | 只看该作者
杨肿出品 必须顶!!!!!
5
发表于 2013-3-8 11:16 | 只看该作者

6
发表于 2013-3-8 11:16 | 只看该作者
感谢老杨,能把这些公布出来
7
发表于 2013-3-8 11:16 | 只看该作者
頂起,不錯不錯
8
发表于 2013-3-8 11:17 | 只看该作者
本帖最后由 浪味仙 于 2013-3-8 11:47 编辑

俏皮活。
9
发表于 2013-3-8 11:17 | 只看该作者
闻得一塌糊涂
10
发表于 2013-3-8 11:18 | 只看该作者

11
发表于 2013-3-8 11:18 | 只看该作者



无私奉献啊

12
发表于 2013-3-8 11:18 | 只看该作者
收藏,,看看。。
13
发表于 2013-3-8 11:18 | 只看该作者



支持,原理这些太复杂了点,要是有更高性能的成品就好咯,期待

14
发表于 2013-3-8 11:19 | 只看该作者

15
发表于 2013-3-8 11:20 | 只看该作者
春天是发芽的季节~~~!
16
发表于 2013-3-8 11:26 | 只看该作者
5khz采样率。。。。先说说传感器的响应速度是多少?
17
发表于 2013-3-8 11:26 | 只看该作者
虽然是大神  把大家唬得一愣一愣的  小弟还是不敢苟同啊
求解要是马达上没有码盘是不是就不能完成了   在次求解无码盘的时候能做到0.006的精度 有码盘的时候是0.04 那是有码盘相当于叠加 还是最低那个为标准呢?
再次求解 闭环控制 码盘还有必要么?
大神  跪求 解释
18
发表于 2013-3-8 11:27 | 只看该作者
太帅了,膜拜一下
19
发表于 2013-3-8 11:28 | 只看该作者
这云台必火呀
20
 楼主| 发表于 2013-3-8 11:30 | 只看该作者
缪飞虎 发表于 2013-3-8 11:26
虽然是大神  把大家唬得一愣一愣的  小弟还是不敢苟同啊
求解要是马达上没有码盘是不是就不能完成了   在次 ...

仔细看一下SVPWM的原理。

码盘的作用,是用来告诉你,什么时候该换相。为了到达恒定的力矩,就需要在不同的电机位置,施加不同的电压矢量。

如果没有码盘,你就做不到电机恒力矩转动,而是一卡一卡的,至少不精确。想要像素级的稳定效果,就达不到了。

您需要登录后才可以回帖 登录 | 我要加入

本版积分规则

关闭

【站内推荐】上一条 /1 下一条

快速回复 返回顶部 返回列表