WO2022024238A1 - 力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム - Google Patents

力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム Download PDF

Info

Publication number
WO2022024238A1
WO2022024238A1 PCT/JP2020/028975 JP2020028975W WO2022024238A1 WO 2022024238 A1 WO2022024238 A1 WO 2022024238A1 JP 2020028975 W JP2020028975 W JP 2020028975W WO 2022024238 A1 WO2022024238 A1 WO 2022024238A1
Authority
WO
WIPO (PCT)
Prior art keywords
operator
force
master
slave
contact
Prior art date
Application number
PCT/JP2020/028975
Other languages
English (en)
French (fr)
Inventor
優次 森西
慈郎 長尾
建 井阪
有信 新島
Original Assignee
日本電信電話株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日本電信電話株式会社 filed Critical 日本電信電話株式会社
Priority to PCT/JP2020/028975 priority Critical patent/WO2022024238A1/ja
Publication of WO2022024238A1 publication Critical patent/WO2022024238A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/02—Hand grip control means
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J3/00—Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction
    • G05D3/12—Control of position or direction using feedback

Definitions

  • the present invention relates to a force-tactile control system, a master device, a slave device, a force-tactile control method, and a force-tactile control program.
  • the force-tactile control system disclosed in Non-Patent Document 1 is known.
  • the user's two hands and two feet are operated by associating the user's foot on the master side with the robot hand on the slave side. It is disclosed that the work can be performed with a total of four hands, two robot hands operated by.
  • MetaLimbs MultipleArms Interaction Metamorphism. https://star.rcast.u-tokyo.ac.jp/metalimbs/
  • Non-Patent Document 1 there is a one-to-one correspondence between the operator provided on the master side and the robot hand to be controlled, which is provided on the slave side. Therefore, the number of robot hands that can be remotely controlled is limited. For example, since the operator's two hands and two feet can perform complicated movements, the four robot hands are operated by operating the four limbs, and each robot hand is an object (for example,). You can get the feeling when you come in contact with the subject).
  • the present invention has been made in view of the above circumstances, and an object thereof is a force-tactile sensation capable of operating a controlled object with a simple operation by an operator and obtaining a feeling of contact with the object. It is an object of the present invention to provide a control system, a master device, a slave device, a force-tactile control method, and a force-tactile control program.
  • the force-tactile control system of one aspect of the present invention is a master device that controls an operator that is displaced by an operator's operation, and a slave device that is connected to the master device and controls a controlled object that is displaced by contact with an object.
  • the master device is provided with a master-side actuator that generates a force-tactile sensation in the operator, and a master that outputs a control signal for force-tactile sensation to the master-side actuator according to the amount of displacement of the controlled object.
  • the slave device includes a control unit, and the slave device outputs a control signal for generating force and tactile sensation to the slave side actuator according to the displacement amount of the actuator and the slave side actuator that generates force and tactile sensation in the controlled object.
  • One of the master control unit and the slave control unit generates a constant reaction force on the operator when the control target is not in contact with the object.
  • a control signal for generating a force-tactile sensation to the operator is output to the master side actuator in addition to the constant reaction force. ..
  • the master device of one aspect of the present invention is a master device connected to a slave device that controls a controlled object that is displaced by contact with an object, and has an actuator that is displaced by an operator's operation and the actuator.
  • the master control unit includes a master-side actuator that generates a force-tactile sensation and a master control unit that outputs a control signal for force-tactile sensation to the master-side actuator according to the displacement amount of the controlled object.
  • a constant reaction force is generated in the actuator, and when the controlled object is in contact with the object, the actuator is added to the constant reaction force. It is characterized by outputting a control signal for generating a force-tactile sensation.
  • the slave device of one aspect of the present invention is a slave device connected to a master device having an actuator that is displaced by an operator's operation, and generates a force-tactile sensation in a controlled object that is displaced by contact with an object.
  • the slave control unit includes a slave control unit that outputs a control signal for generating force and tactile sensation to the slave side actuator according to the displacement amount of the operator.
  • the slave control unit has the control target as the target. When the actuator is not in contact with an object, a constant reaction force is generated in the actuator, and when the controlled object is in contact with the object, a force tactile sensation is generated in the actuator in addition to the constant reaction force. It is characterized in that a control signal for causing the displacement is output to the master device.
  • the force-tactile control method of one aspect of the present invention is mounted on a master device, and when an operator that is displaced by an operator's operation is operated, the force-tactile sensation corresponding to the displacement amount of the operator is obtained by the master device.
  • a constant reaction force is generated in the operator
  • the controller is in contact with the control target. It is characterized by comprising a step of applying the constant reaction force to the force-tactile sensation corresponding to the displacement amount displaced by the contact with the above-mentioned.
  • One aspect of the present invention is a force-tactile control program for operating a computer as the master device.
  • One aspect of the present invention is a force-tactile control program for operating a computer as the slave device.
  • FIG. 1 is an explanatory diagram showing a schematic configuration of a force-tactile control system according to an embodiment of the present invention.
  • FIG. 2 is a block diagram showing a configuration of a force-tactile control system according to an embodiment of the present invention.
  • FIG. 3 is an explanatory diagram showing a state when the operator adopted in the force-tactile control system according to the present embodiment is expanded and contracted.
  • FIG. 4 is a graph showing changes in the force generated in the operator.
  • FIG. 5 is a flowchart showing a process of creating a conversion table.
  • FIG. 6 is a flowchart showing the operation of the force-tactile control system according to the present embodiment.
  • FIG. 7 is a block diagram showing a functional configuration of the force-tactile control system according to the present invention.
  • FIG. 1 is an explanatory diagram showing a schematic configuration of a force-tactile control system according to an embodiment of the present invention
  • FIG. 2 is a block diagram showing a configuration of a force-tactile control system according to the present embodiment.
  • the operator P1 operates the actuator 11 (for example, a piston) that is displaced in one dimension to the robot hand 21 (controlled object).
  • a plurality of actuators 23 (23-1 to 23-n) provided are controlled to operate the robot hand 21.
  • a pseudo handshake is performed with the target person P2 in a remote place.
  • the plurality of sensors 22 (22-1 to 22-n) provided on the robot hand 21 to the operator 11, the feeling that the operator P1 is shaking hands with the target person P2.
  • the force-tactile control system 100 includes a master device 1 and a slave device 2 connected to the master device 1 via a network 3.
  • the master device 1 includes an operator 11, a sensor 12 (master side sensor), an actuator 13 (master side actuator), and a master control unit 14.
  • the operator 11 is a tactile device that can be easily operated by the operator P1 with one hand, one foot, or the like, and is, for example, a piston that can reciprocate in one-dimensional direction.
  • the operator 11 can also be an accelerator pedal of a vehicle, for example, when it is operated by a foot.
  • the operator 11 can also use a dial-type knob if pressurization and feedback are possible.
  • FIG. 1 for the sake of simplification of the description, in the present embodiment, a plurality of operators 11 are provided. For example, there may be a total of six operators, four operators 11 operated by both hands and feet of the operator P1, and two operators operated by the mouth and armpits of the operator P1. Further, it is also possible to operate the operator 11 by the movement of the eyelids and the abdomen of the operator P1.
  • the sensor 12 detects the amount of displacement of the operator 11.
  • the tactile device is a piston that reciprocates in one-dimensional direction
  • the amount of displacement of the piston in one-dimensional direction is detected.
  • the actuator 13 operates the operator 11 by generating a force-tactile sensation in the one-dimensional direction, that is, in the direction in which the operator 11 is contracted or extended. Specifically, the actuator 11 is operated in the one-dimensional direction based on the control command value output from the actuator control unit 141, which will be described later.
  • the control command value is, for example, a voltage value or a current value signal.
  • the master control unit 14 includes an actuator control unit 141, a sensor control unit 142, a calculation unit 143, a storage unit 144, and a communication unit 145.
  • the sensor control unit 142 acquires the detection signal detected by the sensor 12.
  • the detection signal includes information on the displacement amount of the operator 11.
  • the calculation unit 143 acquires the displacement amount detected by each sensor 22 (22-1 to 22-m) (details will be described later) that is installed in the slave device 2 and detects the displacement amount of the robot hand 21, and this displacement.
  • a control amount for controlling the actuator 13 (hereinafter referred to as “master control amount”” is calculated based on the amount.
  • the calculation unit 143 outputs the calculated control amount to the actuator control unit 141.
  • the calculation unit 143 also acquires information on whether or not the robot hand 21 is in contact with the target person P2 from the sensor control unit 242 provided in the slave device 2. Alternatively, it is determined whether or not the robot hand 21 is in contact with the target person P2 based on the detection signal detected by each sensor 22 provided in the slave device 2. The calculation unit 143 outputs a control amount for generating a constant reaction force to the actuator 11 to the actuator control unit 141 when the robot hand 21 is not in contact with the target person P2. The details of the method of calculating the control amount by the calculation unit 143 will be described later.
  • the actuator control unit 141 calculates a control command value (control signal) for operating the actuator 13 based on the control amount calculated by the calculation unit 143.
  • the calculated control command value is output to the actuator 13.
  • the actuator 13 Based on this control command value, the actuator 13 generates a force for operating the actuator 11 in a one-dimensional direction, that is, in a contraction direction or an extension direction. That is, the actuator control unit 141 mounted on the master control unit 14 outputs a control signal for generating a force-tactile sensation to the actuator 13 according to the displacement amount of the robot hand 21.
  • the storage unit 144 has a displacement amount when the operator 11 is operated in the one-dimensional direction, that is, a displacement amount when the operator 11 is contracted or extended, and a displacement amount of the robot hand 21. Memorize the correspondence table showing the relationship between.
  • the operator P1 displaces the operator 11 from the most extended state to the contracted state, and calculates the relationship between the displacement amount when the operator P1 is displaced to the most contracted state and the displacement amount of the robot hand 21.
  • a correspondence table showing the relationship between the displacement amounts is stored. By setting the correspondence table, the displacement amount of the operator 11 when the operator P1 operates the operator 11 can be converted into the displacement amount of the robot hand 21.
  • the corresponding table can also be stored in the storage unit 244 of the slave device 2.
  • the storage unit 144 is composed of a recording medium such as a RAM, a ROM, or a hard disk.
  • the communication unit 145 communicates with the slave device 2 via the network 3.
  • the slave device 2 includes a robot hand 21, which is an operation target device, a sensor 22 (slave side sensor), an actuator 23 (slave side actuator), and a slave control unit 24.
  • the robot hand 21 has, for example, five fingers and a plurality of (for example, ten) joints, and each joint moves to simulate the movement of a human hand, for example.
  • Actuators 23 (23-1 to 23-n) are provided in each joint, and the robot hand 21 shakes hands with, for example, the subject P2 by operating the actuator 23.
  • an example including n actuators 23 is shown.
  • one robot hand 21 is described for the sake of simplification of the explanation, but in the present embodiment, a plurality of robot hands 21 are provided.
  • the robot hand 21 corresponds to the number of operators 11. Can be six.
  • Sensors 22 (22-1 to 22-m) are installed, for example, in the joints of the robot hand 21, and detect the displacement amount of the robot hand 21. Specifically, the displacement amount of each joint due to the operation of the actuator 23 and the displacement amount due to the contact of the robot hand 21 with the object are detected.
  • the hand of the subject P2 will be described as an example of the object with which the robot hand 21 comes into contact.
  • the actuator 23 operates a plurality of (for example, n) joints provided on the robot hand 21.
  • the arithmetic unit 243 outputs a signal of a control amount for controlling the actuator 23 (“slave control amount” described later)
  • the actuator 23 generates a force-tactile sensation according to the slave control amount.
  • the robot hand 21 operates by generating a force-tactile sensation in the actuator 23.
  • the robot hand 21 can be operated so that the robot hand 21 shakes hands with the target person P2.
  • the slave control unit 24 includes an actuator control unit 241, a sensor control unit 242, a calculation unit 243, a storage unit 244, and a communication unit 245.
  • the sensor control unit 242 acquires the detection signal detected by the sensor 22.
  • the detection signal includes information on the amount of displacement of each joint of the robot hand 21. Further, the sensor control unit 242 determines that, for example, when the robot hand 21 shakes hands with the target person P2, the robot hand 21 has touched the hand of the target person P2.
  • the calculation unit 243 is mounted on the master device 1 and acquires the displacement amount detected by the sensor 12 that detects the displacement amount of the operator 11, and the control amount for controlling the robot hand 21 based on this displacement amount. (Hereinafter referred to as "slave control amount”) is calculated.
  • the actuator control unit 241 is a control command for operating each of the n actuators 23 (23-1 to 23-n) based on the control amount (slave control amount) calculated by the calculation unit 143 of the master device 1. Calculate the value (control signal). The actuator control unit 241 outputs the calculated control command value to each actuator 23. Each actuator 23 operates each joint of the robot hand 21 in a desired direction based on the control command value. That is, the actuator control unit 241 mounted on the slave control unit 24 outputs a control signal for generating a force-tactile sensation to the actuator 23 according to the displacement amount of the actuator 11.
  • the storage unit 244 temporarily stores data in the arithmetic processing in the actuator control unit 241, the sensor control unit 242, and the arithmetic unit 243.
  • the storage unit 244 is composed of a recording medium such as a RAM, a ROM, or a hard disk.
  • the communication unit 245 communicates with the master control unit 14 via the network 3.
  • FIG. 3 is an explanatory diagram showing a state when the operator 11 is expanded and contracted.
  • FIG. 4 is a graph showing changes in the force f (t) generated in the operator 11 in the sections X1, X2, and X3 shown in FIG.
  • the calculation unit 143 generates a constant reaction force on the operator 11 when the robot hand 21 is not in contact with the target person P2. That is, when the operator displaces the actuator 11 in the contraction direction, a constant reaction force is generated in the direction facing the displacement. Further, when the operator displaces the actuator 11 in the extension direction, a constant reaction force is generated in the same direction as the displacement. Whether or not the robot hand 21 is in contact with the target person P2 can be determined based on the detection signal of each sensor 22 acquired by the sensor control unit 242.
  • the calculation unit 143 When the robot hand 21 is in contact with the target person P2, the calculation unit 143 generates the above-mentioned constant reaction force on the operator 11, and the target person P2 applies a force to the robot hand 21. Generates force and tactile sensation.
  • the calculation unit 143 calculates a control amount for generating the above-mentioned force in the operator 11, and outputs the control amount to the actuator control unit 141.
  • the operator P1 presses the operator P1 to gradually contract the operator 11 from the most extended state (p1), and then reaches the most contracted state (p5).
  • the operation until the operator P1 relaxes the pressure, gradually expands the pressure, and returns to the most extended state (p9) is shown.
  • the robot hand 21 that operates with the movement of the operator 11 does not come into contact with the target person P2 in the section X1 in which the displacement amount of the operator 11 is from the state p1 to p3. .. Further, it is assumed that the robot hand 21 is in contact with the target person P2 in the section X2 in which the displacement amount of the operator 11 is from the state p3 to p7. It is assumed that the robot hand 21 is not in contact with the target person P2 in the section X3 where the displacement amount of the operator 11 is from the state p7 to p9.
  • the operator P1 can get the feeling of operating the robot hand 21 and shaking hands with the target person P2 in a pseudo manner by a simple operation of expanding and contracting the operator 11 that operates in the one-dimensional direction.
  • the robot hand 21 does not come into contact with the target person P2, as shown in the graph q4 of FIG. 4, the state in which a constant reaction force "a" is generated in the operator 11 is continued.
  • the present invention is not limited to this and is provided in the slave device 2. It may be calculated by the calculation unit 243. That is, in either the master control unit 14 or the slave control unit 24, when the control target (robot hand 21) is not in contact with the target object (target person P2), a constant reaction force is generated in the actuator 11. In addition to the force and tactile sensation generated by the actuator 11 when the controlled object is in contact with the object, a control signal for generating a constant reaction force is calculated and this control signal is output to the actuator 13. can do.
  • step S11 of FIG. 5 the arithmetic unit 143 sets the state when the operator P1 is not operating the operator 11, that is, the state where the displacement amount of the operator 11 is zero (the state of p1 in FIG. 3). Corresponds to the state where the displacement amount of the robot hand 21 is zero.
  • the robot hand 21 is open and is not in contact with the subject P2. That is, the robot hand 21 is in a fully opened state.
  • step S12 the arithmetic unit 143 is in a state when the operator P1 maximizes the displacement amount of the operator 11, that is, when the one-dimensionally displaced operator 11 contracts to the maximum (p5 in FIG. 3).
  • the state) corresponds to the state in which the displacement amount of the robot hand 21 is maximized.
  • the robot hand 21 is in a fully closed state.
  • step S13 the calculation unit 143 creates a correspondence table showing the relationship between the displacement amount of the operator 11 and the displacement amount of the robot hand 21.
  • step S14 the calculation unit 143 stores the corresponding table created in step S13 in the storage unit 144.
  • the correspondence table showing the correspondence relationship between the displacement amount of the operator 11 and the displacement amount of the robot hand 21 is stored in the storage unit 144.
  • the corresponding table may be stored in the storage unit 244 of the slave device 2.
  • FIG. 6 shows an example in which the operator P1 controls the robot hand 21 using the force-tactile control system 100 and shakes hands with the target person P2 in a pseudo manner using the robot hand 21.
  • step S31 of FIG. 6 the master control unit 14 waits for the operation of the operator 11 to start.
  • step S32 the master control unit 14 determines whether or not the operator 11 has started the operation.
  • the operator P1 contracts the operator 11 with, for example, his / her right hand, the operator 11 starts the operation. If the operator 11 starts the operation (S32; YES), the process proceeds to step S33, and if not (S32; NO), the process returns to step S31.
  • step S33 the master control unit 14 controls the displacement amount of the robot hand 21 based on the displacement amount of the operator 11 detected by the sensor 12. Specifically, the actuator 23 is controlled to operate the joint of the robot hand 21, and the robot hand 21 is operated in the direction of shaking hands with the target person P2.
  • the storage unit 144 stores a correspondence table showing the correspondence between the displacement amount of the operator 11 and the displacement amount of the robot hand 21, and the robot hand 21 can refer to this correspondence table.
  • the amount of displacement is controlled to be a desired amount of displacement.
  • step S34 the slave control unit 24 determines whether or not the robot hand 21 has come into contact with the hand of the target person P2. Specifically, it is determined whether or not the robot hand 21 has come into contact with the hand of the target person P2 based on the detection signal of each sensor 22 mounted on the robot hand 21. If it is determined that the robot hand 21 has touched the hand of the target person P2 (S34; YES), the process proceeds to step S36, and if not (S34; NO), the process proceeds to step S35.
  • step S35 the master control unit 14 generates a constant reaction force on the operator 11. That is, the master control unit 14 is constant to the operator 11 in a state where the operator 11 starts to contract and the robot hand 21 that operates according to the displacement amount of the operator 11 is not in contact with the target person P2. Generates a reaction force of. Specifically, as described in the section X1 of FIGS. 3 and 4 described above, the master control unit 14 generates a constant reaction force “a” in the operator 11. Therefore, the operator P1 feels a reaction force due to the operator 11 in the section X1.
  • step S36 the master control unit 14 and the slave control unit 24 perform force-tactile control.
  • the actuator 23 is controlled to operate the robot hand 21 based on the displacement amount of the operator 11 detected by the sensor 12 of the master device 1. Further, the amount of displacement caused by the robot hand 21 coming into contact with the target person P2 is detected by the sensor 22 of the slave device 2, and control is performed to generate a force-tactile sensation in the operator 11 according to the amount of displacement. Since force-tactile control is a well-known technique, detailed description thereof will be omitted.
  • step S37 the slave control unit 24 determines whether or not the robot hand 21 has left the hand of the target person P2. Specifically, based on the detection signal of each sensor 22, it is determined whether or not the robot hand 21 has left the hand of the target person P2. If it is determined that the robot hand 21 has left the hand of the target person P2 (S37; YES), the process proceeds to step S38, and if not (S37; NO), the process returns to step S36.
  • step S38 the master control unit 14 generates a constant reaction force on the operator 11. That is, when the operator 11 starts to extend and the robot hand 21 is separated from the target person P2, the master control unit 14 generates a constant reaction force on the operator 11. Specifically, as described in the section X3 of FIGS. 3 and 4 described above, the master control unit 14 generates a constant reaction force “a” in the operator 11.
  • step S39 the slave control unit 24 controls the displacement amount of the robot hand 21 according to the displacement amount of the operator 11. Specifically, the actuator 23 is controlled to operate the joints of the robot hand 21, and the robot hand 21 is controlled to be expanded.
  • step S40 the master control unit 14 determines whether or not the operator 11 has been extended to the maximum based on the detection signal of the sensor 12. That is, it is determined whether or not the state p9 shown in FIG. 3 has been reached. If the operator 11 is extended to the maximum (S40; YES), this process is terminated, otherwise (S40; NO), the process is returned to step S39.
  • the force-tactile control system 100 of the present embodiment is connected to a master device 1 having an operator 11 that is displaced by the operation of the operator P1 and the master device 1 and is displaced by contact with an object (object P2).
  • a slave device 2 for controlling a control target (robot hand 21) is provided, and the master device 1 includes a master side actuator 13 that generates a force-tactile sensation in the operator 11, and a displacement amount of the control target.
  • the master control unit 14 that outputs a control signal for generating a force tactile sensation is provided on the master side actuator 13, and the slave device 2 includes a slave side actuator 23 that generates a force tactile sensation on the controlled object and the operator.
  • a slave control unit 24 that outputs a control signal for generating force and tactile sensation to the slave side actuator 23 according to the amount of displacement of 11 is provided, and one of the master control unit 14 and the slave control unit 24 is provided.
  • a constant reaction force is generated in the operator 11
  • a control signal for generating a force-tactile sensation to the operator 11 is output to the master-side actuator 13.
  • force-tactile control is performed between the operator 11 and the robot hand 21, and further, when the robot hand 21 is not in contact with the target person P2, the operation is performed. A constant reaction force is generated in the child 11.
  • the operator P1 when the operator P1 operates the operator 11 and indirectly shakes hands with the target person P2 using the robot hand 21, the operation is performed even when the robot hand 21 is not in contact with the target person P2. A certain reaction force is generated in the child 11. Therefore, the operator P1 can easily operate the robot hand 21 by operating the operator 11 using a portion such as a mouth or armpit that is difficult to extend by his / her own force. As a result, it is possible to shake hands with the subject P2 in a pseudo manner using the mouth or armpit.
  • the robot hand 21 is not in contact with the target person P2, no reaction force is generated in the robot hand 21, and the corresponding reaction force is not generated in the operator 11. Therefore, the robot hand 21 and the robot hand 21 are used. When the contact with the target person P2 is completed, the spread of the robot hand 21 is stopped. On the other hand, in the present embodiment, when the robot hand 21 is not in contact with the target person P2, a reaction force is generated in the operator 11, so that the robot hand 21 can be expanded.
  • a pseudo handshake with the target person P2 can be performed by a simple operation of expanding and contracting the operator 11 that is displaced in the one-dimensional direction. That is, it is possible to realize a complicated operation of the robot hand 21 without requiring a complicated operation by the operator P1.
  • one-dimensional displacements such as mouth movements, armpit movements, eyelid movements, abdominal movements, etc. can be performed on a wide range of parts other than the four limbs. It is possible to shake hands with the target person P2 by the robot hand 21 by using the movement of the portion that can be generated. Therefore, the operator can shake hands at the same time with many target persons (for example, five or more people) at the same time. In addition to shaking hands, for example, it is possible to give a high five to a plurality of subjects at the same time.
  • the artist can shake hands or give a high five with multiple fans in the main venue and the remote venue at the same time.
  • robot hand 21 is controlled by one operator 11, but also two robot hands 21 can be controlled at the same time to shake hands with the target person P2 with both hands.
  • the robot hand 21 is provided with an emergency stop device for preventing an unexpected operation when an unexpected operation occurs due to a failure of the sensor 22 or the like.
  • an emergency stop device for preventing an unexpected operation when an unexpected operation occurs due to a failure of the sensor 22 or the like.
  • the force-tactile control system 100 of the present embodiment described above includes, for example, a CPU (Central Processing Unit, processor) 901, a memory 902, and a storage 903 (HDD: HardDiskDrive, SSD: SolidStateDrive). ), A communication device 904, an input device 905, and a general-purpose computer system including an output device 906 can be used.
  • the memory 902 and the storage 903 are storage devices.
  • each function of the force-tactile control system 100 is realized by the CPU 901 executing a predetermined program loaded on the memory 902.
  • the force-tactile control system 100 may be mounted on one computer or may be mounted on a plurality of computers. Further, the force-tactile control system 100 may be a virtual machine mounted on a computer.
  • the program for the force-tactile control system 100 can also be stored in a computer-readable recording medium such as an HDD, SSD, USB (Universal Serial Bus) memory, CD (Compact Disc), or DVD (Digital Versatile Disc). It can also be delivered over the network.
  • a computer-readable recording medium such as an HDD, SSD, USB (Universal Serial Bus) memory, CD (Compact Disc), or DVD (Digital Versatile Disc). It can also be delivered over the network.
  • the present invention is not limited to the above embodiment, and many modifications can be made within the scope of the gist thereof.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

操作子（１１）を備えたマスタ装置（１）と、ロボットハンド（２１）を制御するスレーブ装置（２）を備える。マスタ装置（１）は、操作子（１１）に力触覚を発生させるアクチュエータ（１３）と、ロボットハンド（２１）の変位量に応じて、アクチュエータ（１３）に力触覚発生用の制御信号を出力するマスタ制御部（１４）を備える。スレーブ装置（２）は、ロボットハンド（２１）に力触覚を発生させるアクチュエータ（２３）と、操作子（１１）の変位量に応じて、アクチュエータ（２３）に力触覚発生用の制御信号を出力するスレーブ制御部（２４）を備える。マスタ制御部（１４）は、ロボットハンド（２１）が対象者に接触していないときには操作子（１１）に一定の反力を発生させる。接触しているときには、一定の反力に加えて力触覚を発生させる。

Description

力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム
　本発明は、力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラムに関する。
　非特許文献１に開示された力触覚制御システムが知られている。非特許文献１に開示された力触覚制御システムでは、マスタ側となるユーザの足を、スレーブ側となるロボットハンドに対応付けて作動させることにより、ユーザの２本の手、及び２本の足で作動する２つのロボットハンド、の合計４本の手で作業を実施できることが開示されている。
：MetaLimbs: MultipleArms Interaction Metamorphism。https://star.rcast.u-tokyo.ac.jp/metalimbs/
　非特許文献１に開示された力触覚制御システムでは、マスタ側に設けられる操作子と、スレーブ側に設けられる制御対象であるロボットハンドが１対１の対応となっている。このため、遠隔操作が可能なロボットハンドの数が限定される。例えば、操作者の２本の手、及び２本の足は複雑な動きが可能であるので、４本の手足の操作により４つのロボットハンドを操作して、各ロボットハンドが対象物（例えば、対象者）と接触したときの感触を得ることができる。
　しかし、操作者の４本の手足以外の部位を用いて複雑な操作を行うことが難しいので、遠隔地に設置されている多くのロボットハンドを同時に操作して、各ロボットハンドが対象者と接触したときの感触を得ることは難しい。
　このため、例えば操作者が遠隔地に居る複数の対象者と、ロボットハンドを用いて疑似的に握手やハイタッチをする場合には、操作者の４本の手足を用いて４つのロボットハンドを操作することにより、４人の対象者から握手やハイタッチの感触を得ることができる。しかし、これを超える人数の対象者から握手やハイタッチの感触を同時に得ることは難しい。
　本発明は、上記事情に鑑みてなされたものであり、その目的とするところは、操作者による簡単な操作で制御対象を操作して、対象物と接触した感触を得ることが可能な力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、力触覚制御プログラムを提供することにある。
　本発明の一態様の力触覚制御システムは、操作者の操作により変位する操作子を制御するマスタ装置と、前記マスタ装置に接続され、対象物との接触により変位する制御対象を制御するスレーブ装置と、を備え、前記マスタ装置は、前記操作子に力触覚を発生させるマスタ側アクチュエータと、前記制御対象の変位量に応じて、前記マスタ側アクチュエータに力触覚発生用の制御信号を出力するマスタ制御部と、を備え、前記スレーブ装置は、前記制御対象に力触覚を発生させるスレーブ側アクチュエータと、前記操作子の変位量に応じて、前記スレーブ側アクチュエータに力触覚発生用の制御信号を出力するスレーブ制御部と、を備え、前記マスタ制御部、及び前記スレーブ制御部のいずれか一方は、前記制御対象が前記対象物に接触していないときには前記操作子に一定の反力を発生させ、前記制御対象が前記対象物に接触しているときには、前記一定の反力に加えて、前記操作子に力触覚を発生させるための制御信号を、前記マスタ側アクチュエータに出力することを特徴とする。
　本発明の一態様のマスタ装置は、対象物との接触により変位する制御対象を制御するスレーブ装置に接続されたマスタ装置であって、操作者の操作により変位する操作子と、前記操作子に力触覚を発生させるマスタ側アクチュエータと、前記制御対象の変位量に応じて、前記マスタ側アクチュエータに力触覚発生用の制御信号を出力するマスタ制御部と、を備え、前記マスタ制御部は、前記制御対象が前記対象物に接触していないときには前記操作子に一定の反力を発生させ、前記制御対象が前記対象物に接触しているときには、前記一定の反力に加えて、前記操作子に力触覚を発生させるための制御信号を出力することを特徴とする。
　本発明の一態様のスレーブ装置は、操作者の操作により変位する操作子を備えたマスタ装置に接続されたスレーブ装置であって、対象物との接触により変位する制御対象に力触覚を発生させるスレーブ側アクチュエータと、前記操作子の変位量に応じて、前記スレーブ側アクチュエータに力触覚発生用の制御信号を出力するスレーブ制御部と、を備え、前記スレーブ制御部は、前記制御対象が前記対象物に接触していないときには前記操作子に一定の反力を発生させ、前記制御対象が前記対象物に接触しているときには、前記一定の反力に加えて、前記操作子に力触覚を発生させるための制御信号を、前記マスタ装置に出力することを特徴とする。
　本発明の一態様の力触覚制御方法は、マスタ装置に搭載され、操作者の操作により変位する操作子が操作された際に、この操作子の変位量に応じた力触覚を、前記マスタ装置に接続されたスレーブ装置に搭載された制御対象に発生させる工程と、前記制御対象が対象物との接触により変位した変位量に応じた力触覚を、前記操作子に発生させる工程と、前記制御対象が前記対象物と接触していないときには、前記操作子に一定の反力を発生させ、前記制御対象が前記対象物と接触しているときには、前記操作子に、前記制御対象が前記対象物に接触したことにより変位した変位量に応じた力触覚に、前記一定の反力を加えて発生させる工程と、を備えたことを特徴とする。
　本発明の一態様は、上記マスタ装置としてコンピュータを機能させるための力触覚制御プログラムである。
　本発明の一態様は、上記スレーブ装置としてコンピュータを機能させるための力触覚制御プログラムである。
　本発明によれば、操作者による簡単な操作で制御対象を操作して、対象物と接触した感触を得ることが可能となる。
図１は、本発明の実施形態に係る力触覚制御システムの概略構成を示す説明図である。 図２は、本発明の実施形態に係る力触覚制御システムの構成を示すブロック図である。 図３は、本実施形態に係る力触覚制御システムで採用される操作子を伸縮したときの状態を示す説明図である。 図４は、操作子に発生する力の変化を示すグラフである。 図５は、変換テーブルを作成する処理を示すフローチャートである。 図６は、本実施形態に係る力触覚制御システムの動作を示すフローチャートである。 図７は、本発明に係る力触覚制御システムの機能構成を示すブロック図である。
［本実施形態の構成説明］
　図１は、本発明の実施形態に係る力触覚制御システムの概略構成を示す説明図、図２は、本実施形態に係る力触覚制御システムの構成を示すブロック図である。図１に示すように、本実施形態に係る力触覚制御システムは、操作者Ｐ１が一次元方向に変位する操作子１１（例えば、ピストン）を操作することにより、ロボットハンド２１（制御対象）に設けられている複数のアクチュエータ２３（２３-1～２３-n）を制御し、該ロボットハンド２１を動作させる。そして、ロボットハンド２１を用いて、例えば遠隔地に居る対象者Ｐ２と疑似的に握手する。更に、ロボットハンド２１に設けられた複数のセンサ２２（２２-1～２２-n）で検出された力を操作子１１にフィードバックすることにより、操作者Ｐ１が対象者Ｐ２と握手している感触が得られるように力を発生させる。
　以下、図２を参照して本実施形態に係る力触覚制御システムを詳細に説明する。図２に示すように、本実施形態に係る力触覚制御システム１００は、マスタ装置１と、ネットワーク３を介してマスタ装置１に接続されたスレーブ装置２と、を有している。
　マスタ装置１は、操作子１１と、センサ１２（マスタ側センサ）と、アクチュエータ１３（マスタ側アクチュエータ）と、マスタ制御部１４と、を備えている。
　操作子１１は、操作者Ｐ１が片手や片足などで容易に操作可能な触覚器具であり、例えば一次元方向に往復動作可能なピストンである。なお、操作子１１はピストン以外にも、例えば足で操作する場合には、車両のアクセルペダルとすることもできる。操作子１１は、加圧とフィードバックが可能であれば、ダイヤル式のつまみを用いることも可能である。
　また、図１では説明を簡素化するために１つの操作子１１を記載しているが、本実施形態では、複数の操作子１１を備える。例えば、操作者Ｐ１の両手、両足で操作する４個の操作子１１、及び、操作者Ｐ１の口、脇で操作する２個の操作子の、合計６個とすることができる。更に、操作者Ｐ１の瞼や腹部の動きで操作子１１を操作することも可能である。
　センサ１２は、操作子１１の変位量を検出する。触覚器具が一次元方向に往復動作するピストンである場合には、該ピストンの一次元方向の変位量を検出する。
　アクチュエータ１３は、操作子１１を一次元方向、即ち、操作子１１を収縮させる方向、或いは伸長する方向に力触覚を発生させて、操作子１１を動作させる。具体的に、後述するアクチュエータ制御部１４１より出力される制御指令値に基づいて、操作子１１を一次元方向に動作させる。制御指令値は、例えば電圧値、或いは電流値の信号である。
　マスタ制御部１４は、アクチュエータ制御部１４１と、センサ制御部１４２と、演算部１４３と、記憶部１４４と、通信部１４５と、を備えている。
　センサ制御部１４２は、センサ１２にて検出される検出信号を取得する。検出信号には、操作子１１の変位量の情報が含まれる。
　演算部１４３は、スレーブ装置２に設置されてロボットハンド２１の変位量を検出する各センサ２２（２２-1～２２-m）（詳細は後述）で検出された変位量を取得し、この変位量に基づいて、アクチュエータ１３を制御するための制御量（以下、「マスタ制御量」という」を演算する。演算部１４３は、演算した制御量をアクチュエータ制御部１４１に出力する。
　演算部１４３はまた、ロボットハンド２１が対象者Ｐ２に接触しているか否かをの情報を、スレーブ装置２に設けられるセンサ制御部２４２より取得する。或いは、スレーブ装置２に設けられる各センサ２２で検出される検出信号に基づいて、ロボットハンド２１が対象者Ｐ２に接触しているか否かを判定する。演算部１４３は、ロボットハンド２１が対象者Ｐ２に接触していないときに、操作子１１に一定の反力を発生させるための制御量をアクチュエータ制御部１４１に出力する。演算部１４３による制御量の演算方法の詳細については後述する。
　アクチュエータ制御部１４１は、演算部１４３で演算された制御量に基づいて、アクチュエータ１３を動作させるための制御指令値（制御信号）を算出する。算出した制御指令値をアクチュエータ１３に出力する。アクチュエータ１３は、この制御指令値に基づいて、操作子１１を一次元方向、即ち、収縮方向または伸長方向に動作させるための力を発生する。即ち、マスタ制御部１４に搭載されるアクチュエータ制御部１４１は、ロボットハンド２１の変位量に応じてアクチュエータ１３に力触覚発生用の制御信号を出力する。
　記憶部１４４は、操作子１１を一次元方向に動作させたときの変位量、即ち、操作子１１を収縮させたとき、または、伸長させたときの変位量と、ロボットハンド２１の変位量との関係を示す対応テーブルを記憶する。
　具体的に、操作者Ｐ１が操作子１１を最も伸長した状態から収縮させる方向へ変位させ、最も収縮した状態まで変位したときの変位量と、ロボットハンド２１の変位量との関係を演算し、この変位量の関係を示す対応テーブルを記憶する。対応テーブルが設定されることにより、操作者Ｐ１が操作子１１を動作させたときの、操作子１１の変位量をロボットハンド２１の変位量に変換することができる。なお、上記対応テーブルは、スレーブ装置２の記憶部２４４に記憶することも可能である。記憶部１４４は、例えばＲＡＭ、ＲＯＭ、ハードディスクなどの記録媒体からなる。
　通信部１４５は、ネットワーク３を介して、スレーブ装置２との間で通信を行う。
　一方、スレーブ装置２は、操作対象機器であるロボットハンド２１と、センサ２２（スレーブ側センサ）と、アクチュエータ２３（スレーブ側アクチュエータ）と、スレーブ制御部２４と、を備えている。
　ロボットハンド２１は、例えば５本の指、及び複数（例えば、１０個）の関節を有しており、各関節が動作して、例えば人間の手を動きを模擬する。各関節にはそれぞれアクチュエータ２３（２３-1～２３-n）が設けられており、該アクチュエータ２３が動作することにより、ロボットハンド２１は例えば対象者Ｐ２と握手する。本実施形態では、ｎ個のアクチュエータ２３を備える例を示している。
　なお、図１では、説明を簡素化するために１つのロボットハンド２１を記載しているが、本実施形態では、複数のロボットハンド２１を備える。例えば、操作者Ｐ１の４つの手足、及び口、脇、で操作する合計６個の操作子１１がマスタ装置１に設けられている場合には、操作子１１の個数に対応してロボットハンド２１を６個とすることができる。
　センサ２２（２２-1～２２-m）は、例えばロボットハンド２１の関節に設置されており、該ロボットハンド２１の変位量を検出する。具体的に、アクチュエータ２３の動作に伴う各関節の変位量、及びロボットハンド２１が対象物と接触したことによる変位量を検出する。本実施形態では、ロボットハンド２１が接触する対象物として、対象者Ｐ２の手を例に挙げて説明する。
　アクチュエータ２３は、ロボットハンド２１に設けられる複数（例えば、ｎ個）の関節を動作させる。アクチュエータ２３は、演算部２４３より、アクチュエータ２３を制御するための制御量（後述する「スレーブ制御量」）の信号が出力された際に、このスレーブ制御量に応じた力触覚を発生する。アクチュエータ２３に力触覚が発生することにより、ロボットハンド２１が動作する。例えば、ロボットハンド２１が対象者Ｐ２と握手するように、該ロボットハンド２１を動作させることができる。
　スレーブ制御部２４は、アクチュエータ制御部２４１と、センサ制御部２４２と、演算部２４３と、記憶部２４４と、通信部２４５と、を備えている。
　センサ制御部２４２は、センサ２２にて検出される検出信号を取得する。検出信号には、ロボットハンド２１の各関節の変位量の情報が含まれる。また、センサ制御部２４２は、例えばロボットハンド２１が対象者Ｐ２と握手する際には、ロボットハンド２１が対象者Ｐ２の手に接触したことを判定する。
　演算部２４３は、マスタ装置１に搭載され、操作子１１の変位量を検出するセンサ１２で検出された変位量を取得し、この変位量に基づいて、ロボットハンド２１を制御するための制御量（以下、「スレーブ制御量」という）を演算する。
　アクチュエータ制御部２４１は、マスタ装置１の演算部１４３で演算された制御量（スレーブ制御量）に基づいて、ｎ個の各アクチュエータ２３（２３-1～２３-n）を動作させるための制御指令値（制御信号）を算出する。アクチュエータ制御部２４１は、算出した制御指令値を各アクチュエータ２３に出力する。各アクチュエータ２３は、この制御指令値に基づいて、ロボットハンド２１の各関節を所望の方向に動作させる。即ち、スレーブ制御部２４に搭載されるアクチュエータ制御部２４１は、操作子１１の変位量に応じてアクチュエータ２３に力触覚発生用の制御信号を出力する。
　記憶部２４４は、アクチュエータ制御部２４１、センサ制御部２４２、演算部２４３における演算処理においてデータを一時的に記憶する。記憶部２４４は、例えばＲＡＭ、ＲＯＭ、ハードディスクなどの記録媒体からなる。
　通信部２４５は、ネットワーク３を介して、マスタ制御部１４との間で通信を行う。
　［演算部１４３による制御量の演算方法］
　次に、マスタ装置１に設けられる演算部１４３による制御量の演算方法について説明する。図３は、操作子１１を伸縮したときの状態を示す説明図である。図４は、図３に示した区間Ｘ１、Ｘ２、Ｘ３において、操作子１１に発生する力ｆ（ｔ）の変化を示すグラフである。
　演算部１４３は、ロボットハンド２１が対象者Ｐ２に接触していないときには、操作子１１に一定の反力を発生させる。即ち、操作者が操作子１１を収縮方向に変位させる際に、この変位に対向する方向に一定の反力を発生させる。また、操作者が操作子１１を伸長方向に変位させる際に、この変位と同一の方向に一定の反力を発生させる。ロボットハンド２１が対象者Ｐ２に接触しているか否かは、センサ制御部２４２で取得される各センサ２２の検出信号に基づいて判定することができる。
　演算部１４３は、ロボットハンド２１が対象者Ｐ２に接触しているときには、操作子１１に上記した一定の反力を発生させることに加え、対象者Ｐ２がロボットハンド２１に力を加えたことによる力触覚を発生させる。演算部１４３は、操作子１１に上記の力を発生させるための制御量を演算し、アクチュエータ制御部１４１に出力する。以下、図３、図４を参照して詳細に説明する。
　図３に示すｐ１～ｐ９は、操作子１１が最も伸長した状態（ｐ１）から、操作者Ｐ１が操作子１１を押圧して徐々に収縮させ、最も収縮した状態（ｐ５）に達した後、操作者Ｐ１が押圧を緩めて徐々に伸長させて最も伸長した状態（ｐ９）に戻るまでの動作を示している。
　本実施形態では、一例として、操作子１１の変位量が状態ｐ１からｐ３までの区間Ｘ１において、操作子１１の移動に伴って動作するロボットハンド２１が対象者Ｐ２に接触していないものとする。また、操作子１１の変位量が状態ｐ３からｐ７までの区間Ｘ２において、ロボットハンド２１が対象者Ｐ２に接触しているものとする。操作子１１の変位量が状態ｐ７からｐ９までの区間Ｘ３において、ロボットハンド２１が対象者Ｐ２に接触していないものとする。
　演算部１４３は、図３に示す区間Ｘ１、Ｘ３において、操作子１１に一定の反力を発生させるための制御量を演算する。このため、操作子１１には区間Ｘ１において、操作子１１が収縮する方向の逆の方向に一定の反力が発生する。また、操作子１１は、区間Ｘ３において、操作子１１が伸長する方向と同一の方向に一定の反力が発生する。即ち、図４に示すように、区間Ｘ１、Ｘ３において、「ｆ（ｔ）＝ａ」の反力が発生する。
　演算部１４３はまた、図３に示す区間Ｘ２において、操作子１１に一定の反力と、スレーブ装置２より送信される「マスタ制御量」に応じた力触覚、の合計の力を発生させるための制御量を演算する。このため、図４に示すように操作子１１には、区間Ｘ２において、力触覚ｇ（ｔ）と反力「ａ」の合計である「ｆ（ｔ）＝ｇ（ｔ）＋ａ」の力が発生する。
　従って、操作者Ｐ１が操作子１１を徐々に収縮させることにより、スレーブ装置２のロボットハンド２１を動作させ、ロボットハンド２１が対象者Ｐ２に接触していない場合には、操作子１１には一定の反力「ａ」が発生する（図４のｑ１）。この際、操作子１１には一定の反力が作用しているため、操作者Ｐ１が力を抜くと、操作子１１は自然に伸長する。また、ロボットハンド２１が対象者Ｐ２に接触した場合には、操作子１１には一定の反力「ａ」に加えて、力触覚「ｇ（ｔ）」が発生する（図４のｑ２）。更に、操作者Ｐ１が操作子１１を徐々に伸長させることにより、ロボットハンド２１と対象者Ｐ２との接触が終了した場合には、操作子１１には一定の反力「ａ」が発生する（図４のｑ３）。
　従って、操作者Ｐ１は、一次元方向に動作する操作子１１を伸縮させるという簡単な操作で、ロボットハンド２１を動作させて対象者Ｐ２と疑似的に握手するという感触を得ることができる。なお、ロボットハンド２１が対象者Ｐ２に接触しない場合には、図４のグラフｑ４に示すように、操作子１１には一定の反力「ａ」が発生した状態が継続される。
　なお、本実施形態では、マスタ装置１に設けられた演算部１４３において、操作子１１に発生させる力を算出する例について説明したが、本発明はこれに限定されず、スレーブ装置２に設けられた演算部２４３において演算してもよい。即ち、マスタ制御部１４、及びスレーブ制御部２４のいずれか一方において、制御対象（ロボットハンド２１）が対象物（対象者Ｐ２）に接触していないときには操作子１１に一定の反力を発生させ、制御対象が対象物に接触しているときには操作子１１に発生させる力触覚に加えて、一定の反力を発生させるための制御信号を演算し、この制御信号をアクチュエータ１３に出力する構成とすることができる。
　［本実施形態の動作］
　次に、本実施形態に係る力触覚制御システム１００の動作について説明する。初めに、図５に示すフローチャートを参照して、操作子１１の変位量を、ロボットハンド２１の変位量に変換する際に使用する変換テーブルを作成する処理について説明する。この処理は、図２に示した演算部１４３によって実行される。
　図５のステップＳ１１において、演算部１４３は、操作者Ｐ１が操作子１１を操作していないときの状態、即ち、操作子１１の変位量がゼロの状態（図３のｐ１の状態）を、ロボットハンド２１の変位量がゼロの状態に対応させる。ロボットハンド２１の変位量がゼロであるときには、ロボットハンド２１が開いており、対象者Ｐ２と接触していない。即ち、ロボットハンド２１は開ききった状態である。
　ステップＳ１２において、演算部１４３は、操作者Ｐ１が操作子１１の変位量を最大としたとき、即ち、一次元的に変位する操作子１１が最大に収縮したときの状態（図３のｐ５の状態）を、ロボットハンド２１の変位量が最大となる状態に対応させる。ロボットハンド２１の変位量が最大であるときには、ロボットハンド２１が閉じきった状態である。
　ステップＳ１３において、演算部１４３は、操作子１１の変位量と、ロボットハンド２１の変位量との関係を示す対応テーブルを作成する。
　ステップＳ１４において、演算部１４３は、ステップＳ１３で作成した対応テーブルを記憶部１４４に記憶する。こうして、操作子１１の変位量とロボットハンド２１の変位量の対応関係を示す対応テーブルが記憶部１４４に記憶される。なお、対応テーブルを、スレーブ装置２の記憶部２４４に記憶してもよい。
　次に、本実施形態に係る力触覚制御システム１００の動作を、図６に示すフローチャートを参照して説明する。この処理は、図１に示すマスタ制御部１４、及びスレーブ制御部２４により実行される。図６では、操作者Ｐ１が力触覚制御システム１００を用いてロボットハンド２１を制御し、該ロボットハンド２１を用いて対象者Ｐ２と疑似的に握手する例を示している。
　図６のステップＳ３１において、マスタ制御部１４は、操作子１１の動作開始を待機する。
　ステップＳ３２において、マスタ制御部１４は、操作子１１が動作を開始したか否かを判定する。操作者Ｐ１が、例えば右手で操作子１１を収縮させることにより、操作子１１は動作を開始する。操作子１１が動作を開始した場合には（Ｓ３２；ＹＥＳ）、ステップＳ３３に処理を進め、そうでなければ（Ｓ３２；ＮＯ）、ステップＳ３１に処理を戻す。
　ステップＳ３３において、マスタ制御部１４は、センサ１２で検出される操作子１１の変位量に基づいて、ロボットハンド２１の変位量を制御する。具体的に、アクチュエータ２３を制御してロボットハンド２１の関節を動作させて、対象者Ｐ２と握手する方向にロボットハンド２１を動作させる。
　即ち、前述したように記憶部１４４には、操作子１１の変位量とロボットハンド２１の変位量との対応を示す対応テーブルが記憶されており、この対応テーブルを参照して、ロボットハンド２１の変位量が所望の変位量となるように制御する。
　ステップＳ３４において、スレーブ制御部２４は、ロボットハンド２１が対象者Ｐ２の手に接触したか否かを判定する。具体的に、ロボットハンド２１に搭載されている各センサ２２での検出信号に基づいて、ロボットハンド２１が対象者Ｐ２の手に接触したか否かを判定する。ロボットハンド２１が対象者Ｐ２の手に接触したと判定された場合には（Ｓ３４；ＹＥＳ）、ステップＳ３６に処理を進め、そうでなければ（Ｓ３４；ＮＯ）、ステップＳ３５に処理を進める。
　ステップＳ３５において、マスタ制御部１４は、操作子１１に一定の反力を発生させる。即ち、操作子１１が収縮を開始し、且つ、操作子１１の変位量に応じて動作するロボットハンド２１が対象者Ｐ２に接触していない状態において、マスタ制御部１４は、操作子１１に一定の反力を発生させる。具体的に、前述した図３、図４の区間Ｘ１にて説明したように、マスタ制御部１４は、操作子１１に一定の反力「ａ」を発生させる。このため、操作者Ｐ１は、区間Ｘ１において操作子１１により反力を感じる。
　ステップＳ３６において、マスタ制御部１４及びスレーブ制御部２４は、力触覚制御を実施する。具体的に、マスタ装置１のセンサ１２で検出された操作子１１の変位量に基づいて、アクチュエータ２３を制御しロボットハンド２１を動作させる。また、ロボットハンド２１が対象者Ｐ２に接触したことによる変位量が、スレーブ装置２のセンサ２２により検出され、この変位量に応じて操作子１１に力触覚を発生する制御が実施される。なお、力触覚制御については周知の技術であるので詳細な説明を省略する。
　そして、力触覚制御が実施されることにより、図４の区間Ｘ２のグラフｑ２に示したように、操作子１１には、ロボットハンド２１が対象者Ｐ２と握手したことによる力触覚ｇ（ｔ）が発生する。更に、一定の反力「ａ」が加算され、合計の力「ｆ（ｔ）＝ｇ（ｔ）＋ａ」が操作子１１に発生する。
　ステップＳ３７において、スレーブ制御部２４は、ロボットハンド２１が対象者Ｐ２の手から離れたか否かを判定する。具体的に、各センサ２２での検出信号に基づいて、ロボットハンド２１が対象者Ｐ２の手から離れたか否かを判定する。ロボットハンド２１が対象者Ｐ２の手から離れたと判定された場合には（Ｓ３７；ＹＥＳ）、ステップＳ３８に処理を進め、そうでなければ（Ｓ３７；ＮＯ）、ステップＳ３６に処理を戻す。
　ステップＳ３８において、マスタ制御部１４は、操作子１１に一定の反力を発生させる。即ち、操作子１１が伸長を開始し、且つ、ロボットハンド２１が対象者Ｐ２から離れた場合には、マスタ制御部１４は、操作子１１に一定の反力を発生させる。具体的に、前述した図３、図４の区間Ｘ３にて説明したように、マスタ制御部１４は、操作子１１に一定の反力「ａ」を発生させる。
　ステップＳ３９において、スレーブ制御部２４は、操作子１１の変位量に応じてロボットハンド２１の変位量を制御する。具体的に、アクチュエータ２３を制御してロボットハンド２１の関節を動作させ、ロボットハンド２１を広げるように制御する。
　ステップＳ４０において、マスタ制御部１４は、センサ１２の検出信号に基づき、操作子１１が最大に伸長したか否かを判断する。即ち、図３に示した状態ｐ９になったか否かを判定する。操作子１１が最大に伸長した場合には（Ｓ４０；ＹＥＳ）、本処理を終了し、そうでなければ（Ｓ４０；ＮＯ）、ステップＳ３９に処理を戻す。
　こうして、一次元方向に動作する操作子１１を操作することにより、ロボットハンド２１が対象者Ｐ２と握手し、握手した際に生じる力を操作子１１に発生させる制御を実施することができる。
　［本実施形態の効果］
　本実施形態の力触覚制御システム１００は、操作者Ｐ１の操作により変位する操作子１１を備えたマスタ装置１と、前記マスタ装置１に接続され、対象物（対象者Ｐ２）との接触により変位する制御対象（ロボットハンド２１）を制御するスレーブ装置２と、を備え、前記マスタ装置１は、前記操作子１１に力触覚を発生させるマスタ側アクチュエータ１３と、前記制御対象の変位量に応じて、前記マスタ側アクチュエータ１３に力触覚発生用の制御信号を出力するマスタ制御部１４と、を備え、前記スレーブ装置２は、前記制御対象に力触覚を発生させるスレーブ側アクチュエータ２３と、前記操作子１１の変位量に応じて、前記スレーブ側アクチュエータ２３に力触覚発生用の制御信号を出力するスレーブ制御部２４と、を備え、前記マスタ制御部１４、及び前記スレーブ制御部２４のいずれか一方は、前記制御対象が前記対象物に接触していないときには前記操作子１１に一定の反力を発生させ、前記制御対象が前記対象物に接触しているときには、前記一定の反力に加えて、前記操作子１１に力触覚を発生させるための制御信号を、前記マスタ側アクチュエータ１３に出力する。
　このように本実施形態に係る力触覚制御システム１００では、操作子１１とロボットハンド２１との間で力触覚制御を実施し、更に、ロボットハンド２１が対象者Ｐ２と接触していないときには、操作子１１に一定の反力を発生させる。
　このため、操作者Ｐ１が操作子１１を操作し、ロボットハンド２１を用いて対象者Ｐ２と間接的に握手する際には、ロボットハンド２１が対象者Ｐ２に接触していないときにおいても、操作子１１に一定の反力が発生する。このため、操作者Ｐ１は、自らの力で伸長させることが難しい口や脇などの部位を使って操作子１１を操作し、容易にロボットハンド２１を操作することが可能となる。ひいては、口や脇を使って対象者Ｐ２と疑似的に握手することが可能となる。
　また、従来においてはロボットハンド２１が対象者Ｐ２に接触していなければ、ロボットハンド２１には反力は発生せず、これに応じた反力が操作子１１に発生しないので、ロボットハンド２１と対象者Ｐ２との接触が終了した時点で、ロボットハンド２１の広がりがストップする。これに対して本実施形態では、ロボットハンド２１が対象者Ｐ２と接触していないときに、操作子１１に反力が発生するので、ロボットハンド２１を広げることができる。
　また、本実施形態では、一次元方向に変位する操作子１１を伸縮させるという簡単な操作で、対象者Ｐ２との疑似的な握手を行うことができる。即ち、操作者Ｐ１による複雑な動作を必要とせずに、ロボットハンド２１の複雑な動作を実現することが可能となる。
　操作者Ｐ１による複雑な動作が不要となるので、４本の手足以外にも広範囲な部位、例えば、口の動作、脇の動作、瞼の動作、腹部の動作、などの一次元的な変位を発生させることが可能な部位の動作を用いて、ロボットハンド２１による対象者Ｐ２との握手を行うことが可能となる。このため、操作者は同時に多くの対象者（例えば、５人以上）と同時に握手することが可能となる。また、握手以外にも、例えば、同時に複数の対象者とハイタッチすることが可能である。
　また、例えばアーティストが、本会場から離れた遠隔会場のファンと握手するシーンにおいては、アーティストは同時に本会場及び遠隔会場の複数のファンと握手、或いはハイタッチすることができる。その結果、遠隔会場のファンと握手やハイタッチで触れ合うことができる。
　更に、操作者の親指以外の４本の指を用いて、操作子１１を操作することも可能である。具体的に、親指と人差し指、親指と中指、親指と薬指、親指と小指の４通りの組み合わせを用いて４つの操作子１１を操作することも可能である。
　また、一つの操作子１１で１つのロボットハンド２１を制御するだけでなく、２つのロボットハンド２１を同時に制御することにより、対象者Ｐ２と両手で握手することも可能である。
　更に、操作子１１が予期せずに動作してロボットハンド２１が予期しない動作を引き起こさないように、ロック機構を備える構成とすることが望ましい。
　また、ロボットハンド２１は、センサ２２の故障などに起因して、予期せぬ動作が発生した際に、想定外の動作を防止するための緊急停止装置を備える構成とすることが望ましい。このような構成とすることにより、ロボットハンド２１が対象者Ｐ２と握手する際に、必要以上の握力が発生するというトラブルの発生を回避できる。更に、緊急停止に加え、自動でロボットハンド２１を開く方向に動作するように制御する構成とすることが望ましい。
　上記説明した本実施形態の力触覚制御システム１００には、図７に示すように例えば、ＣＰＵ（Central Processing Unit、プロセッサ）９０１と、メモリ９０２と、ストレージ９０３（HDD：HardDisk Drive、SSD：SolidState Drive）と、通信装置９０４と、入力装置９０５と、出力装置９０６とを備える汎用的なコンピュータシステムを用いることができる。メモリ９０２およびストレージ９０３は、記憶装置である。このコンピュータシステムにおいて、ＣＰＵ９０１がメモリ９０２上にロードされた所定のプログラムを実行することにより、力触覚制御システム１００の各機能が実現される。
　なお、力触覚制御システム１００は、１つのコンピュータで実装されてもよく、あるいは複数のコンピュータで実装されても良い。また、力触覚制御システム１００は、コンピュータに実装される仮想マシンであっても良い。
　なお、力触覚制御システム１００用のプログラムは、ＨＤＤ、ＳＳＤ、ＵＳＢ（Universal Serial Bus）メモリ、ＣＤ (Compact Disc)、ＤＶＤ (Digital Versatile Disc)などのコンピュータ読取り可能な記録媒体に記憶することも、ネットワークを介して配信することもできる。
　なお、本発明は上記実施形態に限定されるものではなく、その要旨の範囲内で数々の変形が可能である。
　１　マスタ装置
　２　スレーブ装置
　３　ネットワーク
　１１　操作子
　１２　センサ（マスタ側センサ）
　１３　アクチュエータ（マスタ側アクチュエータ）
　１４　マスタ制御部
　２１　ロボットハンド（制御対象）
　２２（２２-1～２２-m）　センサ（スレーブ側センサ）
　２３（２３-1～２３-n）　アクチュエータ（スレーブ側アクチュエータ）
　２４　スレーブ制御部
　１００　力触覚制御システム
　１４１、２４１　アクチュエータ制御部
　１４２、２４２　センサ制御部
　１４３、２４３　演算部
　１４４、２４４　記憶部
　１４５、２４５　通信部

Claims (8)

  1. 　操作者の操作により変位する操作子を制御するマスタ装置と、前記マスタ装置に接続され、対象物との接触により変位する制御対象を制御するスレーブ装置と、を備え、
    　前記マスタ装置は、
    　前記操作子に力触覚を発生させるマスタ側アクチュエータと、
    　前記制御対象の変位量に応じて、前記マスタ側アクチュエータに力触覚発生用の制御信号を出力するマスタ制御部と、を備え、
    　前記スレーブ装置は、
    　前記制御対象に力触覚を発生させるスレーブ側アクチュエータと、
    　前記操作子の変位量に応じて、前記スレーブ側アクチュエータに力触覚発生用の制御信号を出力するスレーブ制御部と、を備え、
    　前記マスタ制御部、及び前記スレーブ制御部のいずれか一方は、
    　前記制御対象が前記対象物に接触していないときには前記操作子に一定の反力を発生させ、
    　前記制御対象が前記対象物に接触しているときには、前記一定の反力に加えて、前記操作子に力触覚を発生させるための制御信号を、前記マスタ側アクチュエータに出力すること
    　を特徴とする力触覚制御システム。
  2. 　前記操作子は、一次元方向に動作すること
    　を特徴とする請求項１に記載の力触覚制御システム。
  3. 　対象物との接触により変位する制御対象を制御するスレーブ装置に接続されたマスタ装置であって、
    　操作者の操作により変位する操作子と、
    　前記操作子に力触覚を発生させるマスタ側アクチュエータと、
    　前記制御対象の変位量に応じて、前記マスタ側アクチュエータに力触覚発生用の制御信号を出力するマスタ制御部と、を備え、
    　前記マスタ制御部は、
    　前記制御対象が前記対象物に接触していないときには前記操作子に一定の反力を発生させ、
    　前記制御対象が前記対象物に接触しているときには、前記一定の反力に加えて、前記操作子に力触覚を発生させるための制御信号を出力すること
    　を特徴とするマスタ装置。
  4. 　前記操作子は、一次元方向に動作すること
    　を特徴とする請求項３に記載のマスタ装置。
  5. 　操作者の操作により変位する操作子を備えたマスタ装置に接続されたスレーブ装置であって、
    　対象物との接触により変位する制御対象に力触覚を発生させるスレーブ側アクチュエータと、
    　前記操作子の変位量に応じて、前記スレーブ側アクチュエータに力触覚発生用の制御信号を出力するスレーブ制御部と、を備え、
    　前記スレーブ制御部は、
    　前記制御対象が前記対象物に接触していないときには前記操作子に一定の反力を発生させ、
    　前記制御対象が前記対象物に接触しているときには、前記一定の反力に加えて、前記操作子に力触覚を発生させるための制御信号を、前記マスタ装置に出力すること
    　を特徴とするスレーブ装置。
  6. 　マスタ装置に搭載され、操作者の操作により変位する操作子が操作された際に、この操作子の変位量に応じた力触覚を、前記マスタ装置に接続されたスレーブ装置に搭載された制御対象に発生させる工程と、
    　前記制御対象が対象物との接触により変位した変位量に応じた力触覚を、前記操作子に発生させる工程と、
    　前記制御対象が前記対象物と接触していないときには、前記操作子に一定の反力を発生させ、前記制御対象が前記対象物と接触しているときには、前記操作子に、前記制御対象が前記対象物に接触したことにより変位した変位量に応じた力触覚に、前記一定の反力を加えて発生させる工程と、
    　を備えたことを特徴とする力触覚制御方法。
  7. 　請求項３または４に記載したマスタ装置としてコンピュータを機能させるための力触覚制御プログラム。
  8. 　請求項５に記載したスレーブ装置としてコンピュータを機能させるための力触覚制御プログラム。
PCT/JP2020/028975 2020-07-29 2020-07-29 力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム WO2022024238A1 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/028975 WO2022024238A1 (ja) 2020-07-29 2020-07-29 力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2020/028975 WO2022024238A1 (ja) 2020-07-29 2020-07-29 力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム

Publications (1)

Publication Number Publication Date
WO2022024238A1 true WO2022024238A1 (ja) 2022-02-03

Family

ID=80035501

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/028975 WO2022024238A1 (ja) 2020-07-29 2020-07-29 力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム

Country Status (1)

Country Link
WO (1) WO2022024238A1 (ja)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0271979A (ja) * 1988-09-05 1990-03-12 Hitachi Ltd マニピュレータの制御方法および装置
JPH07246578A (ja) * 1994-03-11 1995-09-26 Yaskawa Electric Corp マスターハンド装置
JP2014004655A (ja) * 2012-06-25 2014-01-16 Univ Of Tsukuba マニピュレーションシステム
JP2015089605A (ja) * 2013-11-07 2015-05-11 学校法人立命館 マスタスレーブシステム

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0271979A (ja) * 1988-09-05 1990-03-12 Hitachi Ltd マニピュレータの制御方法および装置
JPH07246578A (ja) * 1994-03-11 1995-09-26 Yaskawa Electric Corp マスターハンド装置
JP2014004655A (ja) * 2012-06-25 2014-01-16 Univ Of Tsukuba マニピュレーションシステム
JP2015089605A (ja) * 2013-11-07 2015-05-11 学校法人立命館 マスタスレーブシステム

Similar Documents

Publication Publication Date Title
KR100940396B1 (ko) 촉각 피드백과 연관된 명령어를 매핑하는 시스템 및 방법
Abbott et al. Virtual fixture architectures for telemanipulation
Tachi Real-time remote robotics-toward networked telexistence
JP5105450B2 (ja) マスタスレーブシステム及びその制御方法
KR102334764B1 (ko) 햅틱 장치를 통한 가상 피드백을 위한 시스템 및 방법
JPH10177387A (ja) 力覚駆動装置、力覚付与方法および記録媒体
WO2019195020A1 (en) Resistance-based haptic device
Walker et al. User-controlled variable impedance teleoperation
WO2022024238A1 (ja) 力触覚制御システム、マスタ装置、スレーブ装置、力触覚制御方法、及び力触覚制御プログラム
Fan et al. Digital twin-driven mixed reality framework for immersive teleoperation with haptic rendering
JP4876246B2 (ja) 触覚制御方法および触覚制御装置
Nisar et al. Effects of different hand-grounding locations on haptic performance with a wearable kinesthetic haptic device
KR102544926B1 (ko) 결합된 어드미턴스 제어기의 최적 제어
Kamikawa et al. Comparison between force-controlled skin deformation feedback and hand-grounded kinesthetic force feedback for sensory substitution
Malysz et al. Cooperative teleoperation control with projective force mappings
JPH0442144B2 (ja)
CN107168105B (zh) 一种虚拟手术混合控制系统及其验证方法
Kuchenbecker et al. Canceling induced master motion in force-reflecting teleoperation
JP4524729B2 (ja) 遠隔操縦ロボットの制御装置
Ishii et al. Bilateral control for remote controlled robotic forceps system with time varying delay
Xia et al. System Design of Wearable Tactile Device Based on Virtual Reality
Dorin et al. Design and development of an upper limb rehabilitation robotic system
WO2006070495A1 (ja) インタフェース装置
Wijayasekara et al. Fuzzy logic based force-feedback for obstacle collision avoidance of robot manipulators
WO2024028980A1 (ja) 遠隔タッチング支援装置および遠隔タッチング支援方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20946924

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20946924

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: JP