公开(公告)号：CN101244561A

公开(公告)日：2008-08-20

申请号：CN200810064148.6

申请日：2008-03-21

Applicant: 哈尔滨工程大学

Inventor： 朱齐丹 ,  张智 ,  夏桂华 ,  陆军 ,  蔡成涛 ,  王立辉 ,  原新 ,  栗蓬 ,  刘其端 ,  包卫卫

IPC: B25J9/16 ,  G06F17/10

Abstract: 本发明提供的是一种蒸汽发生器检修机械臂安装过程运动学逆解方法。其中的α、β、γ定义如下：初始时脚坐标系与世界坐标系姿态相同，然后脚坐标系绕自身y轴转α角，再绕自身x轴转β角，最后再绕自身y轴转γ角，得到最终的脚坐标系姿态。各关节点的位置分别为：B点为机械臂的术端点，C、D、E、F、G、H分别为第六关节至第一关节点，I为脚趾术端点，首先求出机械臂各个关节点的坐标，通过安装过程的正解解算出B，C，D的坐标；由I点的坐标和姿态角α，β，γ得出向量，然后可推出H点的坐标；求取F点坐标；其次求取各个关节的转角θi(i＝1，2，3，4，5，6)。本发明的方法避免了建立机械臂的运动学方程，大大减少了计算量，提高了运算的速度，而且能够求得全部解。