[发明专利]使物体和物体处于重合状态的机器人的机器人控制装置

摘要

本发明提供一种机器人控制装置，利用机器人更稳定快速地使一方物体与另一方物体相对地移动，以使一方物体与另一方物体成为一方物体的预定部分与另一方物体的预定部分接触而重合的状态即重合状态。机器人控制装置具备计测作用于两个物体之间的力的力计测部；设定并进力控制方向的并进力控制方向设定部；设定并进力控制目标力的并进力控制目标力设定部；设定旋转力控制轴的旋转力控制轴设定部；计算并进力控制方向目标移动量的并进力控制方向目标移动量计算部；计算绕旋转力控制轴目标移动量的绕旋转力控制轴目标移动量计算部；计算旋转方向目标移动量的目标方向目标移动量计算部；以及生成机器人的动作指令的动作指令生成部。

主权项

一种机器人控制装置，以使存在于机器人(50)的手前端部(51)的一方物体(21)相对于另一方物体(22)移动，使上述一方的预定部分与上述另一方的预定部分接触而成为重合的状态的方式，对作用于两者间的力进行控制，上述机器人控制装置(10)的特征在于，具备：力计测部(31)，其对作用于上述一方与上述另一方之间的力进行计测；并进力控制方向设定部(32)，其设定一个以上并进力控制方向，该并进力控制方向是基于作用于上述一方与上述另一方之间的力来使上述一方相对于上述另一方并进移动时的方向；并进力控制目标力设定部(33)，其对于各个上述并进力控制方向设定上述并进力控制方向上的作用于上述一方与上述另一方之间的力的目标值即并进力控制目标力；旋转力控制轴设定部(34)，其设定一个以上的基于作用于上述一方与上述另一方之间的力来使上述一方相对于上述另一方旋转移动时的旋转轴即旋转力控制轴，并设定上述旋转力控制轴中至少一个轴是与上述并进力控制方向不平行的轴；并进力控制方向目标移动量计算部(35)，其对基于作用于上述一方与上述另一方之间的力来使上述一方相对于上述另一方向上述并进力控制方向并进移动的移动量的目标值即并进力控制方向目标移动量进行计算；绕旋转力控制轴目标移动量计算部(36)，其对基于作用于上述一方与上述另一方之间的力来使上述一方相对于上述另一方绕上述旋转力控制轴的轴旋转移动的移动量的目标值即绕旋转力控制轴目标移动量进行计算；目标方向目标移动量计算部(37)，其基于作用于上述一方与上述另一方之间的力、由上述并进力控制方向设定部设定的上述并进力控制方向、由上述旋转力控制轴设定部设定的上述旋转力控制轴、由上述并进力控制方向目标移动量计算部计算的上述并进力控制方向目标移动量以及由上述绕旋转力控制轴目标移动量计算部计算的上述绕旋转力控制轴目标移动量，来对上述一方的并进方向的移动量的目标值即并进方向目标移动量以及上述一方的旋转方向的移动量的目标值即旋转方向目标移动量进行计算；以及动作指令生成部(38)，其基于由上述目标方向目标移动量计算部计算的上述并进方向目标移动量以及上述旋转方向目标移动量，生成上述机器人的动作指令，上述并进力控制方向目标移动量计算部构成为：在上述并进力控制方向上的作用于上述一方与上述另一方之间的力小于与并进力控制方向的力相关的第一预定阈值时，基于作为预定的移动量的第一并进力控制方向移动量，或者基于作为上述预定的移动量的第一并进力控制方向移动量以及上述并进力控制方向的上述并进力控制目标力，对上述并进力控制方向目标移动量进行计算；并且在上述并进力控制方向上的作用于上述一方与上述另一方之间的力为与上述并进力控制方向的力相关的第一预定阈值以上时，基于上述并进力控制方向上的作用于上述一方与上述另一方之间的力以及上述并进力控制方向的上述并进力控制目标力，或者基于上述并进力控制方向上的作用于上述一方与上述另一方之间的力以及上述并进力控制方向的上述并进力控制目标力以及作为预定的移动量的第二并进力控制方向移动量，对上述并进力控制方向目标移动量进行计算。