专利名称：一种开放式机器人控制器力位混合控制的方法
技术领域：
本发明涉及机器人具有力控制的能力的ー种方法。特别涉及到对这种操作的ー种控制器力位混合控制的方法。
背景技术：
随着机器人在各个领域应用的日益广泛，许多场合要求机器人具有力控制的能力。例如，机器人的精密装配、修刮或エ件表面磨削、抛光和擦洗等。在操作过程中要求保持其末端执行器与环境接触。完成这些作业任务，必须具备从自由空问到约束空问的对力的柔顺控制能力。柔顺控制分为主动柔顺控制和被动柔顺性控制。被动柔顺控制由于其专业性強，成功率低等不足使应用范围受到限制。为了克服其不足，需要对机器人采用主动柔顺控制，·即カ控制。本方法采用基于PC总线的开放式机器人控制器，具体以PC+DSP运动控制卡的结构来构造特种机器人开放式的硬件平台，以满足机器人在完成接触性作业时カ控制的需要。
发明内容
本发明的目的是提出一种开放式机器人控制器力位混合控制的方法，是ー种把硬件与软件相结合的ー种方法。针对特殊接触性作业，本方法中的机器人是平面三自由度操作手，整个操作手有一个移动副，两个转动副。适用于在回转壳体内或外壁表面卜完成某些接触性作业，如在壳体内完成清理污垢或打磨表面等。其中，整个操作手由三个伺服电机驱动，回转壳体由一个伺服电机驱动，共四个伺服电机。一种开放式机器人控制器力位混合控制的方法包括开放式机器人控制器的构成，其构成由第一开放式机器人控制器的实现模式，控制系统以エ业控制计算机(IPC)为上位机，以插接在IPC主板ISA扩展槽内的DSP控制卡为系统的控制核心。此种IPC+PMAC双CPU的控制模式具有实现方便、功能強大、可靠性高等特点，是ー种开放式的控制系统。整个控制器采用了模块化的体系结构，エ业PC机处理非实时的部分，实时的运动控制由DSP运动控制卡来承担。控制系统采用的DSP运动控制器为Delta Tan公司的I型PMAC八轴运动控制卡。PMAC从硬件和软件上都体现了优秀的开放性能和強大的运动控制能力。PMAC卡较一般运动控制器有很强的处理能力、轨迹特性和输入带宽，并且有较强的灵活性，能适用于多总线结构(PC、STD、VME)。其具体的功能包括多轴插补计算、用户辅助PLC编程以及模拟量数据采集处理。本方法中PMAC控制卡的硬件核心为Motomla的DSP56003数字信号处理芯片，伺服周期单轴为55Vs，可接收来自测速发电机、光电编码盘、光栅、旋转变压器的多种反馈信号，能与多种伺服电机兼容。PMAC控制卡的优良特性为实现专用机器人力控制提供了良好的硬件平台。本方法应用的I型PMAC，有jl 一 J8不同功能的外部接ロ，可控制I 8轴。本方法中用到了四个接ロ，J3 (多路拨码开关I/O —与ACC — 34AA (PMAC的附件)连接；J5 (通用数字输入和输出)一控制光I禹和中间继电器；J7 (模拟输出5-8轴)一控制执行机构和驱动回转壳体；J8(模拟输出1-4轴)ー控制大臂和小臂电机。第二由胶片粘贴机器人的硬件平台构成本方法采用エ控机IPC、PMAC I型8轴运动控制卡、双端ロ RAM(DPRAM)、I/O扩展板ACC — 34AA、松下、安川伺服电机及驱动器共四套，用于它们之间控制的接ロ连接板一±夹。其控制系统构成图2所示，本方法自行开发的接ロ连接板。在控制系统中，用到了 PMAC的两个附件①DPRAM (Dual port RAM):双端ロ RAM②ACC — 34AA :多路I/O驱动板其中，DPRAM作为PMAC的附件，是ff’C和PMAC之间的通讯桥梁。DPRAM为主机和PMAC之间可以共享高速内存区，通过DPRAM，IPC与PMAC之问可以方便地进行无握手数据交換。DPRAM在主机(IPC)和PMAC之间有地址映射，用这个地址映射匹配两边的内存地II 、DPRAM对数据实时性的保证，提高了控制系统的灵敏性，使操作手实施主动柔顺控制时カ误差減少，力控制精度大大增加。ACC 一 34AA也是PMAC的附件之一，可以提供64个光隔离的分立I/O点，以32位 字分组，有32个输入点和32个输出点。输入点可以接收外部输入控制信号，以便上位控制器(PMAC)作出决策。输出点可以接继电元件，最终控制外围设备的起停PMAC运行后臼PIc程序，通过M变量对ACC — 34AA输入端和输出端进行只读和只写。具体的实施方式基于PMAC力/位混合控制的硬件实现为了实现机器人末端的力/位混合控制，需要PMAc的模拟输出分别工作在伺服驱动器的速度和转矩控制模式下，驱动器的速度模式和力矩模式都接受上位控制器(PMAC)的模拟信号。其中，速度模式的是以控制位置为主要控制指标，而カ矩模式是以控制转矩为主要控制指标，在力矩模式下可以在额定转矩范匿内实现恒转矩输出。为了实现以上要求，操作手的接触作业分三个步骤首先操作手在速度模式下到达预定的位置并保持一定的姿态，在这种模式下利用电流环的位置控制更准确；随后，对伺服电机进行模式转换，小臂在カ矩模式下竖直抬起，在执行机构接近壳体时，执行机构的电机处于自由状态以保证能良好的依附于壳体内壁；最后，在末端机构与壳体内壁接触时，壳体转动，依靠反馈信息调节小臂伺服电机的转矩使执行器能够始终与壳体保持接触并控制一定的接触力，从而使机器人能够在非结构表面下进行有效的カ控制，完成接触性作业。本方法中PMAC运动控制器共控制四轴联动，但由于操作手中大臂、小臂、执行机构要分别工作于两种不同模式下，所以实际占用PMAC的轴通道数为7个。在这两种模式下，驱动器侧接受控制器指令的输入引脚不同，以松下驱动器为例，速度模式下用14、15引脚，而在カ矩模式下用16、17引脚。两个轴通道DACl — DAC2(PMAC的43、44)模拟输出j分别接到伺服驱动器的速度和转矩指令引脚(驱动器侧的14、16)。轴通道I(DACl)的辅助连接是指与其有关的反馈、驱动器使能和报错、限位等连接。，如，CHAl — CHCl是通道I的编码盘反馈信号，+LIMI和-UMl是在反方向和正方向的限位信号，AENAI/D1RI是放大器使能信号，决定伺服驱动器的使能，其它类似引脚不在详迷。、PMAC的J8有60个引脚，有四个轴输出{通道，每个轴输出通道都有一套类似的辅助连接，每个轴输出通道根据其相应的辅助连接而凋节模拟输出，完成伺服功能。在驱动器ー侧，要实现两种模式，需要轴输出通道的模拟指令信号在14和16之间切換，如果用ー个轴输出通道，需要在PMAC和驱动器之间自己搭建电路在外部来完成此切换，这样做实时性不好，可靠性也不高。，因此本方法采用PMAC的两个轴通道来实现埘驱动器两种模式的伺服输出，这样做可以不必搭建外部电路，而11保证实时性的要求。具体做法是通过PMAC的J51来改变C-MODE的状态。如果单独控制两个轴通道吋，需要两套辅助连接以保证轴通道的伺服输出，但实际上一个驱动器。及外部开关只能提供一套轴通道辅助连接，这需要PMAC在其内部完成输出的切換，通过设置I变量中的1X0217 J，这种切换保证在只有一套轴辅助连接的前提下，PMAC对两个轴通道伺服输出。基于PMAC力/位控制的软件实现整个控制软件包括实时控制软件与上位机的系统管理软件两部分。实时控制软件包括伺服驱动、PLC监控、数据采集等；系统管理软件 包括初始化、參数输入、双CPU通讯、壳体作业规划等。为了在PMAC中实现操作手的力/位混合控制，控制软件在Windows平台L用VC++6. 0编写系统应用程序，同时调用PMAC中PC0MM32PR0动态连接库中的函数完成对PMAC的实时操作。在PMAC的初始化程序中作以下设置和定义#1 一 >250000A ;定义小臂电机为旋转轴A#3 一 >6553. 6X ;定义大臂电机为移动轴x#5 一 >50000B ;定义末端电机为旋转轴B#7 一 >c ;定义驱动回转壳体电机为旋转轴C1102 = * ;恢复电机指令输出地址1102的初始值MI 一 >Y $I iil. ’ C2，8 ;设备输出KPMAC的J5)用于模式カ矩和速度的模式转换M162 一 >D $002B ；电机I的实际位置M168 一 >x :$45，8，16，S ;电机 I 的 DAC 输出位........其中，Pl为壳体入口处位置的横坐标，P2为壳体作业位置的横坐标，P3为壳体作业位置的纵坐标，PlOO为カ矩设置值。1102为电机指令输出地址，1169为小臂电机DAC输出限制，c为标定小臂角度极限。M162为寄存器中存储小臂电机(电机I)实际位置值。M168为输出力矩对DAC的标定值。
权利要求
1.一种开放式机器人控制器力位混合控制的方法其特征是包括了开放式机器人控制器实现模式，控制系统以エ业控制计算机(IPC)为上位机，以插接在IPC主板ISA扩展槽内的DSP控制卡为系统的控制核心。此种IPC+PMAC双CPU的控制模式具有实现方便、功能強大、可靠性高等特点，是ー种开放式的控制系统。整个控制器采用了模块化的体系结构，エ业PC机处理非实时的部分，实时的运动控制由DSP运动控制卡来承担。其控制系统采用的DSP运动控制器为DeltaTan公司的I型PMAC八轴运动控制卡。PMAC从硬件和软件上都体现了优秀的开放性能和強大的运动控制能力。PMAC卡较一般运动控制器有很强的处理能力、轨迹特性和输入带宽，并且有较强的灵活性，能适用于多总线结构(PC、STD、VME)。其具体的功能包括多轴插补计算、用户辅助PLC编程以及模拟量数据采集处理。本方法应用的I型PMAC，有jl 一 J8不同功能的外部接ロ，可控制I 8轴。本方法中用到了四个接ロ，J3(多路拨码开关I/O) —与ACC — 34AA(PMAC的附件)连接；J5 (通用数字输入和输出)一控制光稱和中间继电器；J7 (模拟输出5-8轴)ー控制执行机构和驱动回转壳体；J8(模拟输出1-4轴)ー控制大臂和小臂电机。
2.根据权利要求I所述开放式机器人控制器力位混合控制的方法、其特征是采用エ控机IPC、PMAC I型8轴运动控制卡、双端ロ RAM(DPRAM)、I/O扩展板ACC — 34AA、松下、安川伺服电机及驱动器共四套，用于它们之间控制的接ロ连接板ー块。其控制系统构成图2所示，本方法自行开发的接ロ连接板，在控制系统中，用到了 PMAC的两个附件①DPRAM(Dualport RAM):双端 ロ RAM、② ACC — 34AA :多路 I/O 驱动板其中，DPRAM 作为PMAC的附件，是IPC和PMAC之间的通讯桥梁。DPRAM为主机和PMAC之间可以共享高速内存区，通过DPRAM，IPC与PMAC之问可以方便地进行无握手数据交換。DPRAM在主机(IPC)和PMAC之间有地址映射，用这个地址映射匹配两边的内存地址、DPRAM对数据实时性的保证，提高了控制系统的灵敏性，使操作手实施主动柔顺控制时カ误差減少，カ控制精度大大增加。ACC — 34AA也是PMAC的附件之一，可以提供64个光隔离的分立I/O点，以32位字分组，有32个输入点和32个输出点。输入点可以接收外部输入控制信号，以便卜位控制器(PMAC)作出决策。比如，在本方法中接受控制面板上的输入控制信号。
3.根据权利要求2所述、其特征包括了开放式机器人控制器的实现模式及胶片粘贴机器人的硬件平台二部分实现。
全文摘要
开放式机器人控制器力位混合控制的实现方法此控制器采用“PC+PMAC”的控制结构，利用伺服驱动器的两种不同的控制模式，提出了一种实用的力/位混合控制方案，给出了相应的硬件和软件的具体实现。本方法是平面三自由度操作手，整个操作手有一个移动副，两个转动副。适用于在回转壳体内或外壁表面卜完成某些接触性作业，如在壳体内完成清理污垢或打磨表面等。其中，整个操作手由三个伺服电机驱动，回转壳体由一个伺服电机驱动，共四个伺服电机。
文档编号B25J13/00GK102837314SQ20111017233
公开日2012年12月26日 申请日期2011年6月24日 优先权日2011年6月24日
发明者杨际荣 申请人:镇江华扬信息科技有限公司