Control apparatus and method for master-slave robot, master-slave robot, control program, and integrated electronic circuit
View Patent ↗A control apparatus for a master-slave robot includes a force correction section detecting unit that detects a section at which force information from at least one of force information and speed information is corrected, and a force correcting unit that corrects the force information at a section detected as a force correction section by the force correction section detecting unit. A small external force applied to a slave manipulator is magnified and transmitted to a master manipulator, or an excessive manipulation force applied to the master manipulator is reduced and transmitted to the slave manipulator.
1. A control apparatus for a master-slave robot having a slave manipulator that grips an object and performs a task while touching an object to be worked, and a master manipulator that causes a person to remote-control the slave manipulator, the control apparatus comprising:
a speed information acquiring unit that acquires speed information of a hand of the slave manipulator;
a force information acquiring unit that acquires force information externally applied to the slave manipulator;
a force correction section detecting unit that detects a force correction section serving as information of a zone that is required to be corrected in the force information on the basis of (i) the force information acquired by the force information acquiring unit and (ii) the speed information acquired by the speed information acquiring unit;
a force correcting unit that corrects the force information in the zone detected by the force correction section detecting unit;
a force transmitting unit that transmits the force information from the force correcting unit to the master manipulator;
a master control unit that controls manipulation information of the master manipulator when the person manipulates the master manipulator on basis of the force information from the force transmitting unit; and
a slave control unit that is connected to the slave manipulator and the master control unit and outputs a control signal transmitting the manipulation information of the master manipulator sent from the master control unit to the slave manipulator,
wherein the force correction section detecting unit detects a force correction position serving as any one of (i) force information in a zone in which an absolute value of the force information is corrected so as to be increased and (ii) force information in a zone in which the force information is not corrected, from the force information acquired by the force information acquiring unit, and
wherein the force correcting unit corrects the force information so as to increase the absolute value of the force information detected by the force correction section detecting unit in the zone in which the absolute value is increased.
2. The control apparatus for a master-slave robot according to claim 1 , wherein a zone from a force correction start time to a force correction end time is defined as the force correction section, and the force information in the zone is represented by a curve or a straight line changing in a form of a chevron in a relationship between time and force.
3. A master-slave robot comprising the master manipulator, the slave manipulator, and the control apparatus for a master-slave robot according to claim 1 .
4. A control apparatus for a master-slave robot having a slave manipulator that grips an object and performs a task while touching an object to be worked, and a master manipulator that causes a person to remote-control the slave manipulator, the control apparatus comprising:
a speed information acquiring unit that acquires speed information of a hand of the slave manipulator;
a force information acquiring unit that acquires force information externally applied to the slave manipulator;
a force correction section detecting unit that detects a force correction section serving as information of a zone that is required to be corrected in the force information on the basis of (i) the force information acquired by the force information acquiring unit and (ii) the speed information acquired by the speed information acquiring unit;
a force correcting unit that corrects the force information in the zone detected by the force correction section detecting unit;
a force transmitting unit that transmits the force information from the force correcting unit to the master manipulator;
a master control unit that controls manipulation information of the master manipulator when the person manipulates the master manipulator on basis of the force information from the force transmitting unit;
a slave control unit that is connected to the slave manipulator and the master control unit and outputs a control signal transmitting the manipulation information of the master manipulator sent from the master control unit to the slave manipulator; and
a detecting method selecting unit that selects any one of (i) force information and speed information, (ii) speed information, and (iii) stored force information and speed information when the force correction section is detected in the force correction section detecting unit,
wherein on basis of the information selected by the detecting method selecting unit, the force correction section is detected by the force correction section detecting unit.
5. The control apparatus for a master-slave robot according to claim 4 ,
wherein the force correction section detecting unit,
when (i) the force information and speed information is selected from any one of (i) the force information and speed information, (ii) the speed information, and (iii) the stored force information and speed information in the detecting method selecting unit,
sets a time at which a displacement of the speed information acquired by the speed information acquiring unit exceeds a first threshold value, as a force correction start time,
sets a time at which a displacement of the force information acquired by the force information acquiring unit is lower than a second threshold value, as a force correction end time, and
detects a zone from the force correction start time to the force correction end time as the force correction section.
6. The control apparatus for a master-slave robot according to claim 4 ,
wherein the force correction section detecting unit,
when (ii) the speed information is selected from any one of (i) the force information and speed information, (ii) the speed information, and (iii) the stored force information and speed information in the detecting method selecting unit,
sets a time at which a displacement of the speed information acquired by the speed information acquiring unit exceeds a first threshold value, as a force correction start time,
sets a time at which a displacement of the speed information acquired by the speed information acquiring unit is lower than a second threshold value, as a force correction end time, and
detects a zone from the force correction start time to the force correction end time as the force correction section.
7. The control apparatus for a master-slave robot according to claim 4 , further comprising a storing unit that stores force information and speed information in advance,
wherein the force correction section detecting unit,
when (iii) the stored force information and speed information is selected from any one of (i) the force information and speed information, (ii) the speed information, and (iii) the stored force information and speed information in the detecting method selecting unit,
sets, as a force correction start time, a time at which a displacement of the force information or the speed information acquired by the force information acquiring unit or the speed information acquiring unit falls within a predetermined range with reference to a displacement of the force information or the speed information obtained when a displacement of the force information or the speed information stored in the storing unit exceeds a first threshold value,
sets, as a force correction end time, a time at which the displacement of the force information or the speed information acquired by the force information acquiring unit or the speed information acquiring unit falls within a predetermined range with reference to the displacement of the force information or the speed information obtained when the displacement of the force information or the speed information stored in the storing unit is lower than a second threshold value, and
detects a zone from the force correction start time to the force correction end time as the force correction section.
8. The control apparatus for a master-slave robot according to claim 4 , wherein a zone from a force correction start time to a force correction end time is defined as the force correction section, and the force information in the zone is represented by a curve or a straight line changing in a form of a chevron in a relationship between time and force.
9. A master-slave robot comprising the master manipulator, the slave manipulator, and the control apparatus for a master-slave robot according to claim 4 .
10. A control apparatus for a master-slave robot having a slave manipulator that grips an object and performs a task while touching an object to be worked, and a master manipulator that causes a person to remote-control the slave manipulator, the control apparatus comprising:
a speed information acquiring unit that acquires speed information of a hand of the slave manipulator;
a force information acquiring unit that acquires force information externally applied to the slave manipulator;
a force correction section detecting unit that detects a force correction section serving as information of a zone that is required to be corrected in the force information on the basis of (i) the force information acquired by the force information acquiring unit and (ii) the speed information acquired by the speed information acquiring unit;
a force correcting unit that corrects the force information in the zone detected by the force correction section detecting unit;
a force transmitting unit that transmits the force information from the force correcting unit to the master manipulator;
a master control unit that controls manipulation information of the master manipulator when the person manipulates the master manipulator on basis of the force information from the force transmitting unit;
a slave control unit that is connected to the slave manipulator and the master control unit and outputs a control signal transmitting the manipulation information of the master manipulator sent from the master control unit to the slave manipulator; and
a force correcting method selecting unit that selects any one of (i) object grip position information, (ii) object flexibility information, and (iii) master grip position information when a force is corrected in the force correcting unit,
wherein the force correcting unit corrects the force information by the force correcting method selected by the force correcting method selecting unit.
11. The control apparatus for a master-slave robot according to claim 10 , further comprising:
an object grip position acquiring unit that acquires position information for which the slave manipulator grips the objects; and
a correction amount storing unit that stores relationship information between the position information for which the slave manipulator grips the object and a correction amount,
wherein the force correcting unit,
when the object grip position information is selected from any one of (i) the object grip position information, (ii) the object flexibility information, and (iii) the master grip position information in the force correcting method selecting unit,
causes the object grip position acquiring unit to acquire grip position information for which the slave manipulator grips the object, and
determines a correction amount of the force information from the correction amount storing unit by using the grip position information acquired by the object grip position acquiring unit.
12. The control apparatus for a master-slave robot according to claim 10 , further comprising a correction amount storing unit that stores relationship information between flexibility information of the object and a correction amount,
wherein the force correcting unit,
when (ii) the object flexibility information is selected from any one of (i) the object grip position information, (ii) the object flexibility information, and (iii) the master grip position information in the force correcting method selecting unit,
acquires flexibility information of the object based on the object from the correction amount storing unit, and
calculates a correction amount of the force information from the correction amount storing unit by using the flexibility information.
13. The control apparatus for a master-slave robot according to claim 10 , further comprising:
a master grip position acquiring unit that acquires position information for which the person grips the master manipulator; and
a correction amount storing unit that stores relationship information between the position information for which the person grips the master manipulator and a correction amount, wherein
wherein the force correcting unit,
when (iii) the master grip position information is selected from any one of (i) the object grip position information, (ii) the object flexibility information, and (iii) the master grip position information in the force correcting method selecting unit,
acquires the position information for which the person grips the master manipulator in the master grip position information acquiring unit, and
calculates a correction amount of the force information from the correction amount storing unit by using the position information acquired from the master grip position information acquiring unit.
14. The control apparatus for a master-slave robot according to claim 10 , wherein a zone from a force correction start time to a force correction end time is defined as the force correction section, and the force information in the zone is represented by a curve or a straight line changing in a form of a chevron in a relationship between time and force.
15. A master-slave robot comprising the master manipulator, the slave manipulator, and the control apparatus for a master-slave robot according to claim 10 .
16. A control method for a control apparatus for a master-slave robot having a slave manipulator that grips an object and performs a task while touching an object to be worked, and a master manipulator that causes a person to remote-control the slave manipulator, the control method comprising:
acquiring, using a speed information acquiring unit, speed information of a hand of the slave manipulator;
acquiring, using a force information acquiring unit, force information externally applied to the slave manipulator;
detecting, using a force correction section detecting unit implemented using a processor, a force correction section serving as information of a zone that is required to be corrected in the force information on the basis of (i) the force information acquired by the force information acquiring unit and (ii) the speed information acquired by the speed information acquiring unit;
correcting, using a force correcting unit, the force information in the zone detected by the force correction section detecting unit;
transmitting, using a force transmitting unit, the force information from the force correcting unit to the master manipulator;
controlling, using a master control unit, manipulation information of the master manipulator when the person manipulates the master manipulator on basis of the force information from the force transmitting unit;
outputting, using a slave control unit that is connected to the slave manipulator and the master control unit, a control signal transmitting the manipulation information of the master manipulator sent from the master control unit to the slave manipulator,
wherein the control method further comprises detecting, using the force correction section detecting unit, a force correction position serving as any one of (i) force information in a zone in which an absolute value of the force information is corrected so as to be increased and (ii) force information in a zone in which the force information is not corrected, from the force information acquired by the force information acquiring unit, and
wherein the force correcting unit corrects the force information so as to increase the absolute value of the force information detected by the force correction section detecting unit in the zone in which the absolute value is increased.
17. A control method for a control apparatus for a master-slave robot having a slave manipulator that grips an object and performs a task while touching an object to be worked, and a master manipulator that causes a person to remote-control the slave manipulator, the control method comprising:
acquiring, using a speed information acquiring unit, speed information of a hand of the slave manipulator;
acquiring, using a force information acquiring unit, force information externally applied to the slave manipulator;
detecting, using a force correction section detecting unit implemented using a processor, a force correction section serving as information of a zone that is required to be corrected in the force information on the basis of (i) the force information acquired by the force information acquiring unit and (ii) the speed information acquired by the speed information acquiring unit;
correcting, using a force correcting unit, the force information in the zone detected by the force correction section detecting unit;
transmitting, using a force transmitting unit, the force information from the force correcting unit to the master manipulator;
controlling, using a master control unit, manipulation information of the master manipulator when the person manipulates the master manipulator on basis of the force information from the force transmitting unit;
outputting, using a slave control unit that is connected to the slave manipulator and the master control unit, a control signal transmitting the manipulation information of the master manipulator sent from the master control unit to the slave manipulator; and
selecting, using a detecting method selecting unit, any one of (i) force information and speed information, (ii) speed information, and (iii) stored force information and speed information when the force correction section is detected in the force correction section detecting unit,
wherein on basis of the information selected by the detecting method selecting unit, the force correction section is detected by the force correction section detecting unit.
18. A control method for a control apparatus for a master-slave robot having a slave manipulator that grips an object and performs a task while touching an object to be worked, and a master manipulator that causes a person to remote-control the slave manipulator, the control method comprising:
acquiring, using a speed information acquiring unit, speed information of a hand of the slave manipulator;
acquiring, using a force information acquiring unit, force information externally applied to the slave manipulator;
detecting, using a force correction section detecting unit implemented using a processor, a force correction section serving as information of a zone that is required to be corrected in the force information on the basis of (i) the force information acquired by the force information acquiring unit and (ii) the speed information acquired by the speed information acquiring unit;
correcting, using a force correcting unit, the force information in the zone detected by the force correction section detecting unit;
transmitting, using a force transmitting unit, the force information from the force correcting unit to the master manipulator;
controlling, using a master control unit, manipulation information of the master manipulator when the person manipulates the master manipulator on basis of the force information from the force transmitting unit;
outputting, using a slave control unit that is connected to the slave manipulator and the master control unit, a control signal transmitting the manipulation information of the master manipulator sent from the master control unit to the slave manipulator; and
selecting, using a force correcting method selecting unit, any one of (i) object grip position information, (ii) object flexibility information, and (iii) master grip position information when a force is corrected in the force correcting unit,
wherein the force correcting unit corrects the force information by the force correcting method selected by the force correcting method selecting unit.