多关节连杆机构的逆运动学解法、以及利用了该逆运动学解法的示教数据制作装置

摘要

多关节连杆机构具有被驱动源驱动的驱动关节、以及伴随着驱动关节的动作而从动地动作的从动关节。首先，从多关节连杆机构选出使工件的位置、姿态变化的开环连杆机构。导出构成选定的开环连杆机构的各关节的移动量、旋转量。将导出的开环连杆机构的各关节的移动量、旋转量设为固定值，导出由开环连杆机构的关节的至少一部分以及未选定的关节构成的闭环连杆机构的各关节的移动量、旋转量。