Apparatus for effecting coordinated position/force control for a manipulator

摘要

A force and moment which a manipulator receives from an external environment is detected, and this detected value is multiplied by a gain inversely proportional to a virtual spring constant set by a tool coordinate system, and the product is further converted to a value in each joint coordinate system of the manipulator so as to determine a detection torque. A command value of force and moment is converted to a value in each joint coordinate value of the manipulator in the same way as described above, so as to determine a command torque. A difference between a position command value and a position detection value is multiplied by a virtual spring constant in each joint coordinate system of the manipulator obtained by converting the virtual spring constant, and a differential torque is obtained by converting the aforementioned difference to a force and moment corresponding to the difference. A targeted torque is determined by adding the command torque and the differential torque, and feedback control is effected such that the detected torque of each joint of the manipulator coincides with the targeted torque.