CN105487449B - 一种用于四索牵引摄像机器人的专用运动控制器 - Google Patents

一种用于四索牵引摄像机器人的专用运动控制器 Download PDF

Info

Publication number
CN105487449B
CN105487449B CN201511029602.0A CN201511029602A CN105487449B CN 105487449 B CN105487449 B CN 105487449B CN 201511029602 A CN201511029602 A CN 201511029602A CN 105487449 B CN105487449 B CN 105487449B
Authority
CN
China
Prior art keywords
controller
ropes
motion controller
programmable
traction
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201511029602.0A
Other languages
English (en)
Other versions
CN105487449A (zh
Inventor
米建伟
黄集发
段学超
门喜明
方晓莉
范丽彬
王小龙
汪辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xidian University
Original Assignee
Xidian University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Xidian University filed Critical Xidian University
Priority to CN201511029602.0A priority Critical patent/CN105487449B/zh
Publication of CN105487449A publication Critical patent/CN105487449A/zh
Application granted granted Critical
Publication of CN105487449B publication Critical patent/CN105487449B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

本发明涉及一种用于四索牵引摄像机器人的专用运动控制器。其主要由基于Virtex II系列现场可编程逻辑门阵列的可编程片上系统及其外围电路构成。FPGA片内SOPC功能模块根据四索牵引摄像机器人运动控制要求进行定制，主要包括硬核微处理器PowerPC405、处理器局部总线PLB、片上外设总线OPB、PLB转OPB桥、SDRAM控制器、以太网媒介访问控制器、UART、GPIO及系统级高级配置环境，所述的片内功能模块之间均逻辑连接；外围电路主要由电源、时钟、SDRAM存储器、ACE控制器及CF卡、按键、LED、以太网物理层收发器LXT972A、RS232电平转换器MAX3232组成，所述的外围电路均与FPGA电连接。采用SOPC技术实现运动控制器优化了系统的硬件组成，同时增强了系统的柔性。

Description

一种用于四索牵引摄像机器人的专用运动控制器
技术领域
本发明涉及柔索牵引摄像机器人的控制系统技术领域，特别涉及一种成本低、系统可靠性高、控制精度高、运动协调性好、硬件组成结构紧凑的用于四索牵引摄像机器人的专用运动控制器。
背景技术
随着生活水平的提高，人们的业余生活越来越丰富，因此也对各类体育比赛或演唱会等娱乐活动给予了更多的关注。但是由于场地的限制以及安全方面等原因，并不是所有人都能亲临现场观看，为了给观众呈现更好的现场视频，需要一种能够灵活快速的对体育比赛或演唱会现场进行空中拍摄的设备。
柔索牵引摄像机器人出现以前，在进行直播体育比赛或演唱会进行空中拍摄时，传统的摄像技术往往需借助摇臂摄像机、曲臂升降车和直升飞机等设备实现，但是这些设备存在一定的缺点：摇臂摄像机和曲臂升降车摄像系统工作区域和拍摄角度都非常有限，运动速度慢且容易干扰观众视线；而采用直升飞机进行航拍又存在复杂的目标跟踪及位置定位等问题，并且震颤和噪音干扰大，影响现场观众观看，且成本高昂。因此传统的摄像技术不能很好的完成空中拍摄的任务。
柔索牵引摄像机器人的出现为空中拍摄提供了非常好的解决方案，柔索牵引摄像机器人的出现是电视转播技术史上的一次革命。柔索牵引摄像机器人是一种大跨度冗余驱动高速并联机构，可实现空中全景式拍摄，已在奥运会、世界杯、春节联欢晚会等场合得到了应用，具有广阔的应用前景。国外已有成熟的商用产品，比较有名的有美国的Skycam和德国的Spidercam。但是，目前国内对柔索牵引摄像机器人的理论研究还比较薄弱，缺乏相关理论和产品。
柔索牵引摄像机器人摄像技术的好坏与其运动控制器有着重要的关系。目前，在国内外公开的可用于并联机器人的运动控制器均存在以下弊端：价格昂贵；开放性弱、精度差，不能由用户自行修改控制算法，因此不易控制、协调性差。
发明内容
本发明针对上述现有技术的不足，提供了一种用于四索牵引摄像机器人的专用运动控制器，其针对三自由度冗余并联机器人的高效、专用的多轴运动控制器，采用四个伺服电机驱动卷盘收放柔索，其成本低、系统可靠性高、控制精度高、运动协调性好，能够出色地完成大场地的空中拍摄任务。
为解决现有技术中存在的问题，采用的具体技术方案是：
一种用于四索牵引摄像机器人的专用运动控制器，其包括片上可编程系统(SOPC)和设于所述片上可编程系统(SOPC)周围的外围电路。
所述片上可编程系统(SOPC)是基于Virtex II系列现场可编程逻辑门阵列(FPGA)的可编程片上系统，其包括硬核微处理器(PowerPC405)、处理器局部总线(PLB总线)、SDRAM控制器(SDRAM Control)、PLB转OPB桥(PLB2OPB bridge)、以太网媒介访问控制器(Ethernet MAC)、片上外设总线(OPB总线)、系统级高级配置环境(System AdvancedConfiguration Environment，System ACE)、通用可编程输入输出接口(GPIO)和通用异步收发器(UART)；所述处理器局部总线(PLB总线)与硬核微处理器(PowerPC405)相连，所述SDRAM控制器(SDRAM Control)、PLB转OPB桥(PLB2OPB bridge)、以太网媒介访问控制器(Ethernet MAC)均与处理器局部总线(PLB总线)相连，所述片上外设总线(OPB总线)与PLB转OPB桥(PLB2OPB bridge)相连，所述系统级高级配置环境(System ACE)、通用可编程输入输出接口(GPIO)和通用异步收发器(UART)均与片上外设总线(OPB总线)相连。
所述外围电路包括电源、时钟、SDRAM存储器、JTAG(联合测试行为组织)接口、System ACE控制器、CF(Compact Flash)卡、按键、LED、以太网物理层收发器LXT972A、RS232电平转换器MAX3232组成，所述电源、时钟均与现场可编程逻辑门阵列(FPGA)电连接，所述SDRAM存储器与SDRAM控制器(SDRAM Control)电连接，所述JTAG接口和CF卡均与SystemACE控制器连接，所述System ACE控制器与系统级高级配置环境(System ACE)电连接，所述按键和LED均与通用可编程输入输出接口(GPIO)电连接，所述以太网物理层收发器LXT972A与以太网媒介访问控制器(Ethernet MAC)电连接，所述RS232电平转换器MAX3232与通用异步收发器(UART)电连接。
优选的方案，所述现场可编程逻辑门阵列(FPGA)的芯片为可实现可编程片上系统(SOPC)的XC2VP30FF896芯片。片内功能模块均可根据应用需求进行定制。
进一步优选的方案，本发明一种用于四索牵引摄像机器人的专用运动控制器还外接有嵌入式PC，所述嵌入式PC与外围电路中的以太网物理层收发器LXT972A电连接。
更进一步优选的方案，本发明一种用于四索牵引摄像机器人的专用运动控制器还外接有HMI，所述HMI与外围电路中的RS232电平转换器MAX3232电连接，以实现人机交互。
再进一步优选的方案，所述HMI采用MT8050iE触摸液晶屏，其采用触摸方式输入，可快速开发变量图标、曲线显示、时间变量等图形人机界面。
所述片上可编程系统SOPC包括四索牵引三自由度并联摄像机器人的速度运动学方程解算单元，其用于实现从四索牵引三自由度并联机器人的末端执行器速度矢量到柔索索长变化速度矢量之间的变换。
本发明中，外围电路中的以太网物理层收发器LXT972A与现场可编程逻辑门阵列(FPGA)内部的以太网媒介访问控制器(Ethernet MAC)连接，构成以太网通信传输的硬件基础结构。Ethernet MAC的IP核实现以太网MAC(Media Access Controller)功能，MAC在OSI的通信模式中是处于链路层(Link Layer)中的，是链路层的底层，连接处理器局部总线，速率为10-100Mbps。Ethernet MAC的IP核是利用存在于芯片内部的FPGA逻辑资源组成实现的。本发明应用此IP核搭建好以太网通信的硬件基础，然后应用其内部的驱动函数和协议栈编写应用层协议。
通过采用以上技术方案，本发明一种用于四索牵引摄像机器人的专用运动控制器与现有技术对比，其技术效果在于：
1、本发明采用与传统多轴运动控制器不同的设计方法，采用嵌入式系统设计思想和SOPC技术，实现针对具体应用需求定制硬件模块和编写软件程序。采用这种方式，能有效的利用资源，保证系统的可靠性，具有良好的一致性和可扩展性。
2、本发明在运动控制器中集成了四索牵引三自由度并联机器人的运动学求解算法，能使专用运动控制器在各种场合通过简单命令实现对机构的控制并获取必要的数据，使用更方便。
3、本发明采用TCP/IP通信方式与嵌入式PC交互数据，有效提高了数据的吞吐率和可靠性。
4、本发明控制器成本低、控制精度高、运动协调性好，能够出色地完成大场地的空中拍摄任务。
附图说明
图1是本发明四索牵引摄像机器人总体系统架构。
图2是本发明一种用于四索牵引摄像机器人的专用运动控制器的原理框图。
图3是本发明一种用于四索牵引摄像机器人的专用运动控制器与嵌入式PC及伺服系统的连接关系图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了，下面结合具体实例并参照附图，对本发明进一步详细说明。应该理解，这些描述只是示例性的，而并非要限制本发明的范围。此外，在以下说明中，省略了对公知结构和技术的描述，以避免不必要地混淆本发明的概念。
下面结合附图和实施方式对本发明进一步说明：
四索牵引摄像机器人属于三自由度冗余并联机构，采用四个伺服电机驱动卷盘收放柔索实现，系统架构如图1所示。本发明通过四个电机的高精度控制并兼顾它们之间的运动协调，从而实现摄像云台的精密运动控制，因此，研究开发四索牵引并联机器人的专用运动控制器是非常必要的。本发明采用的系统采用四索牵引三自由度并联机构，其在空中拍摄方面有着优异的性能，以其独有的特点能很好地完成了这种大场地的空中拍摄任务。
如图2所示，一种用于四索牵引摄像机器人的专用运动控制器，其包括片上可编程系统(SOPC)和设于所述片上可编程系统(SOPC)周围的外围电路。
所述片上可编程系统(SOPC)是基于Virtex II系列(Virtex II系列FPGA是Xilinx第一代平台FPGA解决方案)现场可编程逻辑门阵列(FPGA)的可编程片上系统，所述现场可编程逻辑门阵列(FPGA)的芯片为可实现可编程片上系统(SOPC)的XC2VP30FF896芯片，芯片内功能模块均可根据应用需求进行定制。
所述片上可编程系统(SOPC)包括硬核微处理器(PowerPC405)、处理器局部总线(PLB总线)、SDRAM控制器(SDRAM Control)、PLB转OPB桥(PLB2OPB bridge)、以太网媒介访问控制器(Ethernet MAC)、片上外设总线(OPB总线)、系统级高级配置环境(System ACE)、通用可编程输入输出接口(GPIO)和通用异步收发器(UART)；所述处理器局部总线(PLB总线)与硬核微处理器(PowerPC405)相连，所述SDRAM控制器(SDRAM Control)、PLB转OPB桥(PLB2OPB bridge)、以太网媒介访问控制器(Ethernet MAC)均与处理器局部总线(PLB总线)相连，所述片上外设总线(OPB总线)与PLB转OPB桥(PLB2OPB bridge)相连，所述系统级高级配置环境(System ACE)、通用可编程输入输出接口(GPIO)和通用异步收发器(UART)均与片上外设总线(OPB总线)相连。
所述外围电路包括电源、时钟、SDRAM存储器、JTAG(联合测试行为组织)、接口System ACE控制器、CF(Compact Flash)卡、按键、LED、以太网物理层收发器LXT972A、RS232电平转换器MAX3232组成，所述电源、时钟均与现场可编程逻辑门阵列(FPGA)电连接，所述SDRAM存储器与SDRAM控制器(SDRAM Control)电连接，所述JTAG接口和CF卡均与SystemACE控制器连接，所述System ACE控制器与系统级高级配置环境(System ACE)电连接，所述按键和LED均与通用可编程输入输出接口(GPIO)电连接，所述以太网物理层收发器LXT972A与以太网媒介访问控制器(Ethernet MAC)电连接，所述RS232电平转换器MAX3232与通用异步收发器(UART)电连接。
本发明一种用于四索牵引摄像机器人的专用运动控制器还外接有嵌入式PC和HMI，所述嵌入式PC与外围电路中的以太网物理层收发器LXT972A电连接；所述HMI与外围电路中的RS232电平转换器MAX3232电连接，以实现人机交互，所述HMI采用MT8050iE触摸液晶屏，其采用触摸方式输入，可快速开发变量图标、曲线显示、时间变量等图形人机界面。
所述片上可编程系统SOPC包括四索牵引三自由度并联摄像机器人的速度运动学方程解算单元，其用于实现从四索牵引三自由度并联机器人的末端执行器速度矢量到柔索索长变化速度矢量之间的变换。
各电路的原理和功能设计如下：
现场可编程门阵列FPGA采用Xilinx公司的Virtex II系列XC2VP30FF896芯片，该芯片内部包含硬核PowerPC405处理器，可实现SOPC。其主要功能是定制系统硬件模块，并通过软件实现四索牵引三自由度并联摄像机器人的速度运动学方程解算，用于完成四索牵引三自由度并联机器人的末端执行器速度矢量到柔索索长变化速度矢量的变换。
外围电路中的以太网物理层收发器LXT972A与现场可编程逻辑门阵列(FPGA)内部的以太网媒介访问控制器(Ethernet MAC)连接，构成以太网通信传输的硬件基础结构。Ethernet MAC的IP核实现以太网MAC(Media Access Controller)功能，MAC在OSI的通信模式中是处于链路层(Link Layer)中的，是链路层的底层，连接处理器局部总线，速率为10-100Mbps。Ethernet MAC的IP核是利用存在于芯片内部的FPGA逻辑资源组成实现的。本发明应用此IP核搭建好以太网通信的硬件基础，然后应用其内部的驱动函数和协议栈编写应用层协议。
参见附图3，是本发明一种用于四索牵引摄像机器人的专用运动控制器与嵌入式PC及伺服系统的连接关系。
以上所述仅为本发明的实施例而已，并不用于限制本发明。本发明可以有各种合适的更改和变化。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (6)

1.一种用于四索牵引摄像机器人的专用运动控制器，其包括片上可编程系统和设于所述片上可编程系统周围的外围电路；其特征在于：
所述片上可编程系统是基于Virtex II系列现场可编程逻辑门阵列的可编程片上系统，其包括硬核微处理器、处理器局部总线、SDRAM控制器、PLB总线转OPB桥、以太网媒介访问控制器、片上外设总线、系统级高级配置环境、通用可编程输入输出接口和通用异步收发器；所述处理器局部总线与硬核微处理器相连，所述SDRAM控制器、PLB转OPB桥、以太网媒介访问控制器均与处理器局部总线相连，所述片上外设总线与PLB转OPB桥相连，所述系统级高级配置环境、通用可编程输入输出接口和通用异步收发器均与片上外设总线相连；
所述外围电路包括电源、时钟、SDRAM存储器、JTAG接口、System ACE控制器、CF卡、按键、LED、以太网物理层收发器LXT972A、RS232电平转换器MAX3232组成，所述电源、时钟均与现场可编程逻辑门阵列电连接，所述SDRAM存储器与SDRAM控制器电连接，所述JTAG接口和CF卡均与System ACE控制器连接，所述System ACE控制器与系统级高级配置环境电连接，所述按键和LED均与通用可编程输入输出接口电连接，所述以太网物理层收发器LXT972A与以太网媒介访问控制器电连接，所述RS232电平转换器MAX3232与通用异步收发器电连接。
2.根据权利要求1所述的一种用于四索牵引摄像机器人的专用运动控制器，其特征在于：所述现场可编程逻辑门阵列的芯片为可实现片上可编程系统的XC2VP30FF896芯片。
3.根据权利要求1所述的一种用于四索牵引摄像机器人的专用运动控制器，其特征在于：其外接嵌入式PC，所述嵌入式PC与所述外围电路中的以太网物理层收发器LXT972A电连接。
4.根据权利要求1所述的一种用于四索牵引摄像机器人的专用运动控制器，其特征在于：其还外接有HMI，所述HMI与外围电路中的RS232电平转换器MAX3232电连接,并可进行人机交互。
5.根据权利要求4所述的一种用于四索牵引摄像机器人的专用运动控制器，其特征在于：所述HMI采用MT8050iE触摸液晶屏，其采用触摸方式输入。
6.根据权利要求1所述的一种用于四索牵引摄像机器人的专用运动控制器，其特征在于：所述片上可编程系统包括四索牵引三自由度并联摄像机器人的速度运动学方程解算单元，其用于实现从四索牵引三自由度并联机器人的末端执行器速度矢量到柔索索长变化速度矢量之间的变换。
CN201511029602.0A 2015-12-31 2015-12-31 一种用于四索牵引摄像机器人的专用运动控制器 Active CN105487449B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201511029602.0A CN105487449B (zh) 2015-12-31 2015-12-31 一种用于四索牵引摄像机器人的专用运动控制器

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201511029602.0A CN105487449B (zh) 2015-12-31 2015-12-31 一种用于四索牵引摄像机器人的专用运动控制器

Publications (2)

Publication Number Publication Date
CN105487449A CN105487449A (zh) 2016-04-13
CN105487449B true CN105487449B (zh) 2018-01-23

Family

ID=55674496

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201511029602.0A Active CN105487449B (zh) 2015-12-31 2015-12-31 一种用于四索牵引摄像机器人的专用运动控制器

Country Status (1)

Country Link
CN (1) CN105487449B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107116532B (zh) * 2017-03-22 2024-01-19 广东电网有限责任公司电力科学研究院 一种子母构型的索并联机器人
CN107309866A (zh) * 2017-07-24 2017-11-03 华南农业大学 一种电缆并联驱动的深海网箱清洗机器人及清洗方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201479316U (zh) * 2009-09-03 2010-05-19 成都智畅信息科技发展有限公司 基于xupv2p平台的视频解码装置
CN103295235A (zh) * 2013-05-13 2013-09-11 西安电子科技大学 柔索牵引摄像机位置的监控方法
CN103293834A (zh) * 2013-05-13 2013-09-11 西安电子科技大学 柔索牵引摄像机传动限位装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN201479316U (zh) * 2009-09-03 2010-05-19 成都智畅信息科技发展有限公司 基于xupv2p平台的视频解码装置
CN103295235A (zh) * 2013-05-13 2013-09-11 西安电子科技大学 柔索牵引摄像机位置的监控方法
CN103293834A (zh) * 2013-05-13 2013-09-11 西安电子科技大学 柔索牵引摄像机传动限位装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
四索牵引摄像机控制系统的软硬件设计及实现;高黎;《四索牵引摄像机控制系统的软硬件设计及实现》;20131121;正文第7-16页 *
柔索牵引摄像机器人控制系统的设计与实现;王龙;《柔索牵引摄像机器人控制系统的设计与实现》;20150415;正文全文 *

Also Published As

Publication number Publication date
CN105487449A (zh) 2016-04-13

Similar Documents

Publication Publication Date Title
CN103862457B (zh) 一种带视觉系统的服务机器人
CN103324100B (zh) 一种信息驱动的情感车载机器人
CN201073550Y (zh) 一种具有丰富运动自由度的智能服务机器人
CN205516491U (zh) 智能交互儿童玩具
CN203133746U (zh) 基于体感交互的一体化虚拟景观游览装置
CN205037040U (zh) 360度全景采集机器人装置
CN106005086A (zh) 一种基于Xtion设备的腿轮复合机器人及其手势控制方法
CN104175308A (zh) 自主服务机器人
CN105487449B (zh) 一种用于四索牵引摄像机器人的专用运动控制器
CN204856222U (zh) 一种基于物联网技术的全向移动平台控制系统
CN205968983U (zh) 一种智能机器人及其控制系统
CN107168182A (zh) 一种室内机器人vr应用的系统及方法
CN109814468A (zh) 一种基于stm32l4芯片的物联网开发板
CN108858176A (zh) 一种智能机器狗
CN102647511B (zh) 基于智能手机的三维博物馆交互系统及其交互方法
CN202490446U (zh) 一种结合智能终端的玩具
CN207968682U (zh) 基于fpga的红外图像处理系统
CN203984550U (zh) 一种3d照相机的控制电路
CN205969039U (zh) 一种智能机器人及其控制系统
CN203037261U (zh) 一种小型陀螺仪稳像系统
CN204209679U (zh) 自主服务机器人
CN104052929A (zh) 可自动拍摄的运动球和拍摄系统
CN204721414U (zh) 移动通信终端
CN206653396U (zh) 一种具有图像识别功能的早教机器人
CN205799523U (zh) 一种家居监控机器人

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant