论文部分内容阅读
为了满足复杂任务的需求,双臂冗余度机器人应运而生,相比于非冗余度单臂机器人而言,双冗余度机械臂在控制器设计、逆运动学求解、运动规划和协调控制方面对研发者提出了更高的要求。本文根据双臂系统的控制需要,采用了中央控制器——多关节控制器的分层控制构架。根据关节控制的需要,设计了以现场可编程门阵列(Field-Programmable Gate Array,FPGA)为核心,嵌入式NIOS II微处理器为平台的关节控制器。关节控制器能够快速采集传感器信息,并与中央控制器通过高速总线通信,保证了控制的实时性。其次,针对双机械臂夹持刚性物体这一强耦合系统,分析了系统的运动约束,结合双臂系统的任务需求,提出了一种七段笛卡尔轨迹规划方法,该方法规划的轨迹具有速度、加速度连续的特点,此外速度、加速度和jerk值(加速度的导数)均被限定在给定范围内,保证了机械臂系统的安全。然后,建立了双臂系统的D-H坐标系,推导了机械臂的正运动学。为了得到速度的逆解,提出了一种改进的梯度投影法,该方法能够有效的处理机械臂的奇异位姿,对关节进行速度限制,并能保证关节速度与笛卡尔速度同步。针对具有偏置腕关节的七自由度机械臂,分析了常用解析方法的不足,提出了一种利用虚拟关节求解逆运动学的解析方法,该方法具有很高的位置精度。最后,建立了双臂系统的动力学模型,设计了PD+重力补偿的位置控制器。在SimMechanics平台中按照机械臂的名义动力学参数建立了双臂系统,并联合Matlab Simulink建立了仿真环境,通过对双臂的位置控制仿真发现,双臂均采用位置控制会导致系统接触力过大,继而使相对位置误差增大。为了实现对接触力的控制,基于给定力的笛卡尔阻抗控制被应用到机械臂中,从而建立了位置/阻抗协调控制器。仿真结果表明,采用位置/阻抗协调控的双臂系统能够很好的跟踪给定的接触力并能减小双臂间的相对位置误差。