姿势控制方法及姿势控制装置

摘要

本发明涉及一种姿势控制方法及姿势控制装置，在该姿势控制方法中，利用四个距离计测装置对处理装置和利用处理装置实施处理的圆管的处理面之间的距离进行计测，并控制处理装置的姿势，其中，基于第一计测距离减去第二计测距离的差和第三计测距离减去第四计测距离的差，控制绕俯仰轴的姿势，基于第一计测距离减去第三计测距离的差和第二计测距离减去第四计测距离的差，控制绕摇摆轴的姿势，基于将第二计测距离及第三计测距离相加而得到的第一合计距离和将第一计测距离及第四计测距离相加而得到的第二合计距离之间的差，控制绕滚动轴的姿势。

主权项

一种姿势控制方法，计测对圆管的内周面或外周面实施处理的处理装置和利用所述处理装置实施处理的所述圆管的处理面之间的间隙距离，控制所述处理装置相对于所述处理面的姿势，该姿势控制方法的特征在于，在所述处理装置中设置有多个距离计测装置，并且，至少任意四个距离计测装置以构成矩形的四个顶点的位置关系且面临所述处理面的方式配置，所述姿势控制方法具备如下的计测装置定位工序，在所述多个距离计测装置面临的所述处理面上，基于在所述处理面上沿管轴向延伸的第一假想分界线及沿与所述第一假想分界线正交的正交方向延伸的第二假想分界线，设定四个假想分割区域，所述四个假想分割区域由第一假想分割区域、在所述管轴向与所述第一假想分割区域邻接的第二假想分割区域、在所述正交方向与所述第一假想分割区域邻接的第三假想分割区域、以及在所述正交方向与所述第二假想分割区域邻接并且在所述管轴向与所述第三假想分割区域邻接的第四假想分割区域构成，所述任意四个距离计测装置中，使第一距离计测装置面临所述第一假想分割区域，使第二距离计测装置面临所述第二假想分割区域，使第三距离计测装置面临所述第三假想分割区域，使第四距离计测装置面临所述第四假想分割区域，所述姿势控制方法还具备如下的姿势控制工序，在所述姿势控制工序中，基于利用所述第一距离计测装置计测的第一计测距离减去利用所述第二距离计测装置计测的第二计测距离的差、和利用所述第三距离计测装置计测的第三计测距离减去利用所述第四距离计测装置计测的第四计测距离的差，控制绕俯仰轴的旋转方向上的所述处理装置的姿势，而且，在所述姿势控制工序中，基于所述第一计测距离减去所述第三计测距离的差、和所述第二计测距离减去所述第四计测距离的差，控制绕摇摆轴的旋转方向上的所述处理装置的姿势，并且，在所述姿势控制工序中，基于将所述第二计测距离与所述第三计测距离相加而得到的第一合计距离减去将所述第一计测距离与所述第四计测距离相加而得到的第二合计距离的差，控制绕滚动轴的旋转方向的所述处理装置的姿势，而且，所述俯仰轴是沿所述处理面的切线方向延伸的轴，所述摇摆轴是沿管轴向延伸的轴，所述滚动轴是沿所述处理装置和所述处理面离开的方向延伸的轴。