CN103722556A - 一种高精度轻型机器人多自由度机械臂驱动控制电路 - Google Patents

一种高精度轻型机器人多自由度机械臂驱动控制电路 Download PDF

Info

Publication number
CN103722556A
CN103722556A CN201310688067.4A CN201310688067A CN103722556A CN 103722556 A CN103722556 A CN 103722556A CN 201310688067 A CN201310688067 A CN 201310688067A CN 103722556 A CN103722556 A CN 103722556A
Authority
CN
China
Prior art keywords
unit
data
signal
mechanical arm
dsp
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.)
Granted
Application number
CN201310688067.4A
Other languages
English (en)
Other versions
CN103722556B (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.)
Beijing Automation Control Equipment Institute BACEI
Original Assignee
Beijing Automation Control Equipment Institute BACEI
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 Beijing Automation Control Equipment Institute BACEI filed Critical Beijing Automation Control Equipment Institute BACEI
Priority to CN201310688067.4A priority Critical patent/CN103722556B/zh
Publication of CN103722556A publication Critical patent/CN103722556A/zh
Application granted granted Critical
Publication of CN103722556B publication Critical patent/CN103722556B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)
  • Control Of Electric Motors In General (AREA)
  • Control Of Multiple Motors (AREA)

Abstract

本发明属于电路设计技术领域,具体涉及一种高精度轻型机器人多自由度机械臂驱动控制电路。本发明包括基于DSP的智能控制单元、基于FPGA的数据采集单元、信号调理单元、智能控制输出单元、智能驱动单元、电源转换单元、高速模数转换单元、数据存储单元、网络总线通讯单元、功率驱动保护单元、传感器单元和人机交互单元。本发明能够实时精确驱动机器人多自由度机械臂关节直流伺服电机,并能够结合综控机指令信息及***信息实现关节直流伺服电机最优控制。

Description

一种高精度轻型机器人多自由度机械臂驱动控制电路
技术领域
本发明属于电路设计技术领域,具体涉及一种高精度轻型机器人多自由度机械臂驱动控制电路。
背景技术
机器人多自由度机械臂是近代自动控制领域中出现的一项新技术,作为多学科融合的边沿学科,它是当今高技术发展最快的领域之一,并已成为现代机械制造生产***中的一个重要组成部分。当今,机器人多自由度机械臂已经广泛应用于工业加工、工业生产、工业装配、工业科学实验、救生***、航天、航空、航海等领域。随着工业技术的快速发展,对机器人多自由度机械臂***控制精度、功率密度、实时性能、可靠性等方面提出了更高的要求。
在机器人多自由度机械臂***中,电气***是多自由度机械臂的灵魂。多自由度机械臂的电气***主要由控制器***、电机驱动***、通讯***、传感器信息采集***以及电源***等几方面构成。控制器***的计算能力以及抗干扰能力直接影响了空间多自由度机械臂的操作性能;电机驱动***直接影响着关节工作的状态;通讯***是连接关节和中央控制器的纽带;电源***是整个多自由度机械臂电气***正常工作的基础。通过机构设计提高多自由度机械臂性能的难度不断增加,而高集成度、高性能的电气***设计成了大幅提高多自由度机械臂性能的有效途径,而且可以通过硬件模块化的设计提高对机械本体结构的优化;因此研究一种高精度轻型机器人多自由度机械臂驱动控制电路设计具有重要的研究意义。
发明内容
本发明需要解决的技术问题为:提供一种高精度轻型机器人多自由度机械臂驱动控制电路,能够实时精确驱动机器人多自由度机械臂关节直流伺服电机,并能够结合综控机指令信息及***信息实现关节直流伺服电机最优控制。
本发明的技术方案如下所述:
一种高精度轻型机器人多自由度机械臂驱动控制电路,包括基于DSP的智能控制单元、基于FPGA的数据采集单元、信号调理单元、智能控制输出单元、智能驱动单元、电源转换单元、高速模数转换单元、数据存储单元、网络总线通讯单元、功率驱动保护单元、传感器单元和人机交互单元。
基于FPGA的数据采集单元采集传感器单元经过信号调理单元调理和高速模数转换单元转换后的模拟量数据,以及采集经过信号调理单元调理后的数字量数据,后利用中断信号将两种数据通过数据总线和地址总线传送至基于DSP的智能控制单元;基于DSP的智能控制单元收到数据后,对数据进行初步处理,并将部分数据储存到数据存储单元;存储完毕后,基于DSP的智能控制单元再调用数据存储单元的数据,结合综控机指令及运动学理论进行数据处理及智能推理,并将智能推理结果输出至智能控制输出单元、智能驱动单元及人机交互单元;智能驱动单元接收智能推理结果并输出功率驱动信号驱动电机运行;网络总线通讯单元通过收发数据和命令实现基于DSP的智能控制单元与外部网络总线或综控机通讯;同时,功率驱动保护单元实时监测***各部件运行状态,如有异常状态及时反馈信息到基于DSP的智能控制单元;电源转换单元为整个电路各单元提供电源。
作为优选方案:所述基于DSP的智能控制单元包括DSP芯片、电源转换电路、无源晶振电路、仿真调试电路:电源转换电路提供DSP芯片所需要的电压;无源晶振电路提供DSP芯片所需要的工作频率;仿真调试电路提供DSP程序软件下载和仿真接口;DSP芯片以数据总线和地址总线方式分别与数据存储单元和基于FPGA的数据采集单元实现数据传输。
作为优选方案:所述基于DSP的智能控制单元采用TMS320F28335芯片。
作为优选方案:所述基于FPGA的数据采集单元包括FPGA芯片、电源转换电路、有源晶振电路、仿真调试接口:电源转换电路和有源晶振电路分别提供FPGA芯片需要的电压和工作频率;仿真调试接口提供程序软件下载端口;FPGA芯片获取高速模数转换单元、数字量传感器及数字量I/O信息数据;FPGA芯片采用数据总线和地址总线分别与模数转换单元及DSP处理器通信。
作为优选方案:所述基于FPGA的数据采集单元采用EP1C3T144芯片。
作为优选方案:所述高速模数转换单元由两片高速模数转换器和电源基准电路组成:电源基准电路提供高速模数转换器需要的基准电压,两片模数转换器采用地址总线和数据总线实现与FPGA芯片的数据和命令通信。
作为优选方案:所述高速模数转换单元采用AD7606芯片。
作为优选方案:所述电源转换单元由多种电源转换模块组成,将***输入电压转换为DSP处理器及其传感器电路所需要的电压。
作为优选方案:所述信号调理单元包括滤波电路、差分电路、光电隔离电路和运放电路:模拟量传感器信息经过滤波电路后,输入到运放电路,将模拟量传感器输出的信号缩放到高速模数转换单元要求的输入范围,然后将信号输出至高速模数转换单元;数字量传感器信息经过滤波电路后,输入到差分电路实现信号耦合,后用光电隔离电路实现信号隔离及电平转换,最后输入基于FPGA的数据采集单元实现信号采集;数字开关量经过滤波电路后,输入到光电隔离电路实现信号隔离及电平转换,后输入到基于FPGA的数据采集单元。
作为优选方案:所述数据存储单元由SDRAM同步动态随机存取存储器和FLASH闪存两种存储器组成,它们之间的位置连接关系是:通过地址总线和数据总线与外部存储器接口连接,基于DSP的智能控制单元通过外部存储器接口实现与数据存储单元数据的读写。
作为优选方案:所述功率驱动保护单元指由电流传感器、温度传感器及信号比较电路组成的过压、过流、欠压、温度保护电路:电流传感器采集伺服电机电流信号,并将量化的信号经过精密电阻进行电压转换后,送到信号调理单元,***采用软件形式实现过流保护;温度传感器采集驱动控制电路内部温度信号,并将量化的信号输送到信号调理单元,采用软件形式实现温度保护;由电阻、光藕、运放电路组成的信号比较电路以硬件形式实现过压、欠压保护。
作为优选方案:所述智能控制输出单元是基于DSP的智能控制单元执行智能逻辑推理的输出结果,它由PWM驱动信号输出和I/O驱动信号输出两部分组成;
PWM驱动信号输出由DSP的PWM信号输出接口、光电隔离芯片、信号驱动芯片组成;I/O驱动信号输出由光电隔离芯片、数据驱动芯片组成;
智能控制输出单元各组件的连接关系为:DSP处理器输出PWM数字信号,该数字信号经光电隔离芯片进行信号隔离后,利用信号驱动芯片进行电压驱动转换实现与智能驱动单元电平匹配;DSP的I/O信号经光电隔离芯片进行信号隔离后,利用数据驱动芯片进行信号驱动,之后直接对外设备输出I/O驱动信号。
作为优选方案:所述智能驱动单元采用SA03直流有刷智能模块驱动芯片。
作为优选方案:所述智能驱动单元壳体表面附加散热片。
作为优选方案:所述关节传感器单元指安装在机器人多自由度机械臂关节上的传感器,包括关节位置传感器、关节位置限位传感器及编码器。
作为优选方案:关节位置传感器采用MC1003系列;关节位置限位传感器采用A1101;编码器采用增量式或单极性编码器。
作为优选方案:所述人机交互单元由数码管、指示灯、按键组成:数码管显示当前多自由度机械臂的工作状态信息;指示灯指示驱动控制器的工作状态;外部操作通过按键调整***参数。
作为优选方案:所述网络总线通讯单元负责基于DSP的智能控制单元与综控机或网络通信数据的发送和接收,网络总线通讯单元包括CAN总线、RS485总线两种网络总线。
作为优选方案:CAN总线对应MCP2551收发器,RS485总线对应MAX1487总线收发器。
本发明的有益效果为:
(1)本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,采用模块化设计结构思想,控制、驱动、传感电路分层设计,实现对关节直流伺服电机的精确控制;
(2)本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,驱动负载能力强,功率密度高,体积小,实时性好,响应快、扩展性强;
(3)本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,采用多重保护机制,***接线简单,高可靠、长寿命、强抗电磁干扰能力;
(4)本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,控制与通信方式灵活,具有多种控制方式接口及通信网络;
(5)本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,采用智能高功率驱动模块,驱动负载能力强,功率密度高,体积小,响应快
(6)本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,控制策略的更新、升级能力强。
附图说明
图1为本发明硬件结构方框示意图;
图2为基于FPGA的数据采集单元结构图;
图3为信号调理单元结构图;
图4为数据存储单元结构图;
图5为功率驱动保护单元结构图。
具体实施方式
下面结合附图和实施例对本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路进行详细说明。
本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,采用了DSP(数字信号处理器)+FPGA(可编程逻辑器件)+高功率密度功率驱动单元的体系结构,具有数据采集、信号滤波、数据处理及传输、网络数据通信、智能控制、人机交互等功能。
本发明的一种高精度轻型机器人多自由度机械臂驱动控制电路,包括基于DSP的智能控制单元、基于FPGA的数据采集单元、信号调理单元、智能控制输出单元、智能驱动单元、电源转换单元、高速模数转换单元、数据存储单元、网络总线通讯单元、功率驱动保护单元、传感器单元和人机交互单元。
如图1所示,基于FPGA的数据采集单元采集传感器单元经过信号调理单元调理和高速模数转换单元转换后的模拟量数据,以及采集经过信号调理单元调理后的数字量数据,后利用中断信号将两种数据通过数据总线和地址总线传送至基于DSP的智能控制单元;基于DSP的智能控制单元收到数据后,对数据进行初步处理,并将部分数据储存到数据存储单元;存储完毕后,基于DSP的智能控制单元再调用数据存储单元的数据,结合综控机指令及运动学理论进行数据处理及智能推理,并将智能推理结果输出至智能控制输出单元、智能驱动单元及人机交互单元;智能驱动单元接收智能推理结果并输出功率驱动信号驱动电机运行;网络总线通讯单元通过收发数据和命令实现基于DSP的智能控制单元与外部网络总线或综控机通讯;同时,功率驱动保护单元实时监测***各部件运行状态,如有异常状态及时反馈信息到基于DSP的智能控制单元;电源转换单元为整个电路各单元提供电源。该硬件***为复杂算法的控制策略提供了实现的基础、为高性能伺服控制策略的实现提供了可能性。
1、基于DSP的智能控制单元
所述基于DSP的智能控制单元是驱动控制电路的核心,DSP处理器采用TI公司高性能TMS320F28335芯片,该芯片工作频率可达150MHz,具有功耗低、功能强、稳定性高、抗干扰性强、运算速度快的优点,是一款浮点运算的电机控制专用芯片。基于FPGA的数据采集单元采集经过信号调理单元处理和模数转换器转换后的模拟量数据,以及经过信号调理单元处理后的数字量数据,并将两种采集的数据存入数据存储单元,然后,该智能控制单元调用数据存储单元中的数据采用先进控制算法完成电气状态参数计算,并结合***信息采用智能逻辑推理方法及运动学理论实现关节直流伺服电机驱动控制功能。
基于DSP的智能控制单元由DSP芯片、电源转换电路、无源晶振电路、仿真调试电路构成:电源转换电路提供DSP芯片所需要的标准3.3V和1.9V电压,无源晶振电路提供DSP芯片所需要的工作频率30MHz,仿真调试电路提供DSP程序软件下载和仿真接口;DSP芯片以数据总线和地址总线方式分别与数据存储单元和基于FPGA的数据采集单元实现数据传输。
电源转换电路由电源转换芯片、高精度电阻、电容组成。
基于DSP的智能控制单元负责整个***驱动控制及数据处理,并能通过网络总线通信单元实现综控机与外部总线网络实现通信。
2、基于FPGA的数据采集单元
所述基于FPGA的数据采集单元采集模拟量和数字量信息,采用ALTERA公司CycloneⅠ系列的EP1C3T144芯片,该芯片有2910LE逻辑资源,13条M4KRAM(共6.5KB),另外还有一个数字锁相环,该芯片可以稳定的工作在50MHz的频率,满足要求。
如图2所示,基于FPGA的数据采集单元由FPGA芯片、电源转换电路、有源晶振电路、仿真调试接口构成:电源转换电路和有源晶振电路分别提供FPGA芯片需要的电压和工作频率;仿真调试接口提供程序软件下载端口;FPGA芯片获取高速模数转换单元、数字量传感器及数字量I/O信息数据;FPGA芯片采用数据总线和地址总线分别与模数转换单元及DSP处理器通信。
FPGA芯片具有模拟量数据采集和数字量数据采集功能,模拟量数据采集指FPGA获取高速模数转换单元转换的数据,数字量数据采集指数字量传感器及外部I/O(通用输入输出接口)信息经过信号调理电路后的数字信息。电源转换芯片提供FPGA芯片所需要的3.3V和1.5V电压。有源晶振部分由有源晶振和电容构成。
3、高速模数转换单元
所述高速模数转换单元由两片高速模数转换器和电源基准电路组成:电源基准电路提供高速模数转换器需要的基准2.5V电压,两片模数转换器采用地址总线和数据总线实现与FPGA芯片的数据和命令通信。
高速模数转换器采用AD7606芯片,其为一款高精度8通道16位高速模数转换器,各模拟通道的转换频率为200kSPS,满足***要求。两片高速模数转换器并联组成16通道模拟信号输入接口,将分别用于关节位置信息和伺服电机电流及电压信息采集。电源基准电路由高精度电压转换芯片AD421和电容组成。
4、电源转换单元
所述电源转换单元由多种电源转换模块组成,主要将***输入电压转换为DSP处理器及其传感器电路所需要的电压,处理器与传感器的电压等级主要分为+24V、+15V、-15V、+5V、+3.3V、+1.9V、+1.5V七种类型。
5、信号调理单元
所述信号调理单元主要实现模拟传感器信号调理、数字传感器信号调理以及数字量开关信号调理功能。如图3所示,信号调理单元包括滤波电路、差分电路、光电隔离电路和运放电路:模拟量传感器信息经过滤波电路后,输入到运放电路,将模拟量传感器输出的信号缩放到高速模数转换单元要求的输入范围,然后将信号输出至高速模数转换单元;数字量传感器信息经过滤波电路后,输入到差分电路实现信号耦合,后用光电隔离电路实现信号隔离及电平转换,最后输入基于FPGA的数据采集单元实现信号采集;数字开关量经过滤波电路后,输入到光电隔离电路实现信号隔离及电平转换,后输入到基于FPGA的数据采集单元。
滤波电路由电阻和电容组成的二阶滤波电路;光电隔离电路由快速光藕HCPL4504、电阻、电容组成;运放电路由OP747芯片、电阻、电容组成的电压跟随器及运算放大器组成。
模拟量传感器信息主要指关节位置电位计信息、温度信息、伺服电机电流和电压信息等。数字量传感器信息主要指编码器信息及位置霍尔传感器。位置霍尔传感器用于传感关节位置限位操作信息。数字开关量信息主要指外部控制I/O输入信息、拨码开关信息等。
该驱动控制电路可接增量式差分编码器和单极性编码器两种形式的编码器。
6、数据存储单元
所述数据存储单元由SDRAM同步动态随机存取存储器和FLASH闪存两种存储器组成,它们之间的位置连接关系是:通过地址总线和数据总线与外部存储器接口连接,基于DSP的智能控制单元通过外部存储器接口实现与数据存储单元数据的读写,其存储操作结构如图4所示。
SDRAM采用2片SDRAM芯片,用来存储与处理数据,以及实现上电后的应用程序加载。FLASH用来固化bootloader引导程序和应用程序。
7、功率驱动保护单元
所述功率驱动保护单元指由电流传感器、温度传感器及信号比较电路组成的过压、过流、欠压、温度保护电路:电流传感器采集伺服电机电流信号,并将量化的信号经过精密电阻进行电压转换后,送到信号调理单元,***采用软件形式实现过流保护;温度传感器采集驱动控制电路内部温度信号,并将量化的信号输送到信号调理单元,采用软件形式实现温度保护;由电阻、光藕、运放电路组成的信号比较电路以硬件形式实现过压、欠压保护。
电流传感器采用NT-50霍尔电流传感器,该元件体积较小,测量范围达±150A,过载能力达500A,满足设计要求。温度传感器采用高精度串行数字DS18B20传感器,满足设计需求。
8、智能控制输出单元
所述智能控制输出单元是基于DSP的智能控制单元执行智能逻辑推理的输出结果,它由PWM驱动信号输出和I/O驱动信号输出两部分组成。
PWM驱动信号输出由DSP的PWM信号输出接口、光电隔离芯片、信号驱动芯片组成。I/O驱动信号输出由光电隔离芯片、数据驱动芯片组成。
智能控制输出单元各组件的连接关系为:DSP处理器输出PWM数字信号,该数字信号经光电隔离芯片进行信号隔离后,利用信号驱动芯片进行电压驱动转换实现与智能驱动单元电平匹配,避免了电机驱动时产生的干扰对控制***的影响;DSP的I/O信号经光电隔离芯片进行信号隔离后,利用数据驱动芯片进行信号驱动,之后直接对外设备输出I/O驱动信号,主要包括刹车信号、报警信号、数码显示信号等。
9、智能驱动单元
所述智能驱动单元采用SA03直流有刷智能模块驱动芯片,该芯片动力输出电压16~100V,额定输出电流30A,最大输出功率为3KW,具有驱动功率大、体积小、转换效率高、***响应速度快、内置多种保护、外部引线简洁、抗干扰能力强的特点。
所述智能驱动单元采用TTL电平控制正反转,并具有温度补偿和堵转保护功能,适用于高功率密度直流伺服驱动装置。
作为优选方案,所述智能驱动单元壳体表面附加散热片。
10、关节传感器单元
所述关节传感器单元指安装在机器人多自由度机械臂关节上的传感器,主要包括关节位置传感器、关节位置限位传感器及编码器。
关节位置传感器采用MC1003系列,±15V供电;关节位置限位传感器采用A1101;编码器采用增量式或单极性编码器。
11、人机交互单元
所述人机交互单元由数码管、指示灯、按键组成:数码管显示当前多自由度机械臂的工作状态信息;指示灯指示驱动控制器的工作状态;外部操作通过按键调整***参数。
12、网络总线通讯单元
所述网络总线通讯单元负责基于DSP的智能控制单元与综控机或网络通信数据的发送和接收。网络总线通讯单元包括CAN总线、RS485总线两种网络总线。
CAN总线对应MCP2551收发器,RS485总线对应MAX1487总线收发器。
基于DSP的智能控制单元、基于FPGA的数据采集单元、高速模数转换单元、信号调理单元、电源转换单元、数据存储单元、人机交互单元和网络总线通讯单元设置在控制板上;功率驱动保护单元、智能驱动单元及智能控制输出单元设置在驱动板上;传感器单元设置在关节电路板上。
本发明的高精度轻型机器人多自由度机械臂驱动控制电路安装连接方式如下:
(1)控制板与驱动板之间采用长2.5cm直径3mm螺纹的铜柱连接,控制板置于底层,往上依次为多层驱动板,底层控制板用直径3mm螺钉与驱动控制器盒底板进行固定连接;
(2)关节电路板安装在机器人多自由度机械臂关节位置,由关节传感器位置处引出编码器连接线、关节位置电位计连接线及霍尔位置限位连接线,并连接到关节电路板端口;
(3)各关节电路板端口采用20针排线依次与对应驱动板电机输入输出信号端口相连;
(4)各关节电机动力线依次与对应驱动板电机动力信号端口相连;
(5)控制板控制端口通过26针排线与各驱动板控制信号端口相连;
(6)控制电路板控制电源外接直流24~36V电压,动力电源外接直流16~100V电压;
(7)控制板智能输出I/O端口通过16针排线与驱动控制盒人机交互端口相连;
(8)控制板通过DB9端口实现与外部通信网络或综控机相连。

Claims (19)

1.一种高精度轻型机器人多自由度机械臂驱动控制电路,包括基于DSP的智能控制单元、基于FPGA的数据采集单元、信号调理单元、智能控制输出单元、智能驱动单元、电源转换单元、高速模数转换单元、数据存储单元、网络总线通讯单元、功率驱动保护单元、传感器单元和人机交互单元,其特征在于:基于FPGA的数据采集单元采集传感器单元经过信号调理单元调理和高速模数转换单元转换后的模拟量数据,以及采集经过信号调理单元调理后的数字量数据,后利用中断信号将两种数据通过数据总线和地址总线传送至基于DSP的智能控制单元;基于DSP的智能控制单元收到数据后,对数据进行初步处理,并将部分数据储存到数据存储单元;存储完毕后,基于DSP的智能控制单元再调用数据存储单元的数据,结合综控机指令及运动学理论进行数据处理及智能推理,并将智能推理结果输出至智能控制输出单元、智能驱动单元及人机交互单元;智能驱动单元接收智能推理结果并输出功率驱动信号驱动电机运行;网络总线通讯单元通过收发数据和命令实现基于DSP的智能控制单元与外部网络总线或综控机通讯;同时,功率驱动保护单元实时监测***各部件运行状态,如有异常状态及时反馈信息到基于DSP的智能控制单元;电源转换单元为整个电路各单元提供电源。
2.根据权利要求1所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述基于DSP的智能控制单元包括DSP芯片、电源转换电路、无源晶振电路、仿真调试电路:电源转换电路提供DSP芯片所需要的电压;无源晶振电路提供DSP芯片所需要的工作频率;仿真调试电路提供DSP程序软件下载和仿真接口;DSP芯片以数据总线和地址总线方式分别与数据存储单元和基于FPGA的数据采集单元实现数据传输。
3.根据权利要求2所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述基于DSP的智能控制单元采用TMS320F28335芯片。
4.根据权利要求2所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述基于FPGA的数据采集单元包括FPGA芯片、电源转换电路、有源晶振电路、仿真调试接口:电源转换电路和有源晶振电路分别提供FPGA芯片需要的电压和工作频率;仿真调试接口提供程序软件下载端口;FPGA芯片获取高速模数转换单元、数字量传感器及数字量I/O信息数据;FPGA芯片采用数据总线和地址总线分别与模数转换单元及DSP处理器通信。
5.根据权利要求4所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述基于FPGA的数据采集单元采用EP1C3T144芯片。
6.根据权利要求4所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述高速模数转换单元由两片高速模数转换器和电源基准电路组成:电源基准电路提供高速模数转换器需要的基准电压,两片模数转换器采用地址总线和数据总线实现与FPGA芯片的数据和命令通信。
7.根据权利要求6所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述高速模数转换单元采用AD7606芯片。
8.根据权利要求6所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述电源转换单元由多种电源转换模块组成,将***输入电压转换为DSP处理器及其传感器电路所需要的电压。
9.根据权利要求8所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述信号调理单元包括滤波电路、差分电路、光电隔离电路和运放电路:模拟量传感器信息经过滤波电路后,输入到运放电路,将模拟量传感器输出的信号缩放到高速模数转换单元要求的输入范围,然后将信号输出至高速模数转换单元;数字量传感器信息经过滤波电路后,输入到差分电路实现信号耦合,后用光电隔离电路实现信号隔离及电平转换,最后输入基于FPGA的数据采集单元实现信号采集;数字开关量经过滤波电路后,输入到光电隔离电路实现信号隔离及电平转换,后输入到基于FPGA的数据采集单元。
10.根据权利要求9所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述数据存储单元由SDRAM同步动态随机存取存储器和FLASH闪存两种存储器组成,它们之间的位置连接关系是:通过地址总线和数据总线与外部存储器接口连接,基于DSP的智能控制单元通过外部存储器接口实现与数据存储单元数据的读写。
11.根据权利要求10所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述功率驱动保护单元指由电流传感器、温度传感器及信号比较电路组成的过压、过流、欠压、温度保护电路:电流传感器采集伺服电机电流信号,并将量化的信号经过精密电阻进行电压转换后,送到信号调理单元,***采用软件形式实现过流保护;温度传感器采集驱动控制电路内部温度信号,并将量化的信号输送到信号调理单元,采用软件形式实现温度保护;由电阻、光藕、运放电路组成的信号比较电路以硬件形式实现过压、欠压保护。
12.根据权利要求11所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述智能控制输出单元是基于DSP的智能控制单元执行智能逻辑推理的输出结果,它由PWM驱动信号输出和I/O驱动信号输出两部分组成;
PWM驱动信号输出由DSP的PWM信号输出接口、光电隔离芯片、信号驱动芯片组成;I/O驱动信号输出由光电隔离芯片、数据驱动芯片组成;
智能控制输出单元各组件的连接关系为:DSP处理器输出PWM数字信号,该数字信号经光电隔离芯片进行信号隔离后,利用信号驱动芯片进行电压驱动转换实现与智能驱动单元电平匹配;DSP的I/O信号经光电隔离芯片进行信号隔离后,利用数据驱动芯片进行信号驱动,之后直接对外设备输出I/O驱动信号。
13.根据权利要求12所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述智能驱动单元采用SA03直流有刷智能模块驱动芯片。
14.根据权利要求13所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述智能驱动单元壳体表面附加散热片。
15.根据权利要求13所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述关节传感器单元指安装在机器人多自由度机械臂关节上的传感器,包括关节位置传感器、关节位置限位传感器及编码器。
16.根据权利要求15所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:关节位置传感器采用MC1003系列;关节位置限位传感器采用A1101;编码器采用增量式或单极性编码器。
17.根据权利要求15所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述人机交互单元由数码管、指示灯、按键组成:数码管显示当前多自由度机械臂的工作状态信息;指示灯指示驱动控制器的工作状态;外部操作通过按键调整***参数。
18.根据权利要求17所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:所述网络总线通讯单元负责基于DSP的智能控制单元与综控机或网络通信数据的发送和接收,网络总线通讯单元包括CAN总线、RS485总线两种网络总线。
19.根据权利要求18所述的一种高精度轻型机器人多自由度机械臂驱动控制电路,其特征在于:CAN总线对应MCP2551收发器,RS485总线对应MAX1487总线收发器。
CN201310688067.4A 2013-12-16 2013-12-16 一种高精度轻型机器人多自由度机械臂驱动控制电路 Active CN103722556B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310688067.4A CN103722556B (zh) 2013-12-16 2013-12-16 一种高精度轻型机器人多自由度机械臂驱动控制电路

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310688067.4A CN103722556B (zh) 2013-12-16 2013-12-16 一种高精度轻型机器人多自由度机械臂驱动控制电路

Publications (2)

Publication Number Publication Date
CN103722556A true CN103722556A (zh) 2014-04-16
CN103722556B CN103722556B (zh) 2016-01-20

Family

ID=50446978

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310688067.4A Active CN103722556B (zh) 2013-12-16 2013-12-16 一种高精度轻型机器人多自由度机械臂驱动控制电路

Country Status (1)

Country Link
CN (1) CN103722556B (zh)

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104375506A (zh) * 2014-11-29 2015-02-25 江西洪都航空工业集团有限责任公司 一种面向机器人的嵌入式智能移动控制器
CN104669279A (zh) * 2014-08-29 2015-06-03 北京精密机电控制设备研究所 一种具有主动温控功能的空间机械臂关节控制器
CN104760049A (zh) * 2015-03-31 2015-07-08 南通艾利特自动化有限公司 一种基于rs485总线的嵌入式轻型机械臂控制***
CN104875813A (zh) * 2015-05-26 2015-09-02 上海大学 一种电驱动小型仿生四足机器人
CN105242587A (zh) * 2014-07-10 2016-01-13 北京自动化控制设备研究所 一种双驱动混合型直流低压智能伺服驱动器电路
CN105242640A (zh) * 2014-07-09 2016-01-13 北京自动化控制设备研究所 一种新型的高速高精度多轴伺服运动控制器电路
CN105234939A (zh) * 2015-10-23 2016-01-13 广东惠利普智能科技有限公司 一种四自由度高速并联机械手控制***
CN106585760A (zh) * 2015-10-19 2017-04-26 沈阳新松机器人自动化股份有限公司 多足机器人控制***及多足机器人
CN106976085A (zh) * 2017-04-10 2017-07-25 深圳供电局有限公司 一种变电站带电作业机器人的控制装置
CN107053169A (zh) * 2016-12-19 2017-08-18 山东省科学院自动化研究所 一种总线型智能伺服驱动***、机器人及方法
CN108227539A (zh) * 2016-12-14 2018-06-29 中国航空工业集团公司西安航空计算技术研究所 一种可配置多通道高速模拟量采集***及方法
CN108227540A (zh) * 2016-12-14 2018-06-29 中国航空工业集团公司西安航空计算技术研究所 一种可配置多通道高精度模拟量采集***及方法
CN108924027A (zh) * 2018-09-19 2018-11-30 武汉库迪智能技术有限公司 一种基于ARM内核的EtherCAT主站控制器
CN109062410A (zh) * 2018-07-28 2018-12-21 贵州航天天马机电科技有限公司 一种无线通信人机交互处理***
CN109656233A (zh) * 2018-12-25 2019-04-19 哈尔滨工业大学 永磁同步电机控制回路测试数据的回传***及方法
CN109760073A (zh) * 2018-12-20 2019-05-17 华东师范大学 一种机器人多动作协调控制器
CN111070208A (zh) * 2019-12-20 2020-04-28 西安电子科技大学 重组化协作机器人关节一体化驱动控制***、方法及应用
CN112802652A (zh) * 2021-01-15 2021-05-14 无锡声亚医疗科技有限公司 一种直流电磁铁控制机械臂应用上的可靠控制电路

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5309075A (en) * 1990-03-23 1994-05-03 Toyoda Koki Kabushiki Kaisha Digital servo-control apparatus for preventing torque variations
KR980004142A (ko) * 1996-06-29 1998-03-30 김주용 와이어 본더용 서보모터 제어장치 및 그 방법
KR20030033744A (ko) * 2001-10-25 2003-05-01 김재열 레이저를 이용한 초미세 위치제어기술
CN101261512A (zh) * 2008-04-17 2008-09-10 上海交通大学 基于arm的嵌入式运动控制卡
CN101655708A (zh) * 2008-12-05 2010-02-24 哈尔滨工业大学深圳研究生院 车辆智能搬运器及其控制***和控制方法
CN202261141U (zh) * 2011-10-26 2012-05-30 山东省科学院自动化研究所 一种智能型步进电机驱动***
CN202272170U (zh) * 2011-06-30 2012-06-13 北京自动化控制设备研究所 一种电动舵***
CN102969949A (zh) * 2012-10-31 2013-03-13 中国科学院长春光学精密机械与物理研究所 一种高精度永磁同步电机伺服控制器

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5309075A (en) * 1990-03-23 1994-05-03 Toyoda Koki Kabushiki Kaisha Digital servo-control apparatus for preventing torque variations
KR980004142A (ko) * 1996-06-29 1998-03-30 김주용 와이어 본더용 서보모터 제어장치 및 그 방법
KR20030033744A (ko) * 2001-10-25 2003-05-01 김재열 레이저를 이용한 초미세 위치제어기술
CN101261512A (zh) * 2008-04-17 2008-09-10 上海交通大学 基于arm的嵌入式运动控制卡
CN101655708A (zh) * 2008-12-05 2010-02-24 哈尔滨工业大学深圳研究生院 车辆智能搬运器及其控制***和控制方法
CN202272170U (zh) * 2011-06-30 2012-06-13 北京自动化控制设备研究所 一种电动舵***
CN202261141U (zh) * 2011-10-26 2012-05-30 山东省科学院自动化研究所 一种智能型步进电机驱动***
CN102969949A (zh) * 2012-10-31 2013-03-13 中国科学院长春光学精密机械与物理研究所 一种高精度永磁同步电机伺服控制器

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
熊新民,曹毅: "智能机器人运动关节集成驱动控制器研究", 《微计算机信息》, no. 22, 31 May 2009 (2009-05-31) *

Cited By (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105242640A (zh) * 2014-07-09 2016-01-13 北京自动化控制设备研究所 一种新型的高速高精度多轴伺服运动控制器电路
CN105242640B (zh) * 2014-07-09 2018-10-26 北京自动化控制设备研究所 一种新型的高速高精度多轴伺服运动控制器电路
CN105242587B (zh) * 2014-07-10 2018-02-09 北京自动化控制设备研究所 一种双驱动混合型直流低压智能伺服驱动器电路
CN105242587A (zh) * 2014-07-10 2016-01-13 北京自动化控制设备研究所 一种双驱动混合型直流低压智能伺服驱动器电路
CN104669279A (zh) * 2014-08-29 2015-06-03 北京精密机电控制设备研究所 一种具有主动温控功能的空间机械臂关节控制器
CN104669279B (zh) * 2014-08-29 2017-04-26 北京精密机电控制设备研究所 一种具有主动温控功能的空间机械臂关节控制器
CN104375506A (zh) * 2014-11-29 2015-02-25 江西洪都航空工业集团有限责任公司 一种面向机器人的嵌入式智能移动控制器
CN104760049A (zh) * 2015-03-31 2015-07-08 南通艾利特自动化有限公司 一种基于rs485总线的嵌入式轻型机械臂控制***
CN104875813A (zh) * 2015-05-26 2015-09-02 上海大学 一种电驱动小型仿生四足机器人
CN104875813B (zh) * 2015-05-26 2018-04-06 上海大学 一种电驱动小型仿生四足机器人
CN106585760A (zh) * 2015-10-19 2017-04-26 沈阳新松机器人自动化股份有限公司 多足机器人控制***及多足机器人
CN105234939A (zh) * 2015-10-23 2016-01-13 广东惠利普智能科技有限公司 一种四自由度高速并联机械手控制***
CN108227540B (zh) * 2016-12-14 2020-10-20 中国航空工业集团公司西安航空计算技术研究所 一种可配置多通道高精度模拟量采集***及方法
CN108227539A (zh) * 2016-12-14 2018-06-29 中国航空工业集团公司西安航空计算技术研究所 一种可配置多通道高速模拟量采集***及方法
CN108227540A (zh) * 2016-12-14 2018-06-29 中国航空工业集团公司西安航空计算技术研究所 一种可配置多通道高精度模拟量采集***及方法
CN107053169A (zh) * 2016-12-19 2017-08-18 山东省科学院自动化研究所 一种总线型智能伺服驱动***、机器人及方法
CN107053169B (zh) * 2016-12-19 2023-11-28 山东省科学院自动化研究所 一种总线型智能伺服驱动***、机器人及方法
CN106976085A (zh) * 2017-04-10 2017-07-25 深圳供电局有限公司 一种变电站带电作业机器人的控制装置
CN106976085B (zh) * 2017-04-10 2023-03-31 深圳供电局有限公司 一种变电站带电作业机器人的控制装置
CN109062410A (zh) * 2018-07-28 2018-12-21 贵州航天天马机电科技有限公司 一种无线通信人机交互处理***
CN108924027A (zh) * 2018-09-19 2018-11-30 武汉库迪智能技术有限公司 一种基于ARM内核的EtherCAT主站控制器
CN109760073A (zh) * 2018-12-20 2019-05-17 华东师范大学 一种机器人多动作协调控制器
CN109656233A (zh) * 2018-12-25 2019-04-19 哈尔滨工业大学 永磁同步电机控制回路测试数据的回传***及方法
CN111070208A (zh) * 2019-12-20 2020-04-28 西安电子科技大学 重组化协作机器人关节一体化驱动控制***、方法及应用
CN112802652A (zh) * 2021-01-15 2021-05-14 无锡声亚医疗科技有限公司 一种直流电磁铁控制机械臂应用上的可靠控制电路

Also Published As

Publication number Publication date
CN103722556B (zh) 2016-01-20

Similar Documents

Publication Publication Date Title
CN103722556B (zh) 一种高精度轻型机器人多自由度机械臂驱动控制电路
CN105242640B (zh) 一种新型的高速高精度多轴伺服运动控制器电路
CN105242587B (zh) 一种双驱动混合型直流低压智能伺服驱动器电路
CN201174041Y (zh) 全数字通用交流伺服定位控制驱动器
CN105356825B (zh) 混合***储能装置
CN102111106B (zh) 一种基于arm和dsp的电机综合控制装置
CN103984275A (zh) 一种基于fpga的通用工业运动控制***及基于该运动控制***的控制方法
CN103490695A (zh) 一种应用于多相电机调速***的控制器
CN105680735A (zh) 基于arm处理器的四轴伺服电机运动控制卡及方法
CN102402201A (zh) 多轴运动控制***
CN102147603A (zh) 基于vme总线的多轴运动控制装置
CN202641652U (zh) 电动乘用车电池快换机器人的控制***
CN103701369A (zh) 一种新型高功率密度直流无刷电机驱动器电路
CN206224181U (zh) 一种基于fpga的多轴伺服驱动***位置反馈数据接口卡
CN202677196U (zh) 一种基于fpga的agv接口板
CN117614318A (zh) 一种基于dsp和fpga双处理器的伺服驱动器
CN206039205U (zh) 一种双通道旋转变压器的智能编码器
CN104882965A (zh) 智能微电网控制装置及控制方法
CN204089676U (zh) 一种用于雷达伺服***的驱动器
CN203432593U (zh) 一种双输出磁电编码器
CN103840722A (zh) 一种伺服驱动器
CN103166296A (zh) 一种机器人电源管理***
CN203658796U (zh) 一种多轴运动控制***开发平台
CN204729722U (zh) 一种智能执行器
CN102722174A (zh) 基于总线控制方式的agv控制***

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant