Device and method for controlling robot arm, robot, and robot arm control program
A control device ( 1 ) for a robot arm ( 8 ) which, if a person approach detection unit ( 3 ) detects approach of a person, performs control according to an impact between the robot arm ( 8 ) and the person. The control performed according to the impact is performed through an impact countermeasure motion control unit ( 4 ) and by setting individual mechanical impedances for respective joint portions of the robot arm ( 8 ) based on a movement of the person detected by a human movement detection unit ( 2 ).
1. A control device for controlling a multiple joint robot arm having at least two links, a first joint portion and a second joint portion, the control device comprising:
an impact position acquisition means for acquiring an impact position at which the multiple joint robot arm comes into contact with a person or a movable object; and
an impact countermeasure motion control means for controlling the multiple joint robot arm to perform an impact countermeasure motion, the impact countermeasure motion making a stiffness of one joint portion of the first joint portion and the second joint portion, which is closer to a base portion than a link, of the at least two links, to which the impact position belongs, lower than a stiffness of another joint portion of the first joint portion and the second joint portion, based on the acquired impact position at which the multiple joint robot arm comes into contact with the person or the movable object,
wherein the impact countermeasure motion control means controls the multiple joint robot arm to perform the impact countermeasure motion by one of (i) maintaining a stiffness of the another joint portion of the first joint portion and the second joint portion, closer to a wrist portion than the link, of the at least two links, to which the impact position belongs, and (ii) providing additional stiffness to the another joint portion closer to the wrist portion than the link, of the at least two links, to which the impact position belongs,
wherein the impact countermeasure motion control means comprises an impact countermeasure motion creating means and a motion control means,
wherein the impact countermeasure motion creating means determines joint desired mechanical impedance values of the first and second joint portions, respectively, at impact countermeasure orientations, and
wherein the motion control means performs an impedance control for controlling mechanical impedance values of the first and second joint portions, respectively, so as to realize the joint desired mechanical impedance values created by the impact countermeasure motion creating means.
2. A control device for controlling a multiple joint robot arm having at least two links, a first joint portion and a second joint portion, the control device comprising:
an impact position acquisition means for acquiring an impact position at which the multiple joint robot arm comes into contact with a person or a movable object; and
an impact countermeasure motion control means for controlling the multiple joint robot arm to perform an impact countermeasure motion, the impact countermeasure motion making a stiffness of one joint portion of the first joint portion and the second joint portion, which is closer to a base portion than a link, of the at least two links, to which the impact position belongs, lower than a stiffness of another joint portion of the first joint portion and the second joint portion, based on the acquired impact position at which the multiple joint robot arm comes into contact with the person or the movable object,
wherein the impact countermeasure motion control means controls the multiple joint robot arm to perform the impact countermeasure motion by one of (i) making the stiffness of the one joint portion of the first joint portion and the second joint portion, which is closer to the base portion than the link, of the at least two links, to which the impact position belongs, lower than the stiffness of the another joint portion of the first joint portion and the second joint portion, and maintaining the stiffness of the another joint portion of the first joint portion and the second joint portion, closer to a wrist portion than the link, of the at least two links, to which the impact position belongs, and (ii) providing additional stiffness to the another joint portion closer to the wrist portion than the link, of the at least two links, to which the impact position belongs,
wherein the impact countermeasure motion control means comprises an impact countermeasure motion creating means and a motion control means,
wherein the impact countermeasure motion creating means determines joint desired mechanical impedance values of the first and second joint portions, respectively, at impact countermeasure orientations, and
wherein the motion control means performs an impedance control for controlling mechanical impedance values of the first and second joint portions, respectively, so as to realize the joint desired mechanical impedance values created by the impact countermeasure motion creating means.
3. The control device as claimed in claim 1 , wherein parameters of the mechanical impedance values are an inertia, a viscosity, and a stiffness of the first joint portion and the second joint portion of the robot arm.
4. The control device as claimed in claim 2 , wherein parameters of the mechanical impedance values are an inertia, a viscosity, and a stiffness of the first joint portion and the second joint portion of the robot arm.