CN2614864Y - 基于多dsp并行处理的自主移动机器人平台 - Google Patents
基于多dsp并行处理的自主移动机器人平台 Download PDFInfo
- Publication number
- CN2614864Y CN2614864Y CN 02295455 CN02295455U CN2614864Y CN 2614864 Y CN2614864 Y CN 2614864Y CN 02295455 CN02295455 CN 02295455 CN 02295455 U CN02295455 U CN 02295455U CN 2614864 Y CN2614864 Y CN 2614864Y
- Authority
- CN
- China
- Prior art keywords
- dsp
- robot
- mobile robot
- control
- bus
- 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.)
- Expired - Lifetime
Links
- 238000012545 processing Methods 0.000 title claims abstract description 16
- 230000007246 mechanism Effects 0.000 claims description 8
- 230000004888 barrier function Effects 0.000 claims description 6
- NBIIXXVUZAFLBC-UHFFFAOYSA-N Phosphoric acid Chemical compound OP(O)(O)=O NBIIXXVUZAFLBC-UHFFFAOYSA-N 0.000 claims description 4
- 238000004891 communication Methods 0.000 abstract description 10
- 238000004519 manufacturing process Methods 0.000 abstract description 2
- 238000012797 qualification Methods 0.000 abstract 1
- 230000008447 perception Effects 0.000 description 8
- 238000013461 design Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 6
- 230000009471 action Effects 0.000 description 5
- 230000007613 environmental effect Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 230000002950 deficient Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 230000001953 sensory effect Effects 0.000 description 3
- 238000013024 troubleshooting Methods 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000005265 energy consumption Methods 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 210000000133 brain stem Anatomy 0.000 description 1
- 230000000875 corresponding effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000002156 mixing Methods 0.000 description 1
- 210000000653 nervous system Anatomy 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于多DSP并行处理的自主移动机器人平台,包括:上层控制计算机通过CAN总线与多个DSP处理系统相连;多个DSP系统之间通过CAN总线相连,以连成控制器局部网络。本实用新型在具备高速数据处理能力和实时数据通信能力的基础上,大大缩小了机器人移动平台的尺寸,减小了能源消耗,降低了移动机器人的整体成本,具备了小批量生产的条件,有利于拓展移动机器人的应用领域。
Description
技术领域
本实用新型涉及通用的移动机器人控制系统,特别涉及基于多DSP并行处理的自主移动机器人平台。
背景技术
移动机器人是机器人学中的一个重要分支,它是一个集环境感知、动态决策与规划、行为控制与执行等多种功能于一体的综合智能控制系统。一个完整的移动机器人系统通常由三个部分组成:移动机构、感知系统和控制系统。移动机构是机器人的载体,决定机器人的运动空间,有步行机构、轮式机构、履带式机构和混合机构等几种。感知系统一般采用CCD摄像机、激光测距仪、超声传感器、接触和接近传感器、红外线传感器和雷达定位传感器、全球定位传感器(GPS)等。移动机器人控制系统相当于人的大脑和神经系统,它综合感知系统获取的环境信息并控制移动机构产生相应的动作。
以往的移动机器人系统基本上都是采用以下两种结构:一是早期的移动机器人采用的结构(见图1),如原西德产的HERO型移动机器人(参见《机器人》杂志第23卷第1期)。这种结构中机器人传感器信号处理和移动机构的伺服控制采用单片机系统来完成,机器人的规划和决策由上层计算机实现,上层计算机和下层模块的通信采用RS232串行通信方式。这种结构的优点是成本低,结构简单,主要缺点是信号处理和运算能力差,只能实现点对点的通信且通信速率低,难以适应动态环境尤其是未知动态环境的要求。近年来移动机器人的设计中开始采用一种基于多台计算机的系统结构(见图2),如清华大学研制的THMR-V型移动机器人(参见《机器人》杂志第23卷第6期)。该结构中每一个控制模块均包括一台计算机(工控机或PC机),各个计算机之间通过局域网(一般为以太网)相连。这种结构的优点是处理能力强,主要缺点是体积大、笨重,而且耗电量大,难以适应采用电池供电的移动机器人低能耗的要求,同时其高成本的特点也极大地限制了移动机器人应用领域的推广。
实用新型内容
本实用新型的目的是提供一种采用多个DSP并行处理的自主移动机器人平台,可分别独立完成移动机器人的伺服控制、传感器信号处理、自主避障、路径规划等任务。
为实现上述目的,一种基于多DSP并行处理的自主移动机器人平台,
包括:
上层控制计算机通过CAN总线与多个DSP处理系统相连;
多个DSP系统之间通过CAN总线相连,以连成控制器局部网络。
本实用新型在具备高速数据处理能力和实时数据通信能力的基础上,大大缩小了机器人移动平台的尺寸,减小了能源消耗,降低了移动机器人的整体成本,具备了小批量生产的条件,有利于拓展移动机器人的应用领域。
附图说明
图1为采用单片机系统作为移动机器人控制模块的系统结构
图2为采用多计算机系统作为移动机器人控制模块的系统结构
图3为采用多DSP并行处理的自主移动机器人平台系统结构
具体实施方式
如图3所示,基于多DSP并行处理的自主移动机器人平台属于自主移动机器人范畴,移动机器人要实现在未知和不确定环境下自主工作,应具有感知环境和规划自身动作的能力。为此,必须提高移动机器人对当前环境的快速感知、理解和识别能力以及导航功能,这在很大程度上取决于移动机器人是否采用了一个合理的体系结构。传统的基于“感知-建模-规划-动作”模型的水平型体系结构信号流程清晰,易于工程实现,但它每规划一个动作都需要经过“感知-建模-规划-动作”的整个流程,感知环境和规划动作的速度慢,只适合于工作在已知环境中;基于行为的垂直型体系结构(如包容式结构)将系统功能分解成并行(垂直)的模块,各模块独立地接收传感器的输入并规划出各自的动作,感知环境和规划动作的速度大为加快,可工作在未知和不确定环境中。本实用新型采用将水平型体系结构和垂直型体系结构结合起来的混合型体系结构,在机器人的底层控制中采用各功能模块可并行执行的垂直型体系结构,底层控制由各自独立的DSP并行处理系统组成,分别完成超声、红外传感器信号处理和运动控制、定位、避障、路径规划等功能,以加快机器人感知环境和规划动作的速度。在机器人的上层控制中采用各功能模块顺序执行的水平型体系结构,保证上层控制能获得机器人感知的全部环境信息和机器人的运行状态,通过对全局信息的分析和推理有效实施对底层控制中各功能模块的任务调度和故障处理,保证移动机器人整体运行的高效和可靠性。
自主移动机器人平台由超声测距DSP系统、避障及伺服控制DSP系统、路径规划DSP系统及上层控制计算机组成,三个相互独立的DSP系统与上层控制计算机之间通过CAN总线连成控制器局部网络。超声传感器信号经放大后送入超声测距DSP系统进行处理;红外传感器信号经放大后送入避障及伺服控制DSP系统进行处理,实现移动机器人的伺服控制和自主避障;定位传感器信号送入路径规划DSP系统进行处理并由DSP系统实现移动机器人的路径规划。
上层控制的主控机采用嵌入式工业控制计算机,用于在上层控制中获取机器人感知的全部环境信息和机器人的运行状态,实现移动机器人的任务调度和故障处理,保证机器人的可靠运行。
本实用新型中各DSP处理系统之间以及DSP处理系统和上层控制计算机之间采用CAN总线连成控制器局部网络,网络中各自独立的DSP处理系统之间及其和上层控制计算机之间通过CAN总线可实现可靠的数据通信和实时、高效的任务调度。
本实用新型与图1所示系统的不同之处在于:
采用数字信号处理器作为各模块的控制中心,这和图1中采用的单片机系统相比在信号处理能力、实时性、计算精度等方面都有很大程度的提高,并且保持了原有单片机系统体积小、成本低、功耗低的特点。本实用新型采用的DSP数字信号处理器具有指令执行速度快、大部分指令都可以在单周期内执行完毕的优点。另外,它还具有非常强大的片内I/O端口和A/D模数转换器、CAN总线接口、串行通信接口等外围设备,可以简化外围电路设计,降低系统成本。本实用新型采用的多DSP并行处理的系统结构有效地克服了图1所示系统存在设计复杂和一些算法难以实现的缺陷。
本实用新型与图1所示系统的另一个主要的不同之处是采用了基于CAN总线的控制器局部网络结构,各自独立的DSP系统之间及其与上层计算机之间可实现高速、可靠、实时和灵活的数据通信,有效克服了图1所示系统只能实现点对点的通信且通信速率低的缺陷,使得采用本实用新型设计的移动机器人可以适应未知动态环境的要求。
本实用新型与图2所示系统的不同之处在于:
采用具有高速信号处理和数字控制功能而且体积小、重量轻、低成本、低功耗的数字信号处理器作为各模块的控制中心,使得本实用新型在具备高速数据处理能力和实时数据通信能力的基础上,大大缩小了机器人移动平台的尺寸,减小了能源消耗,降低了移动机器人的整体成本,有效克服了图2所示系统体积大、笨重、耗电量大、高成本的缺陷,有利于移动机器人在军事和民用等领域的应用推广。
实施例
本实用新型(图3)中各DSP处理系统的CPU均采用TI公司生产的TMS320LF2407A,它是专门针对控制领域应用的DSP芯片,具有高速信号处理和数字控制功能所必需的体系结构,其指令执行速度高达40MIPS,且绝大部分的指令都可以在一个25ns的单周期内执行完毕。另外,它还具有非常强大的片内I/O端口和其它外围设备,可以简化外围电路设计,降低系统成本。
本实用新型底层控制中的超声测距DSP系统采用TMS320LF2407A为核心处理器,通过硬件中断和轮巡采集等方法实现传感器数据采集的实时性和可靠性,软件上采用传感器数据融合算法和容错设计方法保证系统可以达到很高的采集速率和很高的精度。通过CAN总线通信,可以将测距值以很高的通信速率可靠的发送给机器人底层控制中的其他模块和上层控制计算机。
避障及伺服控制DSP系统中的伺服控制是采用变结构的原理来实现的,即在误差较大时使用最速控制,电机加全压高速运行,以使误差迅速减小,在误差较小时使用增益可变的PID控制,实现驱动轮伺服系统的无超调运行,以达到移动机器人高精度、高速度移动的目的。底层控制中的移动机器人避障是通过采集安装在机器人平台上的多路红外传感器信号、采用动态避障算法来实现的。
本实用新型底层控制中的路径规划DSP系统用来实现移动机器人定位和路径规划两部分功能。移动机器人定位用于实时测定机器人当前坐标及方位,它首先根据电机轴编码器的输出经计算后得到粗定位,然后根据超声传感器信息以及上层的图像等其它信息来达到精确定位。路径规划则是根据上面已经得出的机器人位置信息和上层计算机给出的机器人工作环境信息和目标点信息,按照某种优化指标,采用人工势场算法在起始点和目标点间规划出一条与环境障碍无碰的路径。
上层控制的主控机采用嵌入式工业控制计算机,它主要完成两部分功能,一是接收用户的控制指令并显示移动机器人的位置和状态信息,完成与用户的人机接口;二是完成与机器人底层的交互,获取机器人感知的全部环境信息和机器人的运行状态,通过对全局信息的分析和推理有效实施对底层控制中各功能模块的任务调度和故障处理,保证移动机器人整体运行的高效和可靠性。
Claims (4)
1.一种基于多DSP并行处理的自主移动机器人平台,其特征在于:
上层控制计算机通过CAN总线与多个DSP处理系统相连;
多个DSP系统之间通过CAN总线相连。
2.按权利要求1所述的平台,其特征在于所述的DSP处理系统包括:超声测距DSP系统,所述超声测距DSP系统与超声传感器相连。
3.按权利要求1所述的平台,其特征在于所述的DSP处理系统包括:避障及伺服控制DSP系统,所述超声测距DSP系统与处理红外传感器和移动机构相连。
4.按权利要求1所述的平台,其特征在于所述的DSP处理系统包括:路径规划DSP系统,所述路径规划DSP系统与定位传感器相连。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 02295455 CN2614864Y (zh) | 2002-12-31 | 2002-12-31 | 基于多dsp并行处理的自主移动机器人平台 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 02295455 CN2614864Y (zh) | 2002-12-31 | 2002-12-31 | 基于多dsp并行处理的自主移动机器人平台 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN2614864Y true CN2614864Y (zh) | 2004-05-12 |
Family
ID=34238798
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 02295455 Expired - Lifetime CN2614864Y (zh) | 2002-12-31 | 2002-12-31 | 基于多dsp并行处理的自主移动机器人平台 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN2614864Y (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103284653A (zh) * | 2012-03-02 | 2013-09-11 | 恩斯迈电子(深圳)有限公司 | 清洁机器人及其控制方法 |
CN103362902A (zh) * | 2013-06-27 | 2013-10-23 | 山东大学 | 腿足式机器人单腿液压伺服控制器 |
CN103624763A (zh) * | 2012-11-09 | 2014-03-12 | 沈阳建筑大学 | 一种无线遥控建筑环境参数检测机器人 |
CN104589345A (zh) * | 2014-12-01 | 2015-05-06 | 嘉兴市德宝威微电子有限公司 | 公共场所可自由行动的机器人和系统 |
-
2002
- 2002-12-31 CN CN 02295455 patent/CN2614864Y/zh not_active Expired - Lifetime
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103284653A (zh) * | 2012-03-02 | 2013-09-11 | 恩斯迈电子(深圳)有限公司 | 清洁机器人及其控制方法 |
CN103624763A (zh) * | 2012-11-09 | 2014-03-12 | 沈阳建筑大学 | 一种无线遥控建筑环境参数检测机器人 |
CN103362902A (zh) * | 2013-06-27 | 2013-10-23 | 山东大学 | 腿足式机器人单腿液压伺服控制器 |
CN103362902B (zh) * | 2013-06-27 | 2016-01-20 | 山东大学 | 腿足式机器人单腿液压伺服控制器 |
CN104589345A (zh) * | 2014-12-01 | 2015-05-06 | 嘉兴市德宝威微电子有限公司 | 公共场所可自由行动的机器人和系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109755995B (zh) | 基于ros机器人操作系统的机器人自动充电对接方法 | |
CN101612733A (zh) | 一种分布式多传感器移动机器人系统 | |
CN107272680A (zh) | 一种基于ros机器人操作系统的机器人自动跟随方法 | |
CN105425791A (zh) | 一种基于视觉定位的群机器人控制系统及方法 | |
CN111309015A (zh) | 一种融合多传感器的变电站巡检机器人定位导航系统 | |
CN101373380B (zh) | 一种仿人机器人控制系统及机器人操纵方法 | |
CN107272008A (zh) | 一种带惯性补偿的agv激光导航系统 | |
CN1219263C (zh) | 基于多dsp并行处理的自主移动机器人系统 | |
CN103064416A (zh) | 巡检机器人室内外自主导航系统 | |
CN111459172A (zh) | 围界安防无人巡逻车自主导航系统 | |
CN100361792C (zh) | 一种移动机械手控制系统 | |
CN114578772B (zh) | 一种agv集群控制系统设计框架及方法 | |
CN111311009A (zh) | 一种基于长短期记忆的行人轨迹预测方法 | |
CN108469820A (zh) | 一种两轮驱动低速全天候无人驾驶巡逻车系统 | |
Chang et al. | Design of mobile garbage collection robot based on visual recognition | |
CN2614864Y (zh) | 基于多dsp并行处理的自主移动机器人平台 | |
Ye et al. | Robot indoor positioning and navigation based on improved wifi location fingerprint positioning algorithm | |
Miyagusuku et al. | Toward autonomous garbage collection robots in terrains with different elevations | |
CN211207169U (zh) | 一种温室采摘机器人底盘控制系统 | |
Wang et al. | Coarse-to-fine visual object catching strategy applied in autonomous airport baggage trolley collection | |
Wang et al. | Agv navigation based on apriltags2 auxiliary positioning | |
CN113671958B (zh) | 机器人的避障路径的确定方法、系统、电子设备和介质 | |
Wehe et al. | Intelligent robotics and remote systems for the nuclear industry | |
Lu et al. | Slam and navigation of electric power intelligent inspection robot based on ROS | |
Zhao | Architecture and Integrated System of Autonomous Intelligent Robot Based on Multi-perception |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CX01 | Expiry of patent term |
Expiration termination date: 20130104 Granted publication date: 20040512 |