基于csc的开放式机器人控制系统的开发.docxVIP

基于csc的开放式机器人控制系统的开发 0 开放式机器人控制系统 1954年，美国人乔治德沃尔制造了第一种编程机器人，该机器人从概念逐渐向现实转变。196年，美国工业化自动公司（pm）的第一个机器人在美国通用汽车公司（mom）上引入，这表明第二个机器人的诞生是由注册的。随着科技的发展, 机器人从只能简单记忆信息的一代机器人发展到了不仅具有感知能力, 甚至还能进行逻辑思维判断的智能机器人。 机器人控制系统作为机器人的核心, 是一种典型的多轴实时运动控制系统。传统的机器人控制系统的开发基本都是采用封闭式体系结构, 即采用专用计算机、专用操作系统、专用机器人语言和专用微处理器等。这种体系结构的控制器存在开发周期长, 制造和使用成本高, 升级换代困难, 无法添加控制系统的新功能等一些缺点。目前, 控制系统主要采用微处理器型、FPGA/CPLD型和DSP型三种方式构成。 本文介绍了一种基于计算机可编程自动化控制器 (Computerized Programmable Automation Controller, 简称CPAC) 的六自由度开放式机器人控制系统, 在开发过程中可以利用CPAC的实时I/O控制、开放的架构、丰富的人机界面等优点。该机器人控制系统具有良好的开放性和扩展性, 可以根据需要方便地进行功能扩展, 且能适应不同类型的工业机器人。此研究工作对于生产实际也具有一定的指导意义。 1 pc机软件平台 CPAC是计算机可编程自动化控制器的简称, 它是固高科技有限公司推出的应用于工业装备控制的软硬件开发平台。CPAC硬件架构图如图1所示。 CPAC硬件平台由自动化控制器、人机界面、端子板和远程I/O模块四部分组成。自动化控制器 (GUC) 是将PC技术与运动控制技术相结合的产物。它以Intel标准X86架构的CPU和芯片组为系统处理器, 采用高性能DSP和FPGA作为运动控制协处理器。在实现高性能多轴协调运动控制和高速点位运动控制的同时, 也实现了普通PC机的所有基本功能。 C P A C软件平台 (O t o s t u d i o) 是一种基于I E C 6 1 1 3 1-3工业控制语言标准组态化、图形化的开发工具, 支持结构化文本 (ST) 、指令表语言 (IL) 、功能块图 (FBD) 、连续功能图 (CFC) 、梯形图 (LD) 、顺序功能图 (SFC) 等六种编程语言, 易于实现功能模块化。Otostudio集成了HMI编程工具, 便于进行人机界面的开发。且Oto Studio包含有控制方案编辑器和仿真调试器, 可以进行离线仿真调试。 2 六自由度机器人控制系统的软件设计 2.1 人机界面模块 六自由度机器人控制系统按功能模块主要分为人机界面模块、运动控制模块、文件模块以及信息反馈模块等4个模块, 机器人控制系统软件总体结构图如图2所示。其中人机界面模块主要由示教盒功能区、机器人坐标显示功能区、机器人示教操作功能区、关节参数功能区、示教列表操作功能区、关节状态功能区、手动控制功能区和状态反馈功能区组成。运动控制模块主要实现了机器人示教和再现等功能, 是整个系统的核心模块。文件模块主要实现文件的创建、导入、保存以及转换等功能, 而信息反馈模块的主要作用是实时采集和显示各个电机角度和机器人位姿状态, 以及显示驱动器和正负限位的报警状态, 还有伺服使能状态。本文将主要介绍运动控制模块实现的过程。 2.2 机器人运动学运算模块 运动控制模块是联系运动控制器操作的模块, 是整个机器人控制系统的核心。此模块又包含有机器人运动学运算模块、示教模块和再现模块3个子模块。其中运动学运算模块是其它两个子模块的基础。机器人运动学运算模块解决了点位运动轨迹、直线和圆弧运动轨迹等一些轨迹的规划问题, 以及在示教过程中控制机器人位姿变化时所用到的机器人正逆解问题。 2.2.1 基于生物活性的运动模式 示教分为关节坐标示教和直角坐标示教两种, 其中关节坐标示教每次只使一个轴运动, 其它关节维持姿态不变。而直角坐标示教是指机器人相对于基坐标系 (X、Y、Z) 的直角坐标。直角示教时, 机器人沿着定义的X、Y、Z方向运动, 每次可能有多个轴参与运动。 机器人示教的实现大概分为以下五个步骤: 1) 通过功能块M C_M o v e A b s o l u t e (F U N) 使机器人手爪移动到一个示教点, 即机器人手爪运动轨迹上的一个关键中间点。在MC_Move Absolute (FUN) 这个功能块里, 调用库函数GT_Prf Jog () 将运动控制卡设置在JOG模式下, 调用库函数GT_Set Jog Prm () 设置Jog运动参数, 调用库函数GT_Set Vel () 设置目标速度, 调用库函数GT_Update () 启动Jog模