CN107127751B - 关节型机械臂驱控一体化控制***及控制方法 - Google Patents
关节型机械臂驱控一体化控制***及控制方法 Download PDFInfo
- Publication number
- CN107127751B CN107127751B CN201710167950.7A CN201710167950A CN107127751B CN 107127751 B CN107127751 B CN 107127751B CN 201710167950 A CN201710167950 A CN 201710167950A CN 107127751 B CN107127751 B CN 107127751B
- Authority
- CN
- China
- Prior art keywords
- control
- signal
- path
- module
- isolation
- 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
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明属于机器人控制器相关领域,尤其涉及一种关节型机械臂驱控一体化控制***及控制方法。本发明利用一片集成式ARM‑DSP芯片完成机器人控制***主控和电机运动控制,利用两片FPGA实现外部接口通信、电源控制、电流环设计,利用一片DSP芯片分时控制最多7路伺服电机;在本发明中ARM和DSP芯片间通信数据交互采用内存访问的方式,使得数据交互速度达到最快,采用无操作***方案和中断硬实时方案,使得***的实时性得到最大程度的提高,在关节空间内对笛卡尔空间运动学计算结果进行二次优化,保证电机运动平滑性,采用软硬件并行处理机制,设计不间断数据“交互‑使用‑重新填充”流程,保证***数据交互与使用互不干扰。
Description
技术领域
本发明属于机器人控制器相关领域,尤其涉及一种关节型机械臂驱控一体化控制***及控制方法。
背景技术
在基于运动学控制方法的关节型机械臂设计领域中主要有(1)CPAC机器人控制***、(2)CRP-S80工业机器人控制***以及(3)KeMotion机器人控制解决方案;在驱控一体化控制***设计领域中主要有(4)驱控一体化控制器和控制***、(5)开放式驱控一体化的工业机器人控制器研发以及(6)众为兴QC驱控一体***。
对于(1)中方案所述的机器人控制***,关键技术在于逆运动学路径规划解算技术的实现、奇异点避免方法和操作***实时性设计,该方案逆运动学路径规划结算主要采用几何方法求解,奇异点避免方法的实现通过绕奇异点转动机制实现,实时性设计主要通过将WINCE操作***进行内核任务调度机制进行优化与改造进行实现。对于(2)中方案所述的机器人控制***,关键技术在于不同构型机器人运动学求解过程的归一化求解,该方案针对不同构型的机器人分别设计运动学控制算法,然后将设计的运动学算法进行分析、比较,对相同模块进行归一化处理,最后通过优化技术进行总体整合,使用时再通过特殊设置进行构型配置。对于(3)中方案所属的机器人控制***,关键技术在于将机器人运动学控制技术与应用工艺进行了深度整合和优化,在传统机器人运动学技术的基础上,结合搬运、码垛、焊接等应用的特殊要求,进行专门的工艺特殊设计,并以此为优化机制进行运动学控制设计。对于(4)中方案所属的机器人控制***,关键技术主要包括控制器接口设计、应用层操作***设计、应用程序和人机交互设计、运动控制卡设计及用于IO控制的可编程逻辑控制器。对于(5)中方案所述的机器人控制***,关键技术在于将常规运动控制器、常规驱动器的控制模块、工控机、安全控制卡、示教盒的CPU处理模块有机集成,形成一个一体化的运动控制器,并将其中运动控制接口进行封装开放,使用户可以进行二次开发。对于(6)中所述的机器人控制***,关键技术在于通过分片式嵌入式设计实现了机器人控制***逻辑部分功能、人机交互功能、电机实时运动控制功能、机器人安全控制功能和IO控制功能。
对于(1)~(6)所述的方案,皆存在成本过高、实时性解决不彻底、使用时需要二次集成不能直接使用的缺点;有的还有奇异点问题解决耗时太长,驱控一体设计方案不完整、封装后的二次开发接口复杂使用技术门槛高,***硬件过于复杂、稳定性有待提高、负载功率有限的缺点。
导致(1)所述方案在于***主控制器使用INTEL架构工控机成本较高,操作***WINCE内核改造只能保证软实时,该操作***架构设计时根本不存在硬实时控制机制,奇异点解决算法过于单一,所设计方案产品为机器人控制***主控制器,没有将驱动部分和配件设计入内,因此需要二次集成到控制柜中才能在产业中进行实际应用。导致(2)和(3)所述方案缺点的原因在于主控制器使用INTEL架构工控机成本较高,操作***直接使用WINDOWS***没有考虑实时性设计,所设计方案产品为机器人控制***主控制器,没有将驱动部分和配件设计入内,因此需要二次集成到控制柜中才能在产业中进行实际应用。导致(4)所述方案缺点的原因在于主控制器使用INTEL架构工控机成本较高,操作***存在版权成本,驱控一体化方案中只设计了传统伺服驱动器的控制部分而未设计电源模块和放大模块,所设计方案产品为机器人控制***主控制器,没有将驱动部分和配件设计入内,因此需要二次集成到控制柜中才能在产业中进行实际应用。导致(5)所属方案缺点的原因在于主控制器使用INTEL架构工控机成本较高,操作***存在版权成本,驱控一体化方案中只设计了传统伺服驱动器的控制部分而未设计电源模块和放大模块,所涉及的封装后开放接口属于高级软件开发范畴,对设计人员技术要求较高,所设计方案产品为机器人控制***主控制器,没有将驱动部分和配件设计入内,因此需要二次集成到控制柜中才能在产业中进行实际应用。导致(6)所属方案缺点的原因在于使用了多片嵌入式控制芯片,据不完全分析,该***至少使用了1片ARM芯片、2片FPGA芯片、9片DSP芯片,造成***过于复杂,稳定性问题也随之浮现,主控***复杂导致功耗过大,进而使得电源和伺服放大模块功率受到限制,该控制***的封装采用盒式封装,现场抗干扰能力有限,扩展后的外部配件不好固定安装,因此需要二次集成为控制柜才能在实际产线中使用。
发明内容
为了解决上述问题,本发明提出了一种关节型机械臂驱控一体化控制***,其特征在于,包括主控板、信号集成模块、IPM驱动放大模块以及强电管理电路;主控板和信号集成板之间通过SPI总线进行通信连接,信号集成模块通过其IPM接口与IPM驱动放大模块连接,信号集成模块通过其强电控制接口与强电管理电路连接;
主控板包括master-FPGA、ARM-DSP双核处理器、扩展DRAM、SD卡、隔离IO、网络总线模块;主控板的master-FPGA的扩展集成板接口、隔离IO、SD卡、扩展DRAM分别采集相关信息后,交由ARM-DSP双核处理器进行处理,产生控制信息,控制信息通过master-FPGA扩展的集成板接口发送到信号集成板,并写入SD卡和扩展DRAM,同时操作主控板控制IO动作,发送网络总线指令至网络总线模块;
信号集成板上包括slave-FPGA接口管理、IPM接口和隔离模块,所述隔离模块包括编码器信号隔离、抱闸电路隔离、强电模块监控隔离、通信隔离、PC调试串行口隔离,各隔离模块分别与slave-FPGA连接;PC调试串行口隔离连接示教器或PC端;IPM接口连接六路电机控制信号线,抱闸电路隔离连接电机抱闸线,编码器信号隔离连接电机编码器反馈信号线。
所述强电管理电路主要完成电源整流、过压过流保护、大电容充放电管理、再生电阻温度管理。
所述master-FPGA还用于为运动控制多路电流环DQ电流分解使用、编码器信号接收后的CRC校验和旨在速度检测平滑的快速移动窗口平均、生成4路扩展PWM发生器、电流采样检测三阶降噪滤波器;
所述ARM-DSP双核处理器中的DSP模块主要完成***的路径规划和电机实时PID控制算法以及相应的快速和平滑处理,ARM-DSP双核处理器中的ARM模块主要完成***的状态监测、信号管理和任务调度;
所述信号集成板用于在主控板统一时钟下各接口的信号采集、隔离和管理,具体包括IPM接口的电流采集、异常信号采集、电机控制信号发送,抱闸电路接口的信号控制管理,强电控制接口的信息采集和控制管理,扩展IO的隔离、信号读取、控制管理,RS485通信接口的隔离、信号读取、信号发送,编码器接口的隔离、信号读取、信号发送等。
一种关节型机械臂驱控一体化控制***的控制方法,所述方法包括任务示教、路径提取、奇异点处理、运动学路径规划、路径平滑,完成运动学路径规划和路径平滑后将大规模路径规划数据转为实时运动控制部分参考数据,传递至各个轴的位置环、速度环、电流环伺服电机实时运动控制模块。
所述路径提取首先要做的是任务路径描述,任务路径描述采用标准最小指令集格式进行;然后是任务描述解析,任务描述解析分为两部分:一部分为将提取的任务采用二进制编码发送到ARM-DSP双核处理器,ARM-DSP双核处理器会周期性的将机器人运行状态发送至任务示教端,按照二进制译码后将该信息赋于最小指令集格式电机位置上进行显示;另一部分为将提取的任务以及当前机器人状态在示教器上进行显示,该部分采用ASCII编码,按照标准最小指令集格式进行显示;提取后的任务文件直接以二进制格式保存于SD卡中,SD卡信息能复制到其他机器人中直接使用。
所述标准最小指令集格式为从左向右依次为指令ID、指令类型、插补类型、加速度、平滑类型、速度单位、精度类型、断点类型、工具ID以及各电机位置。
所述奇异点处理采用人机交互式,其过程为奇异点检测、奇异点报警及操作者交互和奇异点躲避;
所述奇异点检测首先检测路径的位置奇异信息,然后基于位置奇异信息检测速度奇异信息,最后基于速度奇异信息检测加速度奇异信息,
所述奇异点报警及操作者交互即检测到奇异信息后,控制相关IO发出报警灯信号和报警声音信号,并在示教装置上进行显示,由操作者根据任务特点选择奇异点躲避方法。
所述奇异点躲避方法分为三种,分别为奇异路径重新制定、有限步奇异点躲避和实时监督奇异点躲避,奇异路径重新制定是指放弃当前遇到奇异点的路径重新制定路径避免奇异点,有限步奇异点躲避是指控制机器人每个轴转过特定距离的步长使当前位置偏离奇异点,实时监督奇异点躲避是指各个轴每次转非常小的步长并实时反馈各轴位置信息自动判断是否已经偏离了奇异点,如果已经偏离,则躲避完成。
所述运动学路径规划包括首先提取任务点的起点和终点位置、速度这些运动约束,然后进行路径规划插补方式选择;
所述插补方式分为轴插补、直线插补和圆弧插补,轴插补轨迹生成流程包括多轴同步S曲线路径生成和7段变速时间划分机制,7段变速包括加加速、匀加速、减加速、匀速、加减速、匀减速和减减速;直线插补轨迹生成流程包括正运动学位资求解、变步长路径离散、逆运动学求解、加权最小范数优化;圆弧插补需要由任务起点、终点和中间点三个点构成圆弧曲线,然后进行变步长路径离散、逆运动学求解和加权最小范数优化步骤。
所述大规模路径规划数据转为实时运动控制部分参考数据的过程为ARM-DSP双核处理器中的DSP模块完成大规模路径规划数据后首先以较慢速度写入EEPROM中,然后在ARM-DSP双核处理器中的ARM模块控制下EEPROM当前数据交替快速写入提前分成两页的专用RAM中,EEPROM数据读取首地址由ARM模块给出,EEPROM数据读取量由单页RAM存储量决定,与此同时,DSP模块转入实时控制流程,错时访问已经完成写入的RAM页数据作为参考位置进行单轴电机实时控制。
有益效果
本发明利用一片集成式ARM-DSP芯片完成机器人控制***主控和电机运动控制,利用两片FPGA实现外部接口通信、电源控制、电流环设计,利用一片DSP芯片分时控制最多7路伺服电机;在本发明中ARM和DSP芯片间通信数据交互采用内存访问的方式,使得数据交互速度达到最快,采用无操作***方案和中断硬实时方案,使得***的实时性得到最大程度的提高,在关节空间内对笛卡尔空间运动学计算结果进行二次优化,保证电机运动平滑性,采用软硬件并行处理机制,设计不间断数据“交互-使用-重新填充”流程,保证***数据交互与使用互不干扰。
附图说明
图1为关节型机械臂驱控一体化控制***架构框图。
图2为关节型机械臂驱控一体化控制***硬件结构图。
图3为图3关节型机械臂驱控一体化控制***软件架构图。
图4为多路电机串并行混合控制机制图。
图5为多路电机同步控制时序图。
图6为关节型机械臂驱控一体化控制方法流程图。
图7为任务描述标准最小指令集格式图。
图8为人机交互式奇异点处理流程图。
图9为运动学路径规划流程图。
图10为EEPROM填充页1、DSP访问页2示意图。
图11为EEPROM填充页2、DSP访问页1示意图。
具体实施方式
本发明提出了一种关节型机械臂驱控一体化控制***及控制方法。下面结合附图,对本发明作详细说明。
本发明利用一片集成式ARM-DSP芯片、两片FPGA芯片完成机器人控制***主控和电机运动控制。图1为控制***架构图,如图所示,在物理模块上***核心部分为由多核ARM+DSP、FPGA组成的***主控板、IO扩展模块、电机伺服驱动模块以及Ethercat或RS485或CAN或Profilebus网络总线通信接口。
图2为***硬件结构图,如图所示,***硬件主要由主控板、信号集成模块、IPM驱动放大模块、***强电电路接触器模块等构成。其中,主控板上主要有master-FPGA和ARM-DSP双核处理器、扩展DRAM、SD卡接口、隔离IO、网络总线模块等。信号集成板上主要包括slave-FPGA接口管理和隔离模块,包括编码器信号隔离、抱闸电路隔离、强电模块监控隔离、RS485通信隔离、PC调试串行口隔离等。主控板和信号集成板之间通过两块FPGA间的SPI总线进行通信,通信内容主要包括ADC采集数据、PWM信号、编码器信号及时钟统一管理信号、任务指令信息、控制数据信息等。
主控板工作流程为master-FPGA扩展的集成板接口、隔离IO接口、SD卡接口、DRAM接口采集相关信息后,交由ARM-DSP双核处理器进行处理,产生控制信息,控制信息再通过FPGA扩展的集成板接口、隔离IO接口、SD卡接口、DRAM接口发送到信号集成板、SD卡、控制IO动作、发送网络总线指令、生成4路基本PWM发生器等。信号集成板主要用于在主控板统一时钟下的信号采集、隔离和管理,具体包括IPM驱动放大电路的电流采集、异常信号采集、电机控制信号发送,抱闸接口信号控制管理,强电电路异常接口信息采集和控制管理,扩展IO隔离、信号读取、控制管理,RS485通信接口隔离、信号读取、信号发送,绝对值编码器接口隔离、信号读取、信号发送等。
强电管理电路主要完成电源整流、过压过流保护、大电容充放电管理、再生电阻温度管理等,master-FPGA另一主要作用为运动控制多路电流环DQ电流分解使用、编码器信号接收后的CRC校验和旨在速度检测平滑的快速移动窗口平均、生成4路扩展PWM发生器、电流采样检测三阶降噪滤波器等。ARM-DSP双核处理器中的DSP模块主要完成***的路径规划和电机实时PID控制算法以及相应的快速和平滑处理,主控板ARM模块主要完成***的状态监测、信号管理和任务调度。
***软件程序采用模块化设计方法,如图3所示,主要模块包括M3-ARM处理模块、C28-DSP软件模块、mster-FPGA软件模块、slave-FPGA模块、示教器通信管理模块和PC端GUI通信管理模块等。这里的各个模块为软件模块,逻辑关系为M3-ARM处理模块和C28-DSP软件模块为顺序先后串联连接关系,这两个模块与这里其他所述的模块关系为同步并联运行关系。
其中,M3-ARM处理模块主要包括***管理、示教器通信管理、DSP通信、集成板slave-FPGA管理、外部IO管理以及任务调度等;
C28-DSP模块主要完成DSP子***管理、M3通信处理、master-FPGA通信管理、多路电机实时位置控制和速度控制以及路径规划算法实现等;
mster-FPGA软件模块主要处理电流采样、电流环解耦和控制、以及位置速度检测滤波等流程;
集成板slave-FPGA主要完成电源管理程序、抱闸控制程序和外部IO管理程序等;
示教器管理模块主要完成示教器按键管理、示教器窗口管理、示教器通信管理和示教器文本解析管理等;
PC端GUI管理主要完成GUI调试、参数配置、示教器模拟、数据采集分析和虚拟示教等;
整个***位于统一时钟管理之下,除PC端GUI管理模块外其他均采用硬件实时中断处理机制。
统一时钟管理下的多路电机串并行混合控制机制,如图4所示为多路电机串并行混合控制机制图,在master-FPGA通过并行设计实现7路伺服电机控制的CLARK-PARK变换、PARK逆变换以及与电流解耦密切相关的电流环控制,在DSP上通过串行设计7路电机实时控制的位置环和速度环。CLARK变换的作用为将基于三轴、两维的定子静止坐标系电流矢量转换为基于两轴的定子静止坐标系电流矢量,PARK变换的作用为将两轴正交的定子静止坐标系矢量电流转换为等效到d、q轴的转动***矢量电流,其中CLARK变换如(1)所示,PARK变换如(2)所示,PI控制基本描述如(3)所示。
图5统一时钟管理下的DSP串行位置环、速度环计算任务与FPGA并行CLARK-PARK变换、PARK逆变换的任务管理机制。采用这种机制的优势在于一方面合理处理了CLARK-PARK变换、PARK逆变换计算过于复杂、耗时远大于位置环、速度环PI计算而导致的两者之间任务等待问题,利于减少控制时间、提高控制频率,另一方面代替传统方案中多路电机需要多路DSP控制造成的成本上升问题。
(1)
如图6所示为关节型机械臂驱控一体化控制方法流程图包括任务示教、路径提取、奇异点处理、运动学路径规划、路径平滑以及各个轴的位置环、速度环、电流环伺服电机实时运动控制等模块。
任务路径提取首先要做的是任务路径描述,任务路径描述采用标准最小指令集格式,如图7所示为任务描述标准最小指令集格式图,任务路径描述均按照该指令集进行,路径描述按照图7指令集格式进行编码解码即可。任务路径提取其次要做的是任务描述解析,任务描述解析分为两部分,一部分为将提取的任务发送到ARM-DSP主控***,该部分采用二进制编码,以保证传输和运行实时性最高,与此同时,ARM-DSP主控***会周期性的将机器人运行状态发送至任务示教端,由路径提取模块按照二进制译码后将该信息赋于图7最小指令集格式电机位置上进行显示。另一部分为将提取的任务以及当前机器人状态在示教器上进行显示,该部分采用ASCII编码,按照图7指令集格式进行显示方便操作者直接了解机器人状态。提取后的任务文件直接以二进制格式保存于***SD卡中,将SD卡信息复制到其他机器人中,其他机器人可以直接使用。该关键技术本发明优先在基于单独***的示教装置上实现,但不是唯一限定。
如图8所示,奇异点处理一共分为三个子模块,分别为奇异点检测、奇异点报警及操作者交互、奇异点躲避。其中,奇异点检测首先检测路径的位置奇异信息,然后基于位置奇异信息检测速度奇异信息,最后基于速度奇异信息检测加速度奇异信息。奇异点检测模块检测到奇异信息后会交给奇异点报警模块处理,控制相关IO发出报警灯信号和报警声音信号,并在试教装置上进行显示,由操作者根据任务特点选择奇异点躲避方法。奇异点躲避方法分为三种,分别为奇异路径重新制定、有限步奇异点躲避和实时监督奇异点躲避,奇异路径重新制定是指放弃当前遇到奇异点的路径重新制定路径避免奇异点,有限步奇异点躲避是指控制机器人每个轴转过特定距离的步长使当前位置偏离奇异点,实时监督奇异点躲避是指各个轴每次转非常小的步长并实时反馈各轴位置信息自动判断是否已经偏离了奇异点,如果已经偏离,则躲避完成。该关键技术本发明优先在主控ARM芯片上实现,但不是唯一限定。
运动学路径规划技术基本流程如图9所示,首先将提取任务点的起点和终点位置、速度等运动约束。然后进行路径规划插补方式选择,插补方式分为轴插补、直线插补和圆弧插补。轴插补轨迹生成流程包括多轴同步S曲线路径生成和7段变速时间划分机制(加加速、匀加速、减加速、匀速、加减速、匀减速、减减速)。直线插补轨迹生成流程包括正运动学位资求解、变步长路径离散、逆运动学求解、加权最小范数优化等。圆弧插补与直线插补类似,但是圆弧插补除了需要任务起点和终点外,还需要一个中间点,由三个点构成圆弧曲线,然后再进行变步长路径离散、逆运动学求解和加权最小范数优化步骤。该关键技术本发明优先在主控DSP芯片上实现,但不是唯一限定。
大规模路径规划数据转为实时运动控制部分参考数据的传递流程为DSP完成大规模路径规划数据后首先以较慢速度写入EEPROM中,然后在ARM芯片控制下EEPROM当前数据交替快速写入提前分成两页的专用RAM中,EEPROM数据读取首地址由ARM芯片给出,EEPROM数据读取量由单页RAM存储量决定。与此同时,DSP转入实时控制流程,错时访问已经完成写入的RAM页数据作为参考位置进行单轴电机实时控制。图10表示 在ARM控制下数据由EERPOM填充到RAM页1的过程,同时在这个时间段也是DSP实时控制所需数据由RAM页2进行提供的阶段。图11表示在ARM控制下数据由EERPOM填充到RAM页2的过程,同时在这个时间段也是DSP实时控制所需数据由RAM页1进行提供的阶段。需要特别指出的是,本发明DSP路径规划和DSP实时控制优先在一片DSP芯片上通过错时交替运算进行实施。
Claims (10)
1.一种关节型机械臂驱控一体化控制***,其特征在于,包括主控板、信号集成模块、IPM驱动放大模块以及强电管理电路;主控板和信号集成板之间通过SPI总线进行通信连接,信号集成模块通过其IPM接口与IPM驱动放大模块连接,信号集成模块通过其强电控制接口与强电管理电路连接;
主控板包括master-FPGA、ARM-DSP双核处理器、扩展DRAM、SD卡、隔离IO、网络总线模块;主控板的master-FPGA的扩展集成板接口、隔离IO、SD卡、扩展DRAM分别采集相关信息后,交由ARM-DSP双核处理器进行处理,产生控制信息,控制信息通过master-FPGA扩展的集成板接口发送到信号集成板,并写入SD卡和扩展DRAM,同时操作主控板来控制IO动作,发送网络总线指令至网络总线模块;
信号集成板上包括slave-FPGA接口管理、IPM接口和隔离模块,所述隔离模块包括编码器信号隔离、抱闸电路隔离、强电模块监控隔离、通信隔离、PC调试串行口隔离,各隔离模块分别与slave-FPGA连接;PC调试串行口隔离连接示教器或PC端;IPM接口连接六路电机控制信号线,抱闸电路隔离连接电机抱闸线,编码器信号隔离连接电机编码器反馈信号线;
所述强电管理电路主要完成电源整流、过压过流保护、大电容充放电管理、再生电阻温度管理。
2.根据权利要求1所述的一种关节型机械臂驱控一体化控制***,其特征在于,所述master-FPGA还用于为运动控制多路电流环DQ电流分解使用、编码器信号接收后的CRC校验和旨在速度检测平滑的快速移动窗口平均、生成4路扩展PWM发生器、电流采样检测三阶降噪滤波器。
3.根据权利要求1所述的一种关节型机械臂驱控一体化控制***,其特征在于,所述ARM-DSP双核处理器中的DSP模块主要完成***的路径规划和电机实时PID控制算法以及相应的快速和平滑处理,ARM-DSP双核处理器中的ARM模块主要完成***的状态监测、信号管理和任务调度。
4.根据权利要求1所述的一种关节型机械臂驱控一体化控制***,其特征在于,所述信号集成板用于在主控板统一时钟下各接口的信号采集、隔离和管理,具体包括IPM接口的电流采集、异常信号采集、电机控制信号发送,抱闸电路接口的信号控制管理,强电控制接口的信息采集和控制管理,扩展IO的隔离、信号读取、控制管理,RS485通信接口的隔离、信号读取、信号发送,编码器接口的隔离、信号读取、信号发送。
5.一种基于权利要求1所述的关节型机械臂驱控一体化控制***的控制方法,其特征在于,所述方法包括任务示教、路径提取、奇异点处理、运动学路径规划、路径平滑,以及完成运动学路径规划和路径平滑后将大规模路径规划数据转为实时运动控制部分参考数据,传递至各个轴的位置环、速度环、电流环伺服电机实时运动控制模块。
6.根据权利要求5所述的关节型机械臂驱控一体化控制***的控制方法,其特征在于,所述路径提取首先要做的是任务路径描述,任务路径描述采用标准最小指令集格式进行;然后是任务描述解析,任务描述解析分为两部分:一部分为将提取的任务采用二进制编码发送到ARM-DSP双核处理器,ARM-DSP双核处理器会周期性的将机器人运行状态发送至示教器,按照二进制译码后将该信息赋于最小指令集格式电机位置上进行显示;另一部分为将提取的任务以及当前机器人状态在示教器上进行显示,该部分采用ASCII编码,按照标准最小指令集格式进行显示;提取后的任务文件直接以二进制格式保存于SD卡中, SD卡信息能复制到其他机器人中直接使用。
7.根据权利要求6所述的关节型机械臂驱控一体化控制***的控制方法,其特征在于,所述标准最小指令集格式为从左向右依次为指令ID、指令类型、插补类型、加速度、平滑类型、速度单位、精度类型、断点类型、工具ID以及各电机位置。
8.根据权利要求5所述的关节型机械臂驱控一体化控制***的控制方法,其特征在于,所述奇异点处理采用人机交互式,其过程为奇异点检测、奇异点报警及操作者交互和奇异点躲避;
所述奇异点检测首先检测路径的位置奇异信息,然后基于位置奇异信息检测速度奇异信息,最后基于速度奇异信息检测加速度奇异信息,
所述奇异点报警及操作者交互即检测到奇异信息后,控制相关IO发出报警灯信号和报警声音信号,并在示教装置上进行显示,由操作者根据任务特点选择奇异点躲避方法;
所述奇异点躲避方法分为三种,分别为奇异路径重新制定、有限步奇异点躲避和实时监督奇异点躲避,奇异路径重新制定是指放弃当前遇到奇异点的路径重新制定路径避免奇异点,有限步奇异点躲避是指控制机器人每个轴转过特定距离的步长使当前位置偏离奇异点,实时监督奇异点躲避是指各个轴每次转设定的步长并实时反馈各轴的位置信息自动判断是否已经偏离了奇异点,如果已经偏离,则躲避完成。
9.根据权利要求5所述的关节型机械臂驱控一体化控制***的控制方法,其特征在于,所述运动学路径规划包括首先提取任务点的起点和终点位置、速度这些运动约束,然后进行路径规划插补方式选择;
所述插补方式分为轴插补、直线插补和圆弧插补,轴插补轨迹生成流程包括多轴同步S曲线路径生成和7段变速时间划分机制,7段变速包括加加速、匀加速、减加速、匀速、加减速、匀减速和减减速;直线插补轨迹生成流程包括正运动学位资求解、变步长路径离散、逆运动学求解、加权最小范数优化;圆弧插补需要由任务起点、终点和中间点三个点构成圆弧曲线,然后进行变步长路径离散、逆运动学求解和加权最小范数优化步骤。
10.根据权利要求5所述的关节型机械臂驱控一体化控制***的控制方法,其特征在于,所述大规模路径规划数据转为实时运动控制部分参考数据的过程为ARM-DSP双核处理器中的DSP模块完成大规模路径规划数据后首先以较慢速度写入EEPROM中,然后在ARM-DSP双核处理器中的ARM模块控制下EEPROM当前数据交替快速写入提前分成两页的专用RAM中,EEPROM数据读取首地址由ARM模块给出,EEPROM数据读取量由单页RAM存储量决定,与此同时,DSP模块转入实时控制流程,错时访问已经完成写入的RAM页数据作为参考位置进行单轴电机实时控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710167950.7A CN107127751B (zh) | 2017-03-21 | 2017-03-21 | 关节型机械臂驱控一体化控制***及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710167950.7A CN107127751B (zh) | 2017-03-21 | 2017-03-21 | 关节型机械臂驱控一体化控制***及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107127751A CN107127751A (zh) | 2017-09-05 |
CN107127751B true CN107127751B (zh) | 2019-08-16 |
Family
ID=59720973
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710167950.7A Active CN107127751B (zh) | 2017-03-21 | 2017-03-21 | 关节型机械臂驱控一体化控制***及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107127751B (zh) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107450466A (zh) * | 2017-09-26 | 2017-12-08 | 广东顺德西安交通大学研究院 | 一种冲压机器人控制器及其高速平稳控制方法 |
CN109991932B (zh) * | 2017-12-29 | 2020-05-26 | 沈阳新松机器人自动化股份有限公司 | 一种物流搬运设备s曲线加减速速度规划与控制方法 |
CN108453707B (zh) * | 2018-04-12 | 2021-11-19 | 珞石(山东)智能科技有限公司 | 机器人拖动示教轨迹生成方法 |
CN108527330A (zh) * | 2018-05-05 | 2018-09-14 | 深圳市越疆科技有限公司 | 交互式驱控一体装置、模块式机器人和存储介质 |
CN108638073A (zh) * | 2018-06-08 | 2018-10-12 | 杭州电子科技大学 | 基于fpga的六轴机械臂点到点定距直线规划实现方法 |
CN108908350A (zh) * | 2018-07-16 | 2018-11-30 | 苏州大学张家港工业技术研究院 | 一种交互式机器人的控制***及其控制方法 |
CN109194203A (zh) * | 2018-10-18 | 2019-01-11 | 中国科学院长春光学精密机械与物理研究所 | 一种用于多轴运动控制***的驱动控制器 |
CN109523848A (zh) * | 2018-12-12 | 2019-03-26 | 珠海城市职业技术学院 | 人工智能技术教学装置 |
CN109582621B (zh) * | 2019-01-24 | 2023-09-26 | 杭州山梯姆自动化科技有限公司 | 伺服驱动器***接口的扩展***及方法 |
CN109940618A (zh) * | 2019-04-04 | 2019-06-28 | 天津理工大学 | 一种基于正交模糊pid的串联机械手驱动***运动控制方法 |
CN110488698A (zh) * | 2019-08-16 | 2019-11-22 | 深圳华数机器人有限公司 | 一种开放式驱控一体化二次开发平台与*** |
CN110515358B (zh) * | 2019-08-26 | 2021-07-20 | 杭州芯控智能科技有限公司 | 基于一体化控制器的自动化产线并行控制***的控制方法 |
CN110768606B (zh) * | 2019-11-12 | 2022-04-01 | 佛山智能装备技术研究院 | 硬件模块化控驱一体装置 |
CN110798080B (zh) * | 2019-11-15 | 2020-10-30 | 华北电力大学 | 一种模块化多电平换流器的并行控制***及方法 |
CN110850807B (zh) * | 2019-12-04 | 2021-04-27 | 广东博智林机器人有限公司 | 一种奇异点规避方法、装置、设备及介质 |
CN111070208B (zh) * | 2019-12-20 | 2022-12-09 | 西安电子科技大学 | 重组化协作机器人关节一体化驱动控制***、方法及应用 |
CN111203886B (zh) * | 2020-02-12 | 2021-02-09 | 浙江禾川科技股份有限公司 | 一种多轴驱控*** |
CN113960972A (zh) * | 2021-11-09 | 2022-01-21 | 广东科伺智能科技有限公司 | 一种开放式驱控*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4816730A (en) * | 1986-12-22 | 1989-03-28 | E. I. Du Pont De Nemours And Company | Autosampler |
CN204076264U (zh) * | 2013-12-30 | 2015-01-07 | 北京配天技术有限公司 | 一种运动控制卡及机器人 |
WO2016004587A1 (zh) * | 2014-07-08 | 2016-01-14 | 北京航空航天大学 | 一种基于多核处理器架构的机器人混合***应用框架 |
CN105437234A (zh) * | 2016-01-25 | 2016-03-30 | 珠海格力电器股份有限公司 | 一种多奇异点处理方法、***和工业机器人 |
-
2017
- 2017-03-21 CN CN201710167950.7A patent/CN107127751B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4816730A (en) * | 1986-12-22 | 1989-03-28 | E. I. Du Pont De Nemours And Company | Autosampler |
CN204076264U (zh) * | 2013-12-30 | 2015-01-07 | 北京配天技术有限公司 | 一种运动控制卡及机器人 |
WO2016004587A1 (zh) * | 2014-07-08 | 2016-01-14 | 北京航空航天大学 | 一种基于多核处理器架构的机器人混合***应用框架 |
CN105437234A (zh) * | 2016-01-25 | 2016-03-30 | 珠海格力电器股份有限公司 | 一种多奇异点处理方法、***和工业机器人 |
Also Published As
Publication number | Publication date |
---|---|
CN107127751A (zh) | 2017-09-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107127751B (zh) | 关节型机械臂驱控一体化控制***及控制方法 | |
CN103744356B (zh) | 一种基于dsp/fpga动态可配置的机床智能控制器及控制方法 | |
CN101793931B (zh) | 高压变频器测试*** | |
CN103616825B (zh) | 一种低成本半实物自适应时钟虚拟微电网实验平台 | |
CN107315854A (zh) | 核电站控制***半物理仿真平台设计及实现方法 | |
CN102914998B (zh) | 嵌入式小型四轴开放式数控*** | |
CN103760810B (zh) | 一种远程遥测终端控制器 | |
CN104007978A (zh) | 一种智能变电站二次设备逻辑仿真*** | |
CN103744424A (zh) | 一种对现场设备逻辑控制的测试方法 | |
CN111652760B (zh) | 一种电网运维虚拟现实仿真***及仿真方法 | |
CN114218763A (zh) | 一种基于数字孪生的产线动态虚拟重组方法 | |
CN103149842A (zh) | 一种基于仿真-控制一体化设计的发电厂激励仿真*** | |
CN107247827A (zh) | 基于机器学习的虚端子模型建模及自动连线方法 | |
CN110083935A (zh) | 双馈风机控制器辅助设计方法及设备 | |
CN201804225U (zh) | 一种热连轧仿真*** | |
Wang et al. | Development of three dimensional virtual PLC experiment model based on Unity3D | |
CN107024875A (zh) | 一种基于can总线网络的运动控制实时通讯方法 | |
CN113801666B (zh) | 一种虚实结合的大型焦炉机械设备调试***及调试方法 | |
CN205844887U (zh) | 一种新能源冷却保护***的测试*** | |
Lu | Application of PLC control technology in intelligent automatic control | |
CN202075918U (zh) | 电气设备维修实验装置 | |
Zsuga et al. | Review and conceptual design of FPGA-based application for data-driven power electronic systems | |
CN103020006A (zh) | 一种基于海量数据挖掘的设备状态预测方法 | |
CN102929191B (zh) | 控制多个驱动器同步工作的方法及其装置 | |
CN108108301A (zh) | 一种计算机软件技术开发调试*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |