摘要:
A position/force control apparatus for use with a multi-freedom-degree working machine having at least two degrees of freedom such as a robot, a machine tool or the like. The apparatus is composed of the following components: first setting device for setting a position command and/or a posture command for commanding the position and/or the posture of a working tool on the machine; first detection device for detecting the instant position and/or the instant posture of the working tool; second setting device for setting a force command and/or a moment command for commanding the force and/or the moment to be applied to the working tool; second detection device for detecting the instant force and/or the instant moment acting on the working tool; first computing device for determining, from the position command and/or the posture command set by the first setting device and the instant position and/or the instant posture detected by the first detection device, the position and/or posture offset in terms of the coordinate values of a spontaneous coordinate system; second computing device for determining, from the force command and/or the moment command set by the second setting device and the instant force and/or the instant moment detected by the second detection device, force and/or moment offset in terms of the coordinate values of the. spontaneous coordinate system; third computing device for executing position/force computation for the control of the position of and the force on the working tool by making use of the position and/or posture offset in terms of the coordinate values of the spontaneous coordinate system as obtained through conversion performed by the first computing device and the force and/or moment offset in terms of the coordinate values of the spontaneous coordinate system as obtained through conversion performed by the second computing device, thereby determining the amount of control to be effected on the working machine; and fourth computing device for converting the control amount in terms of the coordinate values of the spontaneous coordinate system determined by the third computing device into the operation command of the driving system for driving the working machine.
摘要:
A profiling control system, which uses a multi-degree-of-freedom working machine having at least two degrees of freedom, comprising at least one force control loop including means for detecting force applied to a working tool from a work surface, means for taking an error between the detected force and a command f ro of urging force of the working tool, which is set beforehand, means for computing a velocity command u z of the working tool on the basis the error, and means for moving the multi-degree-of-freedom working machine on the basis of the velocity command u z , means for commanding at least one velocity command u x of the working tool, means for moving the multi-degree-of-freedom working machine on the basis of the velocity command u x . There are provided first control means for providing a moving velocity v zof in an urging direction, of the working tool, which occurs due to a gradient tan α of the work surface with respect to a feed direction when the working tool is fed with the velocity command u x while the working tool is urged against the work surface with the force command f ro , and second control means for using the moving velocity v zof in the urging direction to correct a controlled variable f ro or u z of the force control loop, thereby canceling force f of due to the velocity v zof .
摘要:
A profiling control system, which uses a multi-degree-of-freedom working machine having at least two degrees of freedom, comprising at least one force control loop including means for detecting force applied to a working tool from a work surface, means for taking an error between the detected force and a command f ro of urging force of the working tool, which is set beforehand, means for computing a velocity command u z of the working tool on the basis the error, and means for moving the multi-degree-of-freedom working machine on the basis of the velocity command u z , means for commanding at least one velocity command u x of the working tool, means for moving the multi-degree-of-freedom working machine on the basis of the velocity command u x . There are provided first control means for providing a moving velocity v zof in an urging direction, of the working tool, which occurs due to a gradient tan α of the work surface with respect to a feed direction when the working tool is fed with the velocity command u x while the working tool is urged against the work surface with the force command f ro , and second control means for using the moving velocity v zof in the urging direction to correct a controlled variable f ro or u z of the force control loop, thereby canceling force f of due to the velocity v zof .
摘要:
A position/force control apparatus for use with a multi-freedom-degree working machine having at least two degrees of freedom such as a robot, a machine tool or the like. The apparatus is composed of the following components: first setting device for setting a position command and/or a posture command for commanding the position and/or the posture of a working tool on the machine; first detection device for detecting the instant position and/or the instant posture of the working tool; second setting device for setting a force command and/or a moment command for commanding the force and/or the moment to be applied to the working tool; second detection device for detecting the instant force and/or the instant moment acting on the working tool; first computing device for determining, from the position command and/or the posture command set by the first setting device and the instant position and/or the instant posture detected by the first detection device, the position and/or posture offset in terms of the coordinate values of a spontaneous coordinate system; second computing device for determining, from the force command and/or the moment command set by the second setting device and the instant force and/or the instant moment detected by the second detection device, force and/or moment offset in terms of the coordinate values of the. spontaneous coordinate system; third computing device for executing position/force computation for the control of the position of and the force on the working tool by making use of the position and/or posture offset in terms of the coordinate values of the spontaneous coordinate system as obtained through conversion performed by the first computing device and the force and/or moment offset in terms of the coordinate values of the spontaneous coordinate system as obtained through conversion performed by the second computing device, thereby determining the amount of control to be effected on the working machine; and fourth computing device for converting the control amount in terms of the coordinate values of the spontaneous coordinate system determined by the third computing device into the operation command of the driving system for driving the working machine.