并联机构机床的控制方法及控制装置

    公开(公告)号:CN101226386A

    公开(公告)日:2008-07-23

    申请号:CN200710140331.5

    申请日:2007-08-09

    IPC分类号: G05B19/404 B23Q17/09

    摘要: 本发明提供一种并联机构机床的控制方法及控制装置,进行考虑了全部从动轴的旋转阻力的影响的补偿,由此可以高精度地确定末端执行器的位置和姿态。首先在第1步骤(S1),求出针对末端执行器的位置指令值和姿态指令值的各致动器指令值。然后在第2步骤(S2),获取第1和第2万向接头的旋转阻力值,在第3步骤(S3),使用旋转阻力值计算作用于各第2万向接头的力和力矩,在第4步骤,根据这些力和力矩求出作用于末端执行器的合力和合力矩。然后在第5步骤,使用这些合力和合力矩计算机构的弹性变形量,使用该值计算致动器指令值的补偿量。然后在第6步骤,对于在第1步骤求出的致动器指令值,加算在第5步骤求出的补偿量以进行更新。