专利名称：一种微型水下机器人矢量布置推进器推力分配装置的制作方法
技术领域：
本实用新型涉及一种水下机器人推进器控制技术，具体的说是微型水下机器人矢 量布置推进器推力分配装置。
背景技术：
微型水下机器自带能源，一次下水过程中不能进行能源的补给，所以如何高效的 利用有限的能源是水下机器人综合能力的重要指标。在消耗能源的部件中，推进器无疑是 最高的一个部件，推进器使微型ROV产生了前进的动力。目前，推进器的矢量布置被广泛采 用，这种布置方法可以以最少的推进器个数获得最多的自由度。科学合理的推进器推进分 别算法可以充分发挥失量布置充推进器的优势，不仅提高动力，而且节省能源。节约能源对 于自带电池工作的微型ROV来说十分关键，现有技术往往忽略了微型ROV推进器的节能因 素；微型ROV推进器功率小，额定电压低，若不注意对控制电压的滤波处理，很容易对推进 器造成损坏。
实用新型内容针对现有技术中存在的微型ROV推进器节能技术和推进器保护技术中存在的不 足之处，本实用新型要解决的技术问题是提供一种能够最大限度降低推进器带来的系统能 量损耗且对推进器进行过压保护的微型水下机器人矢量布置推进器推力分配装置为解决上述技术问题，本实用新型采用的技术方案是本实用新型微型水下机器人矢量布置推进器推力分配装置包括控制信号产生单 元、微控制器以及电压输出单元，其中控制信号产生单元产生电压控制信号，输出至微控 制器；微控制器对电压控制信号进行处理，生成实际的电压控制信号至电压输出单元；电 压输出单元将实际的电压控制信号施加到机器人矢量布置推进器上；微控制器及电压输出 单元均为PC104总线接口 ；电压输出单元的输出电压范围为-10伏 10伏。本实用新型具有以下有益效果及优点1.采用最小损耗推力分配算法最大限度的降低了推进器带来的系统能量损耗，经 过尖峰值去除方法去除了可能产生的对推进器造成损害的过大的电压或脉冲，保证了系统 安全运行，推力/电压转换方法可以将计算得到的推力转换为推进器能够接受和识别的模 拟电压值，保证控制效果的实现。ARM微控制器不仅处理速度快，还有效降低系统能耗，特备 适合微型ROV这一类自带能源的潜水器采用，Iinux系统有效的保证了系统实时性和控制 效果。PM51IPU通过ARM微控制器的控制能够产生和-10 IOV的控制电压。
图1为本实用新型采用的方法流程图；图2为本实用新型采用的方法中尖峰值去除方法流程图；图3为本实用新型采用的方法中推力/电压转换方法流程图；[0011]图4为本实用新型结构框图；图5为本实用新型实施例电气连接图。
具体实施方式
本实用新型基于ARM控制器、Iinux操作系统的微型ROV矢量布置推进器(推进 器个数3个)的推力分配装置。本实用新型如图4所示，包括控制信号产生单元、微控制器以及电压输出单元， 其中控制信号产生单元产生电压控制信号，输出至微控制器；微控制器对电压控制信号 进行处理，生成实际的电压控制信号至电压输出单元；电压输出单元将实际的电压控制信 号施加到机器人矢量布置推进器上。控制信号由信号产生装置产生，本例中为控制单杆，控 制单杆可以产生前进、侧移、潜浮三个方向的控制信号，信号以电压的形式产生。如图5所 示，ARM微控制器采用ATMEL公司生产的ARM9200E微控制器，该控制器的频率为200MHz，足 以满足实时性的要求。操作系统采用RedHatLinuX9.0。该操作系统是Iinux家族中的一 支，具有操作界面友好和驱动程序丰富的特点。将该系统移植到ARM9200E中并安装PC104 驱动。在ARM9200E的PC104接口上连接数据卡，这里为北京中泰研创的PM511PU。该数据 卡具有标准PC104接口，可以方便的插接到ARM9200E上，该卡具有模拟量输出功能，可以输 出模拟电压到推进器，控制其动作。在ARM微控制器中通过虚拟机安装Iinux操作系统，在操作系中安装PC104总线 驱动，以备扩展PC104总线数据处理卡使用。通过ARM微控制器的PC104总线扩展PC104 标准的数据处理卡，产生电压信号并连接至推进器产生推力。根据推进器个数形成推力分 配矩阵，并根据极值理论通过导数计算方法产生最小损耗的唯一推力分配矩阵。将该唯一 最小能耗推力分配矩阵的结果经过尖峰值去除方法的过滤，再通过推力/电压转换方法转 换成实际控制电压，最后将该电压输送给推进器，产生推力。如图1所示，本实用新型微型水下机器人矢量布置推进器推力分配装置采用的方 法包括以下步骤以矢量布置推进器推力分配能耗矩阵做为计算推力的依据；通过极值理论计算最小能耗的推力分配结果；通过推力/电压转换方法将计算得到的分配结果转化为实际控制电压；通过尖峰值去除方法去除不正常数据，得到正常范围内的推进器控制电压，避免 对控制器产生损坏。如图2所示，所述尖峰值去除方法包括以下步骤读取推力分配结果电压值；判断该电压值是否大于设定的上限；若推力分配结果电压值大于上限，将该电压值设为上限；判断是否小于下限；若推力分配结果电压值小于下限，将该电压值设为下限。输出经过上述处理的电压值。通过极值理论计算最小能耗的推力分配结果的方法如下3个推进器2个在水平方向上布置，1个在垂直方向上布置，首先确定根推进器布置角度，设为θ，两个水平方向布置的推进器与对称轴夹角均为θ，1个垂直方向的推进器 夹角为90度。因此获得推力分配矩阵如下Fx = cos θ XTl+cos θ XT2 ①Fy = sia θ XTl-sia θ ΧΤ2 ②FZ = Τ3③其中，Fx、Fy、FZ分别为微型ROV前进、侧移、潜浮三个自由度方向上的力，Tl、Τ2、 Τ3为三个推进器的推力。根据最优化控制理论构造目标函数E = Τ12+Τ22+Τ32④根据极值理论，在④中对Tl求导数，并令其为零，得到0 = 2Tl+2T2dT2/d Tl+2T2d T3/d Tl ⑤最后将⑤式和①、②、③合并便可得到唯一的最小推力分配矩阵⑥、⑦、⑧。T1 = k 1 X Fx+k2 X Fy ⑥T2 = klXFx-k2XFy ⑦T3 = FZ⑧其中kl = 1/cos θ，k2 = Ι/sia θ。推力/电压转换方法由运行于ARM微控制器内的程序执行，其流程图如图3所示读取推力分配结果中的推力值；该推力值减去推进器所能接受的实际电压值的下限，所得结果除以实际电压范 围，实际电压范围为实际电压最大值减去实际电压最小值；除以实际电压范围后结果再乘以推力值范围，推力值范围为推力值最大值减去推 力值最小值；乘以推力值范围后所得结果加上实际电压最小值做为最后输出的推进器控制电 压值。微型ROV的控制器多采用嵌入式控制器，ARM控制器处理速度快、能耗低、外设驱 动丰富，特别适合微型ROV的特点。在操作系统的选择上，目前广泛采用的有liniDuwince 等。Linux因其开放源代码的有点，大大降低了开发成本，又因其良好的实时性和稳定性，使 其优势更加明显。
权利要求1.一种微型水下机器人矢量布置推进器推力分配装置，其特征在于包括控制信号产 生单元、微控制器以及电压输出单元，其中控制信号产生单元产生电压控制信号，输出至微控制器；微控制器对电压控制信号进行处理，生成实际的电压控制信号至电压输出单元；电压输出单元将实际的电压控制信号施加到机器人矢量布置推进器上。
2.按权利要求1所述的微型水下机器人矢量布置推进器推力分配装置，其特征在于 微控制器及电压输出单元均为PC104总线接口。
3.按权利要求1所述的微型水下机器人矢量布置推进器推力分配装置，其特征在于 电压输出单元的输出电压范围为-10伏 10伏。
专利摘要本实用新型涉及一种微型水下机器人矢量布置推进器推力分配装置，方法为以矢量布置推进器推力分配能耗矩阵作为计算推力的依据；通过极值理论计算最小能耗的推力分配结果；通过尖峰值去除方法去除不正常数据，得到正常范围内的推进器控制电压；通过推力/电压转换方法将计算得到的分配结果转化为实际控制电压。装置包括控制信号产生单元、微控制器以及电压输出单元，控制信号产生单元产生电压控制信号，输出至微控制器；微控制器对电压控制信号进行处理，生成实际的电压控制信号至电压输出单元；电压输出单元将实际的电压控制信号施加到机器人矢量布置推进器上。本实用新型保证了系统安全运行，保证控制效果的实现有效降低系统能耗。
文档编号G05B19/04GK201926882SQ20102064279
公开日2011年8月10日 申请日期2010年12月4日 优先权日2010年12月4日
发明者何震, 孙凯, 李智刚, 秦宝成 申请人:中国科学院沈阳自动化研究所