WO2009147832A1 - ロボット、ロボットの制御装置、制御方法、及び制御プログラム - Google Patents
ロボット、ロボットの制御装置、制御方法、及び制御プログラム Download PDFInfo
- Publication number
- WO2009147832A1 WO2009147832A1 PCT/JP2009/002456 JP2009002456W WO2009147832A1 WO 2009147832 A1 WO2009147832 A1 WO 2009147832A1 JP 2009002456 W JP2009002456 W JP 2009002456W WO 2009147832 A1 WO2009147832 A1 WO 2009147832A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- joint
- robot
- body part
- robot arm
- arm
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 20
- 230000007246 mechanism Effects 0.000 claims abstract description 236
- 230000033001 locomotion Effects 0.000 claims abstract description 61
- 210000003205 muscle Anatomy 0.000 claims description 130
- 206010061258 Joint lock Diseases 0.000 claims description 93
- 210000001624 hip Anatomy 0.000 claims description 93
- 210000001503 joint Anatomy 0.000 claims description 54
- 238000001514 detection method Methods 0.000 claims description 27
- 210000004394 hip joint Anatomy 0.000 claims description 27
- 239000013598 vector Substances 0.000 description 30
- 238000010586 diagram Methods 0.000 description 27
- 238000012937 correction Methods 0.000 description 16
- 239000012530 fluid Substances 0.000 description 10
- 210000002414 leg Anatomy 0.000 description 10
- 230000036544 posture Effects 0.000 description 7
- 239000011159 matrix material Substances 0.000 description 6
- 230000008602 contraction Effects 0.000 description 5
- 230000000474 nursing effect Effects 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 4
- 238000003825 pressing Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000002347 injection Methods 0.000 description 3
- 239000007924 injection Substances 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000002441 reversible effect Effects 0.000 description 3
- 230000001360 synchronised effect Effects 0.000 description 3
- 230000003042 antagnostic effect Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 210000002310 elbow joint Anatomy 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 210000000245 forearm Anatomy 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000009940 knitting Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 239000011347 resin Substances 0.000 description 1
- 229920005989 resin Polymers 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000000452 restraining effect Effects 0.000 description 1
- 238000007789 sealing Methods 0.000 description 1
- 210000000323 shoulder joint Anatomy 0.000 description 1
- 239000013589 supplement Substances 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/1075—Programme-controlled manipulators characterised by positioning means for manipulator elements with muscles or tendons
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G7/00—Beds specially adapted for nursing; Devices for lifting patients or disabled persons
- A61G7/10—Devices for lifting patients or disabled persons, e.g. special adaptations of hoists thereto
- A61G7/1013—Lifting of patients by
- A61G7/1017—Pivoting arms, e.g. crane type mechanisms
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G7/00—Beds specially adapted for nursing; Devices for lifting patients or disabled persons
- A61G7/10—Devices for lifting patients or disabled persons, e.g. special adaptations of hoists thereto
- A61G7/104—Devices carried or supported by
- A61G7/1046—Mobile bases, e.g. having wheels
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G7/00—Beds specially adapted for nursing; Devices for lifting patients or disabled persons
- A61G7/10—Devices for lifting patients or disabled persons, e.g. special adaptations of hoists thereto
- A61G7/1049—Attachment, suspending or supporting means for patients
- A61G7/1057—Supported platforms, frames or sheets for patient in lying position
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G7/00—Beds specially adapted for nursing; Devices for lifting patients or disabled persons
- A61G7/10—Devices for lifting patients or disabled persons, e.g. special adaptations of hoists thereto
- A61G7/1063—Safety means
- A61G7/1065—Safety means with electronic monitoring
-
- 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/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
- B25J13/085—Force or torque sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0004—Braking devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J5/00—Manipulators mounted on wheels or on carriages
- B25J5/007—Manipulators mounted on wheels or on carriages mounted on wheels
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/0084—Programme-controlled manipulators comprising a plurality of manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/0084—Programme-controlled manipulators comprising a plurality of manipulators
- B25J9/0087—Dual arms
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/14—Programme-controlled manipulators characterised by positioning means for manipulator elements fluid
- B25J9/142—Programme-controlled manipulators characterised by positioning means for manipulator elements fluid comprising inflatable bodies
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
- A61B90/06—Measuring instruments not otherwise provided for
- A61B2090/064—Measuring instruments not otherwise provided for for measuring force, pressure or mechanical tension
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2200/00—Information related to the kind of patient or his position
- A61G2200/30—Specific positions of the patient
- A61G2200/32—Specific positions of the patient lying
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/30—General characteristics of devices characterised by sensor means
- A61G2203/32—General characteristics of devices characterised by sensor means for force
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/30—General characteristics of devices characterised by sensor means
- A61G2203/42—General characteristics of devices characterised by sensor means for inclination
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G2203/00—General characteristics of devices
- A61G2203/70—General characteristics of devices with special adaptations, e.g. for safety or comfort
- A61G2203/72—General characteristics of devices with special adaptations, e.g. for safety or comfort for collision prevention
Definitions
- the present invention relates to a robot, a robot control device, a control method, and a control program for lifting a heavy object such as lifting a nursing care or transporting an article, or transporting a heavy object.
- a care lift that can be used in a small-scale facility with a simple configuration at low cost, which can be moved in a narrow passage without requiring much effort by a caregiver, is disclosed.
- a transfer machine comprising a lifting arm that holds a helper's arm, an arm drive mechanism unit that includes a geared motor and a worm jack that moves the lifting arm up and down, and a tape switch that detects the load of the person being assisted Is disclosed (see Patent Document 2).
- Patent Document 1 has a problem that it is manual and has low operability due to its excellent operability. Moreover, if an actuator such as a motor is added to improve work efficiency and automation is performed, the apparatus becomes larger and heavier and may not be usable in a general home environment.
- the object of the present invention is to solve the above-mentioned problems of the conventional apparatus, and is lightweight and high power, can be used for lifting a nursing care or transporting heavy objects, and is easy to use, easy to use, and high in work efficiency.
- a robot, a robot control device, a control method, and a control program are provided.
- the present invention is configured as follows.
- a base part The torso, A body part moving mechanism that connects the base part and the body part with a hip joint and moves the body part relative to the base part; A mechanism that is provided in the body part and has a plurality of links, and that connects a joint that connects the plurality of links to each other and a joint that connects one of the links and the body part.
- a robot characterized by comprising:
- the torso part movement in which the base part, the torso part, the base part and the torso part are connected by a hip joint, and the torso part is moved relative to the base part.
- a mechanism a joint disposed on the body part, having a plurality of links, and connecting the plurality of links to each other; and a joint connecting the one of the plurality of links and the body part;
- a robot arm having a joint locking mechanism that can be fixed mechanically, a robot arm actuator that drives the respective joints of the robot arm to rotate the plurality of links, and the body part moving mechanism.
- a control apparatus for a robot which controls the operation of the robot comprising a motor, A robot arm operation mode in which the joint arm mechanism actuator, the robot arm actuator, and the hip joint actuator are respectively driven and controlled, and the robot arm is operated with any of the joints of the robot arm in a free state.
- a robot control device that switches between a body part movement mode for moving the body part using the body part moving mechanism with any one of the joints of the robot arm in a locked state.
- the body part movement in which the base part, the body part, the base part and the body part are connected by a hip joint and the body part is moved relative to the base part.
- a waist joint actuator that drives the body part to move relative to the base part
- a joint lock mechanism actuator that drives the joint lock mechanism
- a robot control method for controlling the operation of the robot and a motor A robot arm operation mode in which the joint arm mechanism actuator, the robot arm actuator, and the hip joint actuator are respectively driven and controlled, and the robot arm is operated with any of the joints of the robot arm in a free state.
- the body part movement in which the base part, the body part, the base part and the body part are connected by a hip joint and the body part is moved relative to the base part.
- a robot control program for controlling the operation of the robot and a motor, A robot arm operation mode in which the joint arm mechanism actuator, the robot arm actuator, and the hip joint actuator are respectively driven and controlled, and the robot arm is operated with any of the joints of the robot arm in a free state.
- a robot for causing the computer to function as a robot operation control means for switching between the body part movement mode for moving the body part using the body part moving mechanism with one of the joints of the robot arm in a locked state.
- the joint lock mechanism by providing the joint lock mechanism, the weight load of the object to be transported can be mechanically held, so that a lightweight arm can be obtained. Also, if the joint is made free by the joint lock mechanism, the degree of freedom due to the arm structure can be effectively utilized, the degree of freedom of positioning with respect to the object to be transported can be increased, and the robot is easy to use be able to.
- the robot of the present invention in addition to the arm provided with the joint lock mechanism, by providing the waist mechanism, a powerful actuator for lifting heavy objects can be used only for the waist mechanism, and is simple and lightweight. High power can be achieved with a simple configuration.
- the arm is provided with the robot operation control means for controlling the operation while switching between the impedance control mode and the position control mode, and switching the lock and unlocking operation of the joint lock mechanism. It is intuitive that the operator can operate the arm directly by hand by performing an impedance control with an external force detection device (for example, a force sensor). An easy-to-understand operation method can be realized, and the robot can be made easier to use.
- the robot control device, control method, and control program of the present invention by controlling the locking and unlocking operations of the joint lock mechanism that can mechanically hold the weight load of the object to be transported, If the joint is made free (unlocked), it is possible to effectively utilize the degree of freedom due to the arm structure having a plurality of links through the joint, even though it is a lightweight arm.
- the degree of freedom can be increased, the robot can be easily controlled, and the robot can be easily used.
- the powerful actuator for lifting heavy objects can Only the mechanism can be controlled, and high power can be achieved with a simple and lightweight configuration.
- the robot operation can be controlled while switching between the impedance control mode and the position control mode and the operation of the joint lock mechanism.
- operations such as positioning of the arm and lifting of the object to be transported can be performed continuously, and impedance control is performed based on information on the external force from the external force detection device (for example, a force sensor), so that the operator can manually move the arm.
- the external force detection device for example, a force sensor
- FIG. 1 is an explanatory diagram showing a schematic configuration of a robot according to an embodiment of the present invention.
- FIG. 2 is a perspective view showing the mechanism configuration of the robot according to the embodiment of the present invention
- FIG. 3 is a side view showing the mechanism configuration of the robot according to the embodiment of the present invention
- FIG. 4 is a diagram illustrating the structure of the pneumatic artificial muscle of the robot according to the embodiment of the present invention
- FIG. 5 is a diagram showing a configuration of a pneumatic supply driving system for driving the pneumatic artificial muscle
- FIG. 1 is an explanatory diagram showing a schematic configuration of a robot according to an embodiment of the present invention.
- FIG. 2 is a perspective view showing the mechanism configuration of the robot according to the embodiment of the present invention
- FIG. 3 is a side view showing the mechanism configuration of the robot according to the embodiment of the present invention
- FIG. 4 is a diagram illustrating the structure of the pneumatic artificial muscle of the robot according to the embodiment of the present invention
- FIG. 5 is a diagram showing
- FIG. 6A is a diagram showing an operation of the third joint of the left arm of the robot according to the embodiment of the present invention
- FIG. 6B is a diagram showing an operation of the third joint of the left arm of the robot according to the embodiment of the present invention
- FIG. 6C is a diagram showing an operation of the third joint of the left arm of the robot according to the embodiment of the present invention
- FIG. 7A is a view showing the structure of the joint lock mechanism of the robot according to the embodiment of the present invention, and is a cross-sectional view passing through the joint axis
- FIG. 7B is a view seen from the direction of arrow V in FIG.
- FIG. 7C is an external side view of the opposing gear in the structure of the joint lock mechanism
- FIG. 8 is a diagram illustrating a drive mechanism of the joint lock mechanism of the robot according to the embodiment of the present invention.
- FIG. 9A is a diagram for explaining the operation of the waist mechanism of the robot according to the embodiment of the present invention
- FIG. 9B is a diagram for explaining the operation of the waist mechanism of the robot according to the embodiment of the present invention
- FIG. 10 is a characteristic diagram of the pneumatic artificial muscle of the robot according to the embodiment of the present invention
- FIG. 11A is a cross-sectional front view illustrating the arrangement of force sensors in the second link of the robot according to the embodiment of the present invention
- FIG. 11B is a cross-sectional side view for explaining the arrangement of force sensors in the second link of the robot according to the embodiment of the present invention
- FIG. 12 is a block diagram of robot operation control means realized by a control program executed in the robot control apparatus according to the embodiment of the present invention
- FIG. 13 is a diagram showing details of the position control means of the robot control apparatus according to the embodiment of the present invention
- FIG. 14 is a diagram showing details of the waist angle control means of the robot control apparatus according to the embodiment of the present invention
- FIG. 15 is a diagram showing an operation sequence table representing the operation mode switching step of the robot control device according to the embodiment of the present invention
- FIG. 16 is a flowchart showing the operation steps of the control program in the impedance control means of the robot control apparatus according to the embodiment of the present invention
- FIG. 17A is an operation diagram for explaining the carrying operation of the robot according to the embodiment of the present invention
- FIG. 17A is an operation diagram for explaining the carrying operation of the robot according to the embodiment of the present invention
- FIG. 17B is an operation diagram for explaining the carrying operation of the robot according to the embodiment of the present invention
- FIG. 17C is an operation diagram illustrating the carrying operation of the robot according to the embodiment of the present invention
- FIG. 17D is an operation diagram for explaining the carrying operation of the robot according to the embodiment of the present invention
- FIG. 18 is a diagram for explaining the support legs of the robot according to the embodiment of the present invention
- FIG. 19 is an explanatory diagram when the arm of the robot according to the embodiment of the present invention is applied to nursing care
- FIG. 20 is a perspective view showing a mechanism configuration when the number of arms of the robot according to the embodiment of the present invention is one
- FIG. 21 is a perspective view showing a mechanism configuration when the arm of the robot according to the embodiment of the present invention is a fixed type
- FIG. 22 is a cross-sectional view for explaining a mechanism for driving the first joint of the robot arm according to the embodiment of the present invention.
- a base part The torso, A body part moving mechanism that connects the base part and the body part with a hip joint and moves the body part relative to the base part; A mechanism that is provided in the body part and has a plurality of links, and that connects a joint that connects the plurality of links to each other and a joint that connects one of the links and the body part.
- a robot characterized by comprising:
- the robot arm actuator is a pneumatic artificial muscle
- the hip joint actuator is a pneumatic artificial muscle
- the robot arm has an external force detection device that detects an external force applied to the robot arm
- the robot motion control means drives the pneumatic artificial muscle of the robot arm actuator and the pneumatic artificial muscle of the waist joint actuator based on the external force applied to the robot arm detected by the external force detection device.
- the robot according to the first aspect is provided, wherein the robot arm is controlled to perform operation control of the robot arm in the robot arm operation mode, and to perform body part movement control in the body part movement mode.
- the robot operation control means performs arm operation control and body part movement control based on the external force by impedance control.
- the robot arm is arranged so as to cover approximately half of the outer surface of the cross-section in the width direction of the most advanced link and substantially the entire length in the longitudinal direction at the most advanced link of the plurality of links.
- the robot according to the second aspect is provided, wherein the external force detecting device detects an external force applied to the exterior member.
- the body part moving mechanism is a waist mechanism that swings the body part back and forth substantially around the waist joint with respect to the base part. 4.
- the robot according to any one of aspects 4 is provided.
- the waist mechanism is driven by a translational drive actuator that drives the waist joint by having one end fixed to the base portion and the other end fixed to the trunk portion.
- a robot according to a fifth aspect is provided, which is a mechanism that swings the body part back and forth about the hip joint with respect to the base part.
- the robot according to the first aspect wherein the joint lock mechanism is a one-way clutch mechanism.
- the robot motion control means when the joint lock mechanism is in a locked state, is configured to apply the external force acting on the movable force of the one-way clutch mechanism at any of the joints.
- the robot arm operation mode is performed, and the robot arm operation mode is not performed for an external force acting in a non-movable direction of the one-way clutch mechanism.
- the robot motion control means controls the position of the servo rigidity lower than the servo rigidity in the unlocked state with respect to the robot arm when the joint lock mechanism is in the locked state.
- a robot according to the seventh aspect is provided.
- the torso part movement in which the base part, the torso part, the base part and the torso part are connected by a hip joint, and the torso part is moved relative to the base part.
- a mechanism a joint disposed on the body part, having a plurality of links, and connecting the plurality of links to each other; and a joint connecting the one of the plurality of links and the body part;
- a robot arm having a joint locking mechanism that can be fixed mechanically, a robot arm actuator that drives the respective joints of the robot arm to rotate the plurality of links, and the body part moving mechanism.
- a waist joint actuator that drives the body part to move relative to the base part
- a joint lock mechanism actuator that drives the joint lock mechanism
- a control apparatus for a robot which controls the operation of the robot and a motor
- a robot arm operation mode in which the joint arm mechanism actuator, the robot arm actuator, and the hip joint actuator are respectively driven and controlled, and the robot arm is operated with any of the joints of the robot arm in a free state.
- a robot control device that switches between a body part movement mode for moving the body part using the body part moving mechanism with any one of the joints of the robot arm in a locked state.
- the body part movement in which the base part, the body part, the base part and the body part are connected by a hip joint and the body part is moved relative to the base part.
- a waist joint actuator that drives the body part to move relative to the base part
- a joint lock mechanism actuator that drives the joint lock mechanism
- a robot control method for controlling the operation of the robot and a motor A robot arm operation mode in which the joint arm mechanism actuator, the robot arm actuator, and the hip joint actuator are respectively driven and controlled, and the robot arm is operated with any of the joints of the robot arm in a free state.
- the body part movement in which the base part, the body part, the base part and the body part are connected by a hip joint and the body part is moved relative to the base part.
- a robot control program for controlling the operation of the robot and a motor, A robot arm operation mode in which the joint arm mechanism actuator, the robot arm actuator, and the hip joint actuator are respectively driven and controlled, and the robot arm is operated with any of the joints of the robot arm in a free state.
- a robot for causing the computer to function as a robot operation control means for switching between the body part movement mode for moving the body part using the body part moving mechanism with one of the joints of the robot arm in a locked state.
- FIG. 1 is a diagram showing a schematic configuration of a robot in the first embodiment of the present invention.
- FIG. 2 is a perspective view showing a mechanism configuration of the robot.
- FIG. 3 is a side view of the robot.
- the robot includes a rectangular frame-shaped base part 1, a waist mechanism 2 that functions as an example of a body part moving mechanism fixed to the base part 1, a body part 8 that is supported by the waist mechanism 2, and a body part 8.
- the left arm 3a supported on the left side and the right arm 3b supported on the right side of the body portion 8 are provided with five blocks.
- a rectangular parallelepiped support 4 is provided on the upper surface of the base 1 constituting the base of the robot, and a waist mechanism 2 is provided above the support 4. Further, the base portion 1 is provided with wheels 5 at four corners, respectively, so that the entire robot can be moved.
- the waist mechanism 2 is composed of a rotary joint (waist joint) around the waist rotation axis 2A, and connects the base part 1 and the body part 8 to the base part 1 by moving the body part 8 back and forth from the waist mechanism 2. Oscillating motion is possible.
- the base portion 1 is rectangular, one side of the opposing short sides of the base portion 1 is defined as a front end portion (end portion 1F on the left front side in FIG. 2), and the other side is defined as a rear end portion. Part (end part 1B on the right back side in FIG. 2).
- the right end portion (the end portion on one side of the long side facing the base portion 1) is the right end portion 1R with respect to the front end portion 1F, and the left end portion (the long side facing the base portion 1). Of the other side) is defined as a left end 1L.
- the body portion 8 is composed of a rectangular frame body composed of a pair of rectangular columnar vertical frame members 8a and a pair of square columnar horizontal frame members 8b.
- the upper end portion of the body portion 8 has a left arm 3a and a right side on both sides.
- the arms 3b are rotatably arranged independently of each other.
- the right arm 3b has a symmetric structure with the left arm 3a, and both the arms 3a and 3b have the same structure. Therefore, in the following, when describing the configuration of the arms 3a and 3b, the arm 3 is a representative example. Will be described.
- the arm 3 has a two-link configuration including a first link 6 that is an upper arm and a second link 7 that is a forearm.
- the base end portion of the first link 6 is connected to the upper end portion of the body portion 8 by the first joint 9 and the second joint 10 which are shoulder joints.
- Two joints are relatively rotatable around 10 axes. That is, the first joint 9 enables the rotation of the first link 6 around the first joint shaft 12 along the axial direction of each vertical frame member 8a of the body portion 8, and the second joint 10
- the first link 6 can be turned around the second joint shaft 13 along the axial direction of the lateral frame member 8b on the upper side of the body portion 8.
- tip part of the 1st link 6 and the base end part of the 2nd link 7 are relatively rotatable by the 3rd joint 11 which is an elbow joint.
- the third joint 11 is an elbow joint.
- the second link 7 around the third joint axis 14 parallel to the second joint axis 13 can be rotated with respect to the first link 6.
- the first joint 9, the second joint 10, and the third joint 11 of the arm 3 are provided with an encoder 37 that is an example of a joint angle sensor, and rotation angles (joint angle vectors) of the joints 9, 10, 11.
- q [q 1 , q 2 , q 3 ] T can be detected respectively.
- q 1 , q 2 , and q 3 are joint angles of the first joint 9, the second joint 10, and the third joint 11, respectively.
- Information on the rotation angle detected by the encoder 37 is output to the control device 38.
- Reference numerals 15a, 15b, 15c, 15d, 16a, 16b, 17a, 17b, 17c, 17d, 18a, 18b, 18c, 18d, 18e, and 18f are pneumatic artificial muscles that change the air pressure inside each pneumatic artificial muscle. This acts as an example of an actuator for a robot arm that contracts and expands to drive the joints 6, 10, 11, and 2A of the left arm 3a, the right arm 3b, and the waist mechanism 2.
- the pneumatic artificial muscles 15a, 15b, 15c, and 15d function as an arm third joint driving member that performs rotational driving around the third joint axis 14 by the third joint 11.
- the pneumatic artificial muscles 16 a and 16 b function as an arm second joint driving member that performs rotational driving around the second joint axis 13 by the second joint 10.
- the pneumatic artificial muscles 17a, 17b, 17c, and 17d function as an arm first joint driving member that performs rotational driving around the first joint axis 12 by the first joint 9.
- the pneumatic artificial muscles 18a, 18b, 18c, 18d, 18e, and 18f function as a lock operation drive member that drives a lock operation of a joint lock mechanism 28 described later.
- the pneumatic artificial muscle 19 is a pneumatic artificial muscle that functions as an example of a waist joint actuator or a waist mechanism drive member, and the pneumatic artificial muscle 19 functions as a translational drive actuator that rotates around the joint axis 2A of the waist mechanism 2.
- the pneumatic artificial muscles 15a, 15b, 15c, 15d, 16a, 16b, 17a, 17b, 17c, and 17d, and the rotational movement around the third joint axis 14 by the third joint 11 is taken as an example. ,explain.
- the pneumatic artificial muscles 15a and 15b are arranged on the front side and both sides of the first link 6, and the pneumatic artificial muscles 15c and 15d are arranged on the rear side and both sides of the first link 6.
- the pneumatic artificial muscles 15a, 15b, 15c, and 15d are rotatably fixed at their one end portions (upper end portions) to the base end portion of the first link 6 in the vicinity of the second joint 10, Side end) is fixed to the base end portion of the second link 7 so as to be rotatable in the vicinity of the third joint 11. Further, at the base end of the second link 7, the other ends of the front pneumatic artificial muscles 15 a and 15 b and the other ends of the rear pneumatic artificial muscles 15 c and 15 d are connected to the third joint shaft 14 of the third joint 11. Each is fixed at a symmetrical position in the center.
- the pneumatic artificial muscles 15a and 15b and the pneumatic artificial muscles 15c and 15d are contracted and expanded by changing the air pressure inside the pneumatic artificial muscles 15a and 15b on the front side and the pneumatic artificial muscles 15c and 15d on the rear side, respectively.
- the pneumatic artificial muscles 15 a and 15 b and the pneumatic artificial muscles 15 c and 15 d antagonize, and a rotational motion occurs around the third joint axis 14 of the third joint 11, so that the first link 6 and the second link 7 are relative to each other. Movement is driven.
- the second link 7 is connected to the first link 6 in FIG.
- the rotational motion of the second joint 10 around the second joint axis 13 is driven by the antagonistic drive of the front pneumatic artificial muscle 16a and the rear pneumatic artificial muscle 16b. That is, the two front pneumatic artificial muscles 16a are arranged on the front side of the trunk portion 8 and in the vicinity of the vertical frame member 8a, and the two rear pneumatic artificial muscles 16b are on the rear side of the trunk portion 8 and vertically. It arrange
- Each of the pneumatic artificial muscles 16a and 16b can be rotated to both ends of the upper bar-shaped link member 8c fixed to the base end of the upper link 6 at one end (upper end) in the vicinity of the second joint 10.
- Each other end portion (lower end portion) is fixed to both end portions of the lower bar-shaped link member 8d fixed to the lower end portion of the body portion 8 in the vicinity of the rotating shaft 2A of the waist mechanism 2. ing.
- the other end of the front pneumatic artificial muscle 16a and the other end of the rear pneumatic artificial muscle 16b are arranged at symmetrical positions with respect to the trunk portion 8.
- the pneumatic artificial muscle 16a and the pneumatic artificial muscle 16b are contracted and extended by changing the air pressure inside the front pneumatic artificial muscle 16a and the rear pneumatic artificial muscle 16b, respectively, the pneumatic artificial muscle 16a and the pneumatic artificial muscle 16b is antagonized, and a rotational motion is generated around the second joint axis 13 of the second joint 10, and the relative rotational motion between the body portion 8 and the arm 3 is driven.
- the arm 3 moves around the second joint axis 13 of the second joint 10 in FIG. Rotate clockwise and back.
- the front pneumatic artificial muscle 16a is contracted and the rear pneumatic artificial muscle 16b is driven to extend, the arm 3 moves around the second joint axis 13 of the second joint 10 in FIG. It turns clockwise and turns to the front.
- the rotational motion of the first joint 9 around the first joint axis 12 is caused by the antagonistic drive of the front upper and rear lower pneumatic artificial muscles 17a and the front lower and rear upper pneumatic artificial muscles 17b. Motion is transmitted and driven by the connecting member 20.
- the driving method of the first joint 9 will be described in detail with reference to FIG. 22 taking the case of the right arm 3b as an example. 22 is a cross-sectional view taken along the line AA in FIG. End portions of the pneumatic artificial muscles 17 a and 17 b are connected to a swing link 94, and the swing link 94 can rotate around a swing link rotation shaft 95.
- the swing link 94 When the pneumatic artificial muscle 17a contracts and the pneumatic artificial muscle 17b extends, the swing link 94 generates a rotational motion indicated by an arrow U, and the swing link 94 is connected to the connecting member 20b on the connecting shaft 96. The rotational motion of the moving link 94 is transmitted, and the rotational motion indicated by the arrow V around the first joint 9 of the right arm 3b is driven. Similarly, in the case of the left arm 3a, the first joint is driven by driving the connecting member 20a by the pneumatic artificial muscles 17a and 17b disposed in the lower part.
- FIG. 4A shows a front view of the pneumatic artificial muscle 15a in a decompressed state
- FIG. 4B shows a front view of the pneumatic artificial muscle 15a in a pressurized state
- FIG. 4C shows a pneumatic artificial muscle.
- a cross-sectional view of the muscle 15a is shown.
- the other pneumatic artificial muscles 15b, 15c, 15d, 16a, 16b, 17a, 17b, 17c, 17d and 18a, 18b, 18c, 18d, 18e, 18f, 19 described later have the same structure.
- the artificial muscle 15a will be taken as a representative for explanation. As shown in FIG.
- the pneumatic artificial muscle 15a is a constraining member formed by knitting in a mesh shape with a resin or metal fiber cord which is hardly stretched on the outer surface of a tubular elastic body 21 made of a rubber material. 22 is provided, and both ends of the tubular elastic body 21 are hermetically sealed by the sealing members 23, respectively.
- a compressive fluid such as air into the tubular elastic body 21 through the fluid injection member 24
- the tubular elastic body 21 tends to expand mainly in the radial direction.
- the tubular elastic body 21 is converted into a contracting motion in the central axis direction, and the entire length contracts. Since the pneumatic artificial muscle 15a is mainly composed of an elastic body, the pneumatic artificial muscle 15a is characterized by being a flexible, safe and lightweight actuator.
- FIG. 5 is a diagram showing a configuration of an air pressure supply drive system for driving the pneumatic artificial muscle 15a.
- reference numeral 25 denotes an air pressure source such as a compressor
- 26 denotes an air pressure adjusting unit in which an air pressure filter 26a, an air pressure reducing valve 26b, and an air pressure lubricator 26c are combined.
- Reference numeral 38 denotes a control device constituted by, for example, a general personal computer, which is equipped with a D / A board 41 and outputs a voltage command value to the 5-port flow rate control electromagnetic valve 27 to thereby inject each fluid into and out of the fluid.
- the flow rate of each air flowing through the members 24a and 24b can be controlled. Details of the control device 38 will be described later.
- the high-pressure air generated by the air pressure source 25 is depressurized by the air pressure adjusting unit 26, adjusted to a constant pressure of, for example, 600 kPa, and supplied to the 5-port flow rate control electromagnetic valve 27.
- the opening degree of the 5-port flow rate control electromagnetic valve 27 is controlled in proportion to the voltage command value output from the control device 38 via the D / A board 41.
- the five-port flow control solenoid valve 27 is connected to a pair of pneumatic artificial muscles 15a and 15b and a pair of pneumatic artificial muscles 15c and 15d, and a fluid injecting member 24 of the tubular elastic body 21.
- the pair of pneumatic artificial muscles 15a and 15b and the pair of pneumatic artificial muscles 15c and 15d are arranged substantially in parallel along the longitudinal direction of the first link 6, and the ends of the respective tubular elastic bodies 21 on the fluid injecting member 24 side are arranged.
- the first link 6 is fixed to the end of the second joint 10 side.
- the other ends of the tubular elastic bodies 21 of the pair of pneumatic artificial muscles 15a and 15b and the pair of pneumatic artificial muscles 15c and 15d are rotatably supported by the second link 7.
- the pneumatic artificial muscles 15b and 15d are not shown because they are located in the shadowed areas behind the pneumatic artificial muscles 15a and 15c, respectively.
- the tubular link 21 of the pair of pneumatic artificial muscles 15a and 15b and the pair of pneumatic artificial muscles 15c and 15d expands and contracts, so that the second link 7 is the third of the third joint 11. It is driven to rotate forward and backward around the joint axis 14.
- the right rotation shown by the arrow X in FIG. 5 is the forward direction
- the left rotation opposite to the arrow X is the reverse direction.
- An air flow having a flow rate proportional to the value is exhausted from the pneumatic artificial muscles 15c and 15d to the atmosphere. Accordingly, the total length of each of the pneumatic artificial muscles 15a and 15b is reduced and the total length of each of the pneumatic artificial muscles 15c and 15d is increased, whereby the absolute value of the voltage command value is changed from the state shown in FIG. 6A to the state shown in FIG.
- the third joint 11 performs a clockwise rotational movement indicated by an arrow Y around the third joint axis 14 at a speed proportional to
- the 5-port flow rate control electromagnetic valve 27 is switched and the air pressure is changed.
- the circuit symbol B is entered, the operations of the pneumatic artificial muscles 15a and 15b and the pneumatic artificial muscles 15c and 15d are reversed, and the third joint 11 performs the left rotation around the third joint axis 14. That is, the flow path from the air pressure source 25 side to the fluid injecting member 24 side of each tubular elastic body 21 of the pneumatic artificial muscles 15c and 15d is opened via the 5-port flow control electromagnetic valve 27, and the absolute value of the voltage command value is set.
- Air having a flow rate proportional to the value is supplied to the pneumatic artificial muscles 15c and 15d.
- the flow path from the fluid injection member 24 of each tubular elastic body 21 to the atmospheric pressure side is opened via the 5-port flow control electromagnetic valve 27, and the absolute value of the voltage command value is set.
- An air flow having a flow rate proportional to the value is exhausted from the pneumatic artificial muscles 15a and 15b to the atmosphere. Accordingly, the total length of each of the pneumatic artificial muscles 15c and 15d is reduced, and the total length of each of the pneumatic artificial muscles 15a and 15b is extended, whereby the absolute value of the voltage command value is changed from the state shown in FIG. 6A to the state shown in FIG.
- the third joint 11 rotates counterclockwise as indicated by an arrow Z around the third joint axis 14 at a speed proportional to.
- the joints 9, 10, 11 of the arm 3 include joint lock mechanisms 28 a, 28 b, 28 c, 28 d, 28 e, 28 f for fixing the joints 9, 10, 11, respectively.
- the second joint 10 of the left arm 3a, the third joint 11 of the left arm 3a, the first joint 9 of the right arm 3b, the second joint 10 of the right arm 3b, and the third joint 11 of the right arm 3b. are arranged. Since each joint lock mechanism 28a, 28b, 28c, 28d, 28e, 28f has a similar structure, in the following, when describing the structure of each joint lock mechanism 28a, 28b, 28c, 28d, 28e, 28f, etc. As an example, the joint lock mechanism 28 will be described.
- FIG. 7A to 7C show details of the joint lock mechanism 28.
- FIG. FIG. 7A is a cross-sectional view through the joint axis.
- FIG. 7B is a view seen from the direction of arrow V in FIG. 7A, that is, a view of the surface on which the gear portion of one of the opposing gears is formed seen from the axial direction of the joint axis.
- FIG. 7C is an external side view of two opposed gears.
- FIG. 8 shows details of the drive mechanism of the joint lock mechanism 28.
- FIG. 8 is a view of the first link 6 of the left arm 3a as viewed from the direction of the arrow W shown in FIG. In the case of the first link 6 of the right arm 3b, the structure shown in FIG.
- reference numeral 29 denotes a disk-like fixed opposing gear having an annular shape on the surface facing the gear portion 29a, and the joint shaft of the joint that performs the locking and unlocking operation is inserted into the center in a non-rotatable manner.
- a circular hole 29b to be joined is opened, and is fixed so as not to move relative to the structure close to the base portion 1 and the joint axis among the structures connected by the joint.
- the fixed opposing gear 29 is fixed to the first link 6 and the third joint shaft 14 as examples of the structure and joint shaft on the side close to the base portion 1.
- the distal end of the third joint shaft 14 of the third joint 11 passes through the hole 29b of the fixed opposing gear 29 and is inserted and fitted so as not to be relatively rotatable. That is, the third joint shaft 14 and the fixed opposing gear 29 are integrally fixed.
- the 1st link 6 and the 2nd link 7 are connected with the bearing 70 in the 3rd joint 11 so that relative rotation is possible.
- 7g is a collar that can rotate integrally with the second link 7 and can rotate relative to the first link 6 by a bearing 70
- 28g is a casing in which a pressing spring 33 and the like to be described later are disposed.
- Reference numeral 30 denotes a disk-shaped movable opposing gear having a ring-shaped gear portion 30a that can mesh with the gear portion 29a of the fixed opposing gear 29, and a circular concave portion 30b that can communicate with the hole 29b at the center.
- the joint shaft (for example, in the case of the joint lock mechanism 28c of the third joint 11 described above), the joint shaft (for example, the distal end portion of the third joint shaft 14) is relatively rotatable and moves in the axial direction in the recess 30b. It is arranged so as to face the fixed opposing gear 29 in such a manner that it can be inserted.
- the movable counter gear 30 is not fixed to the joint shaft, can be translated in the axial direction of the joint shaft, and can rotate about the rotation axis.
- a guide protrusion 31 protruding in the radial direction is provided at one place on the outer peripheral surface of the movable counter gear 30, and the guide groove disposed in the structure closer to the hand among the structures connected by the joint. 32 is engaged.
- the guide groove 32 is disposed in the second link 7 (see FIG. 7B).
- the guide protrusion 31 is relatively movable with respect to the guide groove 32 along the longitudinal direction of the guide groove 32 (the through direction in FIG. 7B, that is, the thickness direction of the movable counter gear 30).
- the movable opposing gear 30 and the structure on the side close to the hand can be relatively translated in the central axis direction of the joint axis (in the above case, the third joint axis 14).
- the movable opposing gear 30 and the structure on the side close to the hand are restrained by the engagement of the guide protrusion 31 and the guide groove 32. With 7), it will rotate integrally.
- FIG. 7A shows a state where the guide protrusion 31 and the guide groove 32 are disengaged.
- the gear portion 29a on the opposing surface of the fixed opposing gear 29 and the gear portion 30a on the opposing surface of the movable opposing gear 30 each have a sawtooth cross section, and the movable opposing gear 30 is opposite to the stationary opposing gear 29.
- the fixed opposing gear 29 and the movable opposing gear 30 are engaged with each other by being pressed by the urging force of the pressing spring 33 arranged in the collar 7g of the casing 28g along the central axis direction of the movable opposing gear 30. It functions as the opposing gears 29 and 30.
- the joint lock mechanism 28 functions as a one-way clutch.
- the movable counter gear 30 is a pneumatic artificial muscle 18 (specifically, pneumatic artificial muscles 18a, 18b, 18c) for driving a joint locking mechanism via a control cable 57 constituted by an outer guide tube 55 and a pulling wire 56. , 18d, 18e, and 18f, but when the structure is described, a typical example is 18).
- FIG. 7A shows a state in which the guide protrusion 31 and the guide groove 32 are disengaged.
- the movable counter gear 30 is moved in the central axis direction by the pulling wire 56 from the fixed counter gear 29.
- the gear part 29a and the gear part 30a have moved away from each other (left side in FIG. 7A).
- the pneumatic artificial muscle 18 is driven and the movable opposing gear 30 is moved in the direction of the central axis by the pulling wire 56 to the side approaching the fixed opposing gear 29 (right side in FIG. 7A), the gear portion 29a and the gear portion are moved. 30a is in a state of being bitten.
- the pneumatic artificial muscle 18a (shown in FIG. 3) is disposed on the base portion 1 and drives the joint lock mechanism 28a of the first joint 9 of the left arm 3a.
- the pneumatic artificial muscle 18b (arranged behind the pneumatic artificial muscle 18a in FIG. 3) is arranged on the base portion 1 and drives the joint locking mechanism 28b of the first joint 9 of the right arm 3b.
- the pneumatic artificial muscle 18c (arranged behind the pneumatic artificial muscle 18e in FIG. 8) is arranged inside the first link 6 of the left arm 3a, and drives the joint lock mechanism 28c of the second joint 10 of the left arm 3a.
- the pneumatic artificial muscle 18d (arranged in the right arm 3b as in the pneumatic artificial muscle 18c in FIG. 8) is arranged inside the first link 6 of the right arm 3b, and the joint lock of the second joint 10 of the right arm 3b.
- the mechanism 28d is driven.
- the pneumatic artificial muscle 18e (shown in FIG. 8) is disposed inside the first link 6 of the left arm 3a, and drives the joint locking mechanism 28e of the third joint 11 of the left arm 3a.
- the pneumatic artificial muscle 18f (arranged in the right arm 3b as in the pneumatic artificial muscle 18e in FIG. 8) is arranged inside the first link 6 of the right arm 3b, and the joint lock of the third joint 11 of the right arm 3b.
- the mechanism 28f is driven.
- the direction in which the joint lock mechanism 28 can rotate as the one-way clutch is set to the rotation direction indicated by the arrow R in FIGS.
- the direction in which this is applied (the direction in which relative rotation is not possible) is arranged so as to be in the direction opposite to the arrow R in the figure.
- the waist mechanism 2 will be described with reference to FIGS. 3, 9A, and 9B.
- the waist mechanism 2 is driven by the pneumatic artificial muscle 19.
- One end of the pneumatic artificial muscle 19 is rotatably fixed to the base portion 1, and the other end is rotatably fixed to the rear end portion of the force transmission lever 34.
- a front end portion of the force transmission lever 34 is fixed to the body portion 8. If high-pressure air is supplied to the pneumatic artificial muscle 19 to contract the pneumatic artificial muscle 19, the force transmission lever 34 is pulled backward, and the body portion 8 swings around the joint axis 2A of the waist mechanism 2.
- 9A rises from the forward tilted state of the body part 8 shown in FIG. 9A to the upright state of the body part 8 shown in FIG. 9B.
- the trunk portion 8 is in an upright state of the trunk portion 8 shown in FIG. 9B due to the weight of the trunk portion 8 or the arm 3.
- the body part 8 shown in FIG. 9A falls forward to the forward inclined state.
- the pneumatic artificial muscle 19 that drives the lower back mechanism 2 is provided with a pressure sensor 67 (see FIG. 3) connected to the control device 38, and the pressure sensor 67 measures the pressure inside the pneumatic artificial muscle 19. It is possible. From the internal pressure P p of the pneumatic artificial muscle 19 by the pressure sensor 67 and the strain ⁇ of the pneumatic artificial muscle 19 obtained from the angle information of the encoder 37 of the joint shaft 2A of the waist mechanism 2, the robot lifts a load such as a heavy object. The operation mode switching means 47 can determine whether or not it is in the state.
- the internal pressure P p , the strain ⁇ , and the contraction force F of the pneumatic artificial muscle 19 have the relationship shown in FIG.
- the contraction force F p can be calculated by the contraction force calculation means 194 from the internal pressure P p and the strain ⁇ of the pneumatic artificial muscle 19, and the calculated contraction force F p is calculated by the robot as a heavy object or the like.
- the operation mode switching means 47 can determine that the robot is lifting a heavy load or the like.
- the determination information as to whether or not the robot is lifting a heavy load or the like is performed by an operation mode switching unit 47 described later, and the determination result is output to a joint lock mechanism control unit 59 described later.
- a triaxial force sensor 35 that functions as an example of an external force detection device that can detect translational forces in three directions near the center of the second link 7 of the arm 3.
- the force sensor 35 is provided with a force detection exterior cover 36 that is not in contact with the structure of the second link 7 with a gap therebetween, and the force sensor 35 includes the force detection exterior cover 36 and the third arm 3.
- the force acting between the two links 7 is detected and output to the control device 38.
- the force detection exterior cover 36 is configured to cover substantially half of the outer surface of the second link 7 in the cross section in the width direction and most of the second link 7 in the link length direction, and a large part of the surface of the second link 7.
- a force sensor 35 is disposed so as to be positioned below the arm 3 in the transport basic posture shown in FIGS. 2 and 3, and even when a cared person or a transported object is placed on the upper surface of the arm 3. Since the force sensor 35 does not come into contact with the caregiver or the transported object, the external force can be detected by the force sensor 35 without being affected by the cared person or the transported object.
- the control device 38 shown in FIG. 1 and FIG. 5 is configured by a general personal computer in terms of hardware, and the portions other than the input / output IF 40 are in software as a control program 39 executed by the personal computer. Realized.
- the input / output IF 40 includes a D / A board 41, an A / D board 42, and a counter board 43 connected to an expansion throttle such as a PCI bus of a personal computer.
- the control device 38 functions by executing a control program 39 for controlling the operation of the robot, and the joint angles output from the encoders 37 of the joints 9, 10, and 11 of the left arm 3a and the right arm 3b. Information is taken into the control device 38 through the counter board 43, and external force information detected by the force sensor 35 disposed on the left arm 3a and the right arm 3b is taken into the control device 38 through the A / D board 42, respectively. Then, the control command value for the rotational movement of each joint is calculated by the control device 38.
- the calculated control command values are given to the 5-port flow rate control solenoid valve 27 through the D / A board 41, and the 5-port flow rate control solenoid valve 27 uses the pneumatic artificial muscles 15a of the joints 9, 10, 11 of the arm 3 to 15b, 15c, 15d, 16a, 16b are driven.
- reference numeral 58 denotes an operation mode changeover switch, which is provided with three buttons, a forward button 64, a backward button 65, and a stop button 66. Information on which button is pressed is digitally transmitted through I / O. Input to the control device 38.
- FIG. 12 is a block diagram of a robot control system realized by a control program 39 executed in the control device 38.
- it is a block diagram showing the configuration of the robot operation control means 44 that controls the operation of the robot by the control program 39 based on the information from the input / output IF 40.
- the robot control system is configured to include an operation mode switching unit 47 and an impedance control unit 45.
- the impedance control means 45 includes a left arm impedance control means 45a, a right arm impedance control means 45b, and a waist mechanism impedance control means 45p.
- the impedance control unit 45 will be described in detail as a representative.
- the suffix i is L or R, which means an input / output signal in the left arm impedance control means 45a or the right arm impedance control means 45b, respectively.
- the joint angle q i of the arm 3 is the joint angle q L of the left arm 3a that is an input signal of the left arm impedance control unit 45a or the joint angle q R of the right arm 3b that is an input signal of the right arm impedance control unit 45b.
- Means for ease of understanding, separate left and right letters or numbers are shown in parentheses after representative letters or numbers.
- the impedance control means 45 (45a or 45b) is configured to include an impedance calculation means 46 (46a or 46b) and a position control means 49 (49a or 49b).
- the force F iL (F LL or F RL ) measured by the force sensor 35 is input to the impedance calculation means 46 (46a or 46b), and the hand target correction value r id ⁇ (r Ld ⁇ or r Rd ⁇ ) is the impedance calculation means. 46 (46a or 46b).
- the position control means 49 adds the hand target correction value r id ⁇ (r) to the position target value r id (r Ld or r Rd ) of the arm 3 (3a or 3b) input from the target trajectory generation means 48.
- the value r idm (r Ldm or r Rdm ) obtained by adding Ld ⁇ or r Rd ⁇ ) by the impedance control means 45 (45a or 45b) and the joint angle q i (q of the arm 3 (3a or 3b) measured by the encoder 37 L or q R ) is input, and the joint command value u iq (u Lq or u Rq ) is output from the position control means 49 (49a or 49b), and becomes a command value to the arm 3 (3a or 3b).
- the impedance calculation means 46 (46a or 46b) is a part that performs the function of realizing the mechanical impedance in the arm 3 (3a or 3b), and is the impedance parameter inertia M, viscosity D, elasticity K, and the current value of the joint angle.
- a hand position target correction output for realizing mechanical impedance in the arm 3 (3a or 3b).
- r id ⁇ (r Ld ⁇ or r Rd ⁇ ) is calculated by the impedance calculating means 46 (46a or 46b) according to the following equation (1) and output.
- the hand position target correction output r id ⁇ (r Ld ⁇ or r Rd ⁇ ) is added to the hand position target r id (r Ld or r Rd ) output from the target trajectory generating means 48 by the impedance control means 45 (45a or 45b), A hand position correction target vector r idm (r Ldm or r Rdm ) is generated.
- FIG. 13 is a diagram showing details of the position control means 49 (49a or 49b).
- 53 is position error compensation means, and a hand position vector r calculated by the forward kinematics calculation means 52 from the current value q i (q L or q R ) of the joint angle vector measured in the arm 3 (3a or 3b).
- An error r ie (r Le or r Re ) between i (r L or r R ) and the hand correction target vector r idm (r Ldm or r Rdm ) is input to the position error compensation unit 53, and the position error compensation unit 53
- the position error compensation output u ire (u Lre or u Rre ) is output to the approximate inverse kinematics calculation means 54.
- the approximate inverse kinematics calculation means 54 also receives the current value q i (q L or q R ) of the joint angle vector measured in the arm 3 (3a or 3b).
- the position error compensation means 53 receives a joint lock command from a joint lock mechanism control means 59, which will be described later.
- the position error compensation servo gain is set to that in the unlocked state. For example, by setting the value to a low value such as 1 ⁇ 2 (the size of the position error compensation output u ire is halved), the servo rigidity of the position control is reduced.
- the position error compensation output u ire (u Lre or u Rre ) is input to the approximate inverse kinematics calculation unit 54, the approximation reverse kinematical calculation unit output from the 54 joint angle error q ie (q Le or q Re) joint angle error compensating output u iqe to compensate for the (U Lqe or u Rqe ) is output.
- a joint angle vector q i (q L or q R ), which is a current value q of the joint angle measured by the encoder 37 of each joint shaft 12, 13, 14 output from the arm 3 (3a or 3b).
- Geometrical science of conversion from the joint angle vector q i (q L or q R ) of the arm 3 (3a or 3b) to the hand position vector r i (r L or r R ) Perform a statistical calculation.
- the basic operation is feedback control (position control) of the hand position error r ie (r Le or r Re ) by the position error compensation means 53. If, for example, a PID compensator is used as the position error compensation means 53, the control is performed so that the hand position error r ie (r Le or r Re ) converges to 0, and the target arm 3 (3a or 3b) Is realized.
- the hand position correction output r id ⁇ (r Ld ⁇ or r Rd ⁇ ) is set to the position target value r id (r Ld or r Rd ) of the arm 3 (3a or 3b) by the impedance calculating means 46 (46a or 46b). Is corrected to the target value r id (r Ld or r Rd ) of the hand position. For this reason, in the above-described position control system, the target value of the hand position slightly deviates from the original value, and as a result, mechanical impedance is realized. Since the hand position target correction output r id ⁇ (r Ld ⁇ or r Rd ⁇ ) is calculated by the equation (1), the mechanical impedance of the inertia M, the viscosity D, and the stiffness K is realized.
- the operator of the robot holds the force detection exterior cover 36 that functions as an example of the exterior member of the arm 3 (3a or 3b) by hand to detect the force.
- the arm 3 (3a or 3b) operates in the direction in which the force is applied. Therefore, simply holding and moving the arm 3 (3a or 3b) allows the arm 3 (3a or 3b) to move. The operation of 3b) can be performed, and positioning can be performed easily.
- the configuration of the waist mechanism impedance control means 45p is the same as that of the impedance control means 45 (45a or 45b), but the dimension is one-dimensional.
- the calculation by the waist impedance calculation means 50 is based on the impedance parameter inertia m, the viscosity d, the elasticity k, the current value q p of the waist angle, and the external force F i (F L or F R ) detected by the force sensor 35.
- the hip angle target correction output qp ⁇ d is calculated by the following equation (5) and output.
- the hip angle target correction output q p ⁇ d is added to the hip angle target q pd output from the target trajectory generating means 48 to generate a hip angle correction target vector q pdm .
- s is a Laplace operator
- F z is the vertical component of the detected value of the vertical component F Lz and the right arm 3b of the force sensor 35 of the detection value of the force sensor 35 of the left arm 3a Of FRZ , the value with the larger absolute value is selected. Selection of the value of F z (F Lz or F Rz ) is performed by the force sensor selection means 51. As a result, the waist mechanism 2 operates even when an external force is input to either the force sensor 35 of the left arm 3a or the force sensor 35 of the right arm 3b.
- the angle control means 60 has the configuration shown in FIG. 14, and the waist angle error q pe between the generated waist angle correction target vector q pdm and the waist angle q p is input to the angle error compensation means 61 and the angle error is calculated.
- a waist angle command value u pqe is output from the compensation means 61 toward the waist mechanism 2. If, for example, a PID compensator is used as the angle error compensation means 61, the angle control means 60 performs control so that the waist angle error q pe converges to 0, and the target operation of the waist mechanism 2 is realized.
- the operator of the robot can lift the force detection exterior cover 36 by manually holding either the left arm 3a, the right arm 3b, or both simultaneously.
- the waist mechanism 2 rises and the entire arm 3 rises.
- the waist mechanism 2 operates so as to fall forward.
- the entire arm 3 is lowered.
- the operation mode switching means 47 receives the hand position vector r i (r L or r R ) from the position control means 49 (49a or 49b) and the current value q p of the waist angle from the waist mechanism 2, and the operation shown in FIG.
- the operation sequence is controlled based on the sequence table (details will be described later), the control mode is switched between the left arm impedance control means 45a, the right arm impedance control means 45b, and the waist mechanism impedance control means 45p, and the joint lock mechanism control means 59 is selected.
- the switching operation between the lock operation and the lock release of the joint lock mechanism 28 via, and the operation command to the target trajectory generating means 48 are performed.
- the operation mode switching means 47 advances to the next sequence when the forward button 64 of the operation mode changeover switch 58 is pressed, and returns to the previous sequence when the backward button 65 of the operation mode changeover switch 58 is pressed.
- the control mode is switched according to each step.
- the operation mode changeover means 47 stops the operation of the target trajectory generation means 48 and sets the control mode of the left arm 3a and the right arm 3b to the position. For control, the control mode of the waist mechanism 2 is switched to the angle control mode.
- the operation of the target trajectory generating unit 48 is stopped, the target trajectory output at the moment when the operation is stopped continues to be output without being updated. Therefore, the operations of the left arm 3a, the right arm 3b, and the waist mechanism 2 are stopped.
- the robot operation stops. This stop operation is effective when it is desired to immediately stop the robot operation, such as when the robot operation becomes abnormal.
- the operation mode switching means 47 switches between the position control mode and the impedance control mode.
- the operation mode switching unit 47 sets the output of the impedance calculation unit 46 to 0 so that the operation of the arm 3 (3a or 3b) functions as position control following the hand position target value.
- the impedance control mode by enabling the output of the impedance calculating means 46 (46a or 46b), the impedance for operating the arm 3 (3a or 3b) to have a mechanical impedance characteristic set with respect to the external force. To act as a control.
- the operation mode switching means 47 functions as waist angle control for the waist mechanism 2 by setting the output of the waist impedance calculating means 50 to 0 in the angle control mode, while performing impedance control.
- the waist mechanism 2 functions as an impedance control that operates so as to have a mechanical impedance characteristic set for an external force.
- the operation mode switching means 47 sends a command to the joint lock mechanism control means 59 to control the lock operation and the lock release of the joint lock mechanism 28.
- the joint lock mechanism control means 59 Information on whether the arm 3 (3a or 3b) is lifting a heavy load or the like is input to the joint lock mechanism control means 59 from the operation mode switching means 47. Only when it is determined by the mode switching means 47, the lock release operation of the joint lock mechanism 28 is performed by the joint lock mechanism control means 59, and when it is determined by the operation mode switching means 47 that a load such as a heavy object is lifted, The joint lock mechanism control means 59 is operated to be interlocked so that the lock release operation of the mechanism 28 cannot be performed. As a result, when the arm 3 (3a or 3b) is lifting a load such as a heavy object, the lock of the joint lock mechanism 28 is not accidentally released by the joint lock mechanism control means 59. Can be increased.
- the joint lock mechanism control means 59 sends a joint lock command to the position error compensation means 53, and operates to lower the servo rigidity of the position control when the joint is locked.
- the rotational movement of the joint is unnecessarily generated by the position control by the position error compensation means 53, and the fixed opposed gear 29 and the movable opposed gear 30 can be prevented from being engaged with each other with an excessive force.
- the friction between the tooth surfaces contacting the fixed opposing gear 29 and the movable opposing gear 30 can be reduced, and the opening operation can be performed smoothly.
- the target trajectory generation means 48 outputs a hand position target vector r id (r Ld or r Rd ) for realizing the operation of the target arm 3 (3a or 3b).
- the movement of the target arm 3 (3a or 3b) is determined in advance for each passing point in accordance with the target work by positional information (r id0 , r id1 , r id2 ...), That is, (r Ld0 , r Ld1 , R Ld2 ... Or (r Rd0 , r Rd1 , r Rd2 ...),
- a target trajectory generating means 48 using a keyboard which is an example of the external input means (external input apparatus) 93 of the control device 38 as a numerical value.
- the target trajectory generating means 48 supplements the trajectory between the points using polynomial interpolation to generate the hand position target vector r id (r Ld or r Rd ). Regarding the waist angle target value (waist angle target vector) q pd as well as the operation of the arm 3 (3a or 3b), the target trajectory generating means 48 performs the target angle control operation (in other words, the body). The trajectory of the swinging motion of the part 8 is generated.
- the position information (q pd0 , q pd1 , q pd2 ”) Is input in advance to the target trajectory generation unit 48 as a numerical value by the external input unit 93 according to the target work,
- the trajectory generating means 48 complements the trajectory between the points using polynomial interpolation, and generates a waist angle target vector) q pd .
- the operation mode switching means 47 has position information (r id0 , r id1 , r id2. r Ld0 , r Ld1 , r Ld2 ...) or (r Rd0 , r Rd1 , r Rd2 ...)) or (q pd0 , q pd1 , q pd2.
- the trajectory interpolation by means 48 is activated.
- the trajectory interpolation by the target trajectory generating unit 48 is stopped, and the hand position target value r id (r Ld or r Rd ) or the waist angle target value q pd at the moment of switching to the impedance control mode is used as the target trajectory. It is maintained by the generating means 48.
- the target trajectory generation means 48 sets the target hand position r i (r L or r R ) or waist angle q p at the moment of switching.
- a trajectory interpolation is newly operated by the target trajectory generation means 48 from the trajectory start point.
- step S 1 joint angle data (joint variable vector or joint angle vector q i ) (q L or q R ) measured by each encoder 37 is taken into the control device 38.
- step S2 the approximate inverse kinematics calculation unit 54 calculates the Jacobian matrix Jir ( JLr or JRr ) or the like necessary for the kinematics calculation of the arm 3 (3a or 3b).
- step S3 the current hand position vector r i (r) of the arm 3 (3a or 3b) from the joint angle data (joint angle vector q i ) (q L or q R ) from the arm 3 (3a or 3b).
- L or r R is calculated by the forward kinematics calculation means 52, and the calculated current hand position vector r i (r L or r R ) is output (processing in the forward kinematics calculation means 52).
- step S4 the target trajectory generating unit 48 determines a control mode command from the operation mode switching unit 47 (in other words, the control mode is determined based on the command value from the operation mode switching unit 47).
- the target trajectory generation unit 48 determines whether the impedance control mode is selected or the impedance control mode. If the target trajectory generation unit 48 determines that the impedance control mode is selected, the target trajectory generation unit 48 determines the position. If it is determined that the control mode is set, the process proceeds to step S5 ′.
- step S5 in the impedance control mode, the external force F i (F L or F R ) measured by the force sensor 35 is taken into the impedance calculation means 46 (46a or 46b) of the control device 38.
- step S6 in the impedance control mode, the hand position vector r i (r L or r R ) (forward kinematics calculation means) at the moment when the target trajectory calculation means 48 switches to the impedance control mode.
- the hand position vector r i (r L or r R )) calculated at 52 and input to the target trajectory calculation means 48 via the operation mode switching means 47 in FIG. 12 is recorded, and the hand position target vector r id ( r Ld or r Rd ) and held in the impedance control means 45 (45a or 45b).
- step S7 in the impedance control mode, the mechanical impedance parameter inertia M, viscosity D, elasticity K, and force sensor 35 preset in the impedance calculation means 46 (46a or 46b) are measured by the force sensor 35.
- the hand position target correction output r id ⁇ is calculated by the impedance calculation means 46 (impedance Processing in calculation means 46). Thereafter, the process proceeds to step S8.
- step S5 ′ in the case of the position control mode, the hand position target correction output r id ⁇ (r Ld ⁇ or r Rd ⁇ ) is set to 0 vector by the impedance calculation means 46 (processing in the impedance calculation means 46).
- step S6 ′ the target trajectory calculating means 48 calculates the hand position target vector r id (r Ld or r Rd ) of the arm 3 (3a or 3b) and calculates the calculated hand position target.
- the vector r id (r Ld or r Rd ) is output to the impedance control means 45 (45a or 45b). Thereafter, the process proceeds to step S8.
- step S8 the sum of the hand position target vector r id (r Ld or r Rd ) and the hand position target correction output r id ⁇ (r Ld ⁇ or r Rd ⁇ ) is calculated by the impedance control means 45 (45a or 45b).
- the hand position error r rie (r Le or r Re ) is calculated by the position error compensation means 53 (processing in the position error compensation means 53).
- a PID compensator can be considered. Control by the position error compensation means 53 is performed so that the position error converges to 0 by appropriately adjusting three gains of proportionality, differentiation, and integration, which are constant diagonal matrices.
- step S9 the approximate inverse kinematics calculation unit 54 multiplies the inverse matrix of the Jacobian matrix J ir (J Lr or J Rr ) calculated in step S2 by the position error compensation output u ire (u Lre or u Rre ) is converted from a value related to the hand position error to a joint angle error compensation output u iq (u Lqe or u Rqe ) which is a value related to the joint angle error by the approximate inverse kinematics calculation means 54 (approximate inverse kinematics calculation means) 54).
- step S10 the joint angle error compensation output u iq (u Lqe or u Rqe ) is given from the approximate inverse kinematics calculation means 54 to the 5-port flow rate control solenoid valve 27 through the D / A board 41.
- the pneumatic artificial muscles 15a, 15b, 15c, 15d, 16a, 16b, 17a, 17b, 17c, and 17d are respectively driven, and the arm 3 (3a or 3b) is driven.
- Control of the operation of the arm 3 (3a or 3b) and the waist mechanism 2 is realized by repeatedly executing the above steps S1 to S10 as a control calculation loop.
- sequence 2 left arm operation
- the left arm 3a enters the impedance control mode, and when the operator applies force with the hand 90 to the force detection exterior cover 36 of the second link 7 of the left arm 3a, the left arm 3a operates. Therefore, a person (operator) can operate the left arm 3a by grasping the force detection exterior cover 36 of the second link 7 of the left arm 3a with a hand 90, as shown in FIG. 17B. Then, the left arm 3a is inserted and arranged below the transport object 62, and the transport object support ready state of FIG. 17C is reached.
- the support leg 63 that supports the transport object 62 has a structure as shown in FIG. 18 as viewed from the direction indicated by the arrow U in FIG. It can be inserted and placed below. That is, in FIG. 18, the support leg 63 is configured by laying two horizontal struts 63b between a pair of vertical struts 63a having a lower end fixed to the support plate 63d and a transport object placing plate 63c fixed to the upper end. In the state where the transport object 62 is placed on the pair of transport object placing plates 63c, the space 63p is provided in which the left arm 3a and the right arm 3b can be inserted between the pair of vertical columns 63a. .
- the second link 7 of the left arm 3a is arranged. Can be arranged below one side of the transport object 62.
- the caregiver when carrying out the care lifting work, the caregiver lifts the cared person's upper body or leg so that it is slightly lifted from the bed or the like, and the left arm 3a is inserted into the created gap.
- sequence 5 (lifting / lowering)
- the waist mechanism 2 is switched to impedance control, and a human (operator) hand 90 is placed on the force detection exterior cover 36 of the second link 7 of either the left arm 3a or the right arm 3b.
- the waist mechanism 2 is operated, so that a person (operator) grasps the force detection exterior cover 36 of the second link 7 with the hand 90 and pushes up the second link 7.
- both the left arm 3a and the right arm 3b are lifted simultaneously by the movement of the waist mechanism 2, and the lift of the transport object 62 is realized, and the transport object support preparation state of FIG. The object is lifted.
- a person grasps and pulls down the force detection exterior cover 36 of the second link 7 so that the left arm 3a and the right arm 3b are lowered by the operation of the waist mechanism 2,
- the transport object 62 is lowered, and the transport object 62 returns to the state of FIG.
- sequence 7 (left arm operation)>
- the left arm 3a is in the impedance control mode in the state of FIG. 17C in which the transport object 62 is supported by the support legs 63, and the force detection exterior cover of the second link 7 of the left arm 3a.
- the left arm 3a starts to operate, so that a person (operator) operates the left arm 3a by holding the force detection exterior cover 36 of the second link 7 with the hand 90.
- the left arm 3a is detached from the space 63p below the transport object 62 supported by the support legs 63, and the state returns to the initial state of FIG. 17A through the state of FIG. 17B.
- sequence 8 (right arm operation)>
- the right arm 3b is in the impedance control mode in the state of FIG. 17C in which the transport object 62 is supported by the support legs 63, and the force detection exterior cover of the second link 7 of the right arm 3b.
- the right arm 3b starts to operate, so that a person (operator) operates the right arm 3b by holding the force detection exterior cover 36 of the second link 7 with the hand 90.
- the right arm 3b can be detached from the space 63p below the transport object 62 supported by the support legs 63. Thereafter, returning to the sequence 1 and repeating the steps (sequences), the operation becomes possible continuously.
- the operation mode switching means 47 advances the above operation sequence to the next sequence when the forward button 64 of the operation mode changeover switch 58 is pressed, and returns to the previous sequence when the backward button 65 is pressed.
- a series of operations are realized to enable transportation work or care lifting work.
- the arms 3a and 3b are mechanically loaded with the weight of the transport object 62 when the joints 9, 10 and 11 are locked. Therefore, it is not necessary to provide a strong actuator, and the light arm 3 can be obtained. Further, if the joints 9, 10, and 11 are made free, the degree of freedom due to the arm structure can be effectively utilized, the degree of freedom in positioning with respect to the transport object 62 can be increased, and an easy-to-use robot. It can be.
- the hip mechanism 2 is provided, so that the strong actuator for lifting heavy objects can be the hip mechanism 2 only, and a high power with a simple and lightweight configuration. It can be.
- the joint lock mechanism 28 By making the joint lock mechanism 28 a one-way clutch mechanism, it mechanically responds to the weight load of the object 62 to be transported, and after the arm 3 is positioned and the joint is locked, the one-way clutch mechanism can be moved in the movable direction. In contrast, readjustment is possible. That is, when the joint lock mechanism 28 is in the locked state, the robot operation control means 44 performs the robot arm operation mode for any external force acting in the movable direction of the one-way clutch mechanism at any of the joints. The robot arm operation mode can be prevented from being applied to an external force acting in the non-moving direction of the one-way clutch mechanism.
- the impact force of the arm 3 on the object or the like can be weakened by the one-way clutch mechanism. , Can ensure safety.
- control device 38 that controls the operation while switching between the impedance control mode and the position control mode and switching the joint lock mechanism 28, operations such as positioning of the arm 3 and lifting of the transport object 62 can be performed.
- impedance control with a force sensor 35 that can be performed continuously, an intuitive and easy-to-understand operation method that allows the operator to directly operate the arm 3 with the hand 90 is realized, and the robot is further easy to use. Can do.
- the robot according to the embodiment of the present invention can be applied, for example, to a care work for picking up and transporting a care receiver 92 sleeping on a bed 91 as shown in FIG.
- the caregiver lifts the upper body of the care receiver 92 sleeping on the bed 91 a little, for example, the caregiver (operator) grasps the left arm 3a with the hand 90, and the left arm 3a is operated and the left arm 3a is inserted into the lower side of the upper half of the cared person 92.
- the caregiver slightly lifts the leg of the cared person 92
- the carer grasps the right arm 3 b with the hand 90, operates the right arm 3 b, and is placed below the leg of the cared person 92.
- the joints 9, 10, and 11 of the left arm 3a and the right arm 3b may be locked by the joint lock mechanisms 28, and then the care receiver 92 may be lifted by the waist mechanism 2.
- the arm 3 is driven by the pneumatic artificial muscle.
- the present invention is not limited to this, and it may be configured to be driven by a motor. Even when the arm 3 is driven by a motor, by providing the joint lock mechanism 28, the motor does not need to be subjected to a load by a transported object, so a small and light motor can be used, and a lightweight robot can be obtained. .
- the configuration has two arms 3a and 3b.
- the present invention is not limited to this, and a single arm 3a can be configured as shown in FIG.
- the lifting operation of the transported object can be performed, and since the number of arms is small, the number of parts is small and the robot arm can be made lighter.
- the movable type using the wheels 5 is used.
- the present invention is not limited to this. The same applies to a fixed type robot in which the support column 4 is fixed to the fixed base 1A as shown in FIG. Operation is possible.
- the operation sequence is as shown in the operation sequence table shown in FIG. 15 and the left arm 3a and the right arm 3b are operated.
- the present invention is not limited to this, and either one arm is operated. In this case, it is possible to synchronize the movements of the other arm so that the movements are the same or symmetrical.
- the operation mode switching means 47 sets the arm to be operated in the impedance control mode, the arm to be synchronized in the position control mode, and when the same operation is performed, the target value of the hand position of the arm to be synchronized is operated.
- the target value of the arm hand position to be synchronized is set as the hand position r i (r L or r of the arm to be operated). Only the horizontal component of R ) may be inverted to a negative value.
- the left arm 3a and the right arm 3b do not move synchronously at the same time, but when one of the arms is operated, the trajectory or final arrival of the arm hand position r i (r L or r R ). If the point is recorded and then the trajectory recorded by the other arm is operated by position control up to the final arrival point in the next sequence, it is also possible to operate so as to synchronize with a time difference.
- the impedance control for operating the waist mechanism 2 has been described with the impedance parameter inertia m, viscosity d, and elasticity k as constant values.
- the present invention is not limited to this, and in the operation mode switching means 47, These parameters can also be set to change.
- the viscosity d is initially set to a large value such as 20, for example, the force sensor 35 detects the force and the lifting operation by the waist mechanism 2 is started, for example, gradually, over 2 seconds, For example, the value is decreased to a small value such as 5.
- the beginning of the lifting motion is highly viscous and has an effect of preventing the waist mechanism 2 from moving suddenly.
- the viscosity gradually decreases and the operation starts with a lighter force.
- the robot, the robot control device, the control method, and the control program according to the present invention are useful for a robot that performs a nursing work such as lifting or carrying an article such as a heavy object in a home or a welfare facility. Further, the present invention can be applied not only to home robots but also to industrial robots or movable mechanisms for transporting heavy objects in production facilities.
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- General Health & Medical Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Nursing (AREA)
- Life Sciences & Earth Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Rheumatology (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
- Invalid Beds And Related Equipment (AREA)
Abstract
Description
胴体部と、
上記土台部と上記胴体部を腰関節で接続しかつ上記胴体部を上記土台部に対して相対的に移動させる胴体部移動機構と、
上記胴体部に配設され、かつ、複数のリンクを有するとともに、上記複数のリンクを互いに連結する関節と上記複数のリンクのうちの一方のリンクと上記胴体部とを連結する関節とをそれぞれ機構的に固定可能な関節ロック機構を有するロボットアームと、
上記ロボットアームの上記それぞれの関節を駆動して上記複数のリンクを回動駆動するロボットアーム用アクチュエータと、
上記胴体部移動機構を介して上記胴体部を上記土台部に対して相対的に移動させるように駆動する腰関節用アクチュエータと、
上記関節ロック機構を駆動する関節ロック機構用アクチュエータと、
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボット動作制御手段と、
を備えることを特徴とするロボットを提供する。
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボットの制御装置を提供する。
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボットの制御方法を提供する。
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボット動作制御手段としてコンピュータを機能させるためのロボットの制御プログラムを提供する。
胴体部と、
上記土台部と上記胴体部を腰関節で接続しかつ上記胴体部を上記土台部に対して相対的に移動させる胴体部移動機構と、
上記胴体部に配設され、かつ、複数のリンクを有するとともに、上記複数のリンクを互いに連結する関節と上記複数のリンクのうちの一方のリンクと上記胴体部とを連結する関節とをそれぞれ機構的に固定可能な関節ロック機構を有するロボットアームと、
上記ロボットアームの上記それぞれの関節を駆動して上記複数のリンクを回動駆動するロボットアーム用アクチュエータと、
上記胴体部移動機構を介して上記胴体部を上記土台部に対して相対的に移動させるように駆動する腰関節用アクチュエータと、
上記関節ロック機構を駆動する関節ロック機構用アクチュエータと、
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボット動作制御手段と、
を備えることを特徴とするロボットを提供する。
上記ロボットアームは、上記ロボットアームにかかる外力を検出する外力検出装置を有し、
上記ロボット動作制御手段は、上記外力検出装置により検出された上記ロボットアームにかかる外力に基づいて、上記ロボットアーム用アクチュエータの上記空気圧人工筋と上記腰関節用アクチュエータの上記空気圧人工筋とをそれぞれ駆動制御して、ロボットアーム動作モード時の上記ロボットアームの動作制御を行うとともに胴体部移動モード時の胴体部移動制御を行うことを特徴とする第1態様に記載のロボットを提供する。
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボットの制御装置を提供する。
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボットの制御方法を提供する。
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボット動作制御手段としてコンピュータを機能させるためのロボットの制御プログラムを提供する。
図1は、本発明の第1実施形態におけるロボットの概略構成を示す図である。また、図2は上記ロボットの機構構成を示す斜視図である。図3は上記ロボットの側面図である。
Jir(qi)は
シーケンス1(ホームポジション)では、左アーム3a及び右アーム3bが位置制御モード、腰機構2が角度制御モードとなり、左アーム3a、右アーム3b、及び、腰機構2がそれぞれ動作し、ロボットは図17Aに示す基本姿勢となる。
シーケンス2(左アーム操作)では、左アーム3aがインピーダンス制御モードになり、左アーム3aの第2リンク7の力検出外装カバー36に操作者が手90で力をかけると、左アーム3aが動作するようになるため、人(操作者)が手90で、左アーム3aの第2リンク7の力検出外装カバー36を把持することで左アーム3aを操作することができて、図17Bの状態を経て、運搬対象物62の下方に左アーム3aを挿入して配置し、図17Cの運搬対象物支持準備状態に至る。
シーケンス3(右アーム操作)では、右アーム3bがインピーダンス制御モードになり、右アーム3bの第2リンク7の力検出外装カバー36に操作者が手90で力をかけると、右アーム3bが動作するようになるため、人(操作者)が手90で、右アーム3bの第2リンク7の力検出外装カバー36を把持することで右アーム3bを操作することができて、運搬対象物62の下方に右アーム3bを挿入して配置する(右アーム3bを、図17Cの左アーム3aの位置と同様な位置に配置して運搬対象物支持準備状態とする)。このとき、左アーム3aは位置制御モードに切り替わり、シーケンス2で操作された位置(図17Cの位置)に保持されてその姿勢が固定されている(図17B及び図17Cの左アーム3aの動作と同様の右アーム3bの動作を行なう)。
シーケンス4(関節ロック)では、左アーム3a及び右アーム3bの全関節9,10,11の各関節ロック機構28が動作し、全関節9,10,11が固定され、左アーム3a及び右アーム3bの姿勢が固定される。このとき、右アーム3bは位置制御モードに切り替わり、シーケンス3で操作された位置(図17Cの位置)に保持され、そのままの姿勢が固定される。なお、左アーム3aは位置制御モードに切り替わったままであるため、左アーム3a及び右アーム3bの両方が位置制御モードに切り替わった状態となり、左アーム3a及び右アーム3bの姿勢がそれぞれ固定される。
シーケンス5(昇降)では、腰機構2がインピーダンス制御に切り替わり、左アーム3a又は右アーム3bのいずれか一方のアーム3の第2リンク7の力検出外装カバー36に人(操作者)の手90で力をかけると、腰機構2が動作するようになるため、人(操作者)が第2リンク7の力検出外装カバー36を手90で把持し、第2リンク7を押し上げるようにすることで、腰機構2の動作により左アーム3a及び右アーム3bが両方同時に上昇するような動作となり、運搬対象物62の上昇が実現し、図17Cの運搬対象物支持準備状態から図17Dの運搬対象物持ち上げ状態になる。このとき、人(操作者)が第2リンク7の力検出外装カバー36を把持し、引き下げるようにすることで腰機構2の動作により左アーム3a及び右アーム3bが下降するような動作となり、運搬対象物62の下降が実現し、運搬対象物62が支持脚63で支持された図17Cの状態に戻る。
シーケンス6(関節ロック解除)では、運搬対象物62が支持脚63で支持された図17Cの状態において、左アーム3a及び右アーム3bの全関節9,10,11の各関節ロック機構28が動作し、全関節9,10,11の固定が解除される。左アーム3a及び右アーム3bのそれぞれの制御は位置制御モードのままであり、左アーム3a及び右アーム3bの各位置は保持される。
シーケンス7(左アーム操作)では、運搬対象物62が支持脚63で支持された図17Cの状態において、左アーム3aがインピーダンス制御モードになり、左アーム3aの第2リンク7の力検出外装カバー36に手90で力をかけると、左アーム3aが動作するようになるため、人(操作者)が手90で第2リンク7の力検出外装カバー36を把持することで左アーム3aを操作することができて、支持脚63で支持された運搬対象物62の下方の空間63pから左アーム3aを離脱させ、図17Bの状態を経て、図17Aの初期状態に戻る。
シーケンス8(右アーム操作)では、運搬対象物62が支持脚63で支持された図17Cの状態において、右アーム3bがインピーダンス制御モードになり、右アーム3bの第2リンク7の力検出外装カバー36に手90で力をかけると、右アーム3bが動作するようになるため、人(操作者)が手90で第2リンク7の力検出外装カバー36を把持することで右アーム3bを操作することができて、支持脚63で支持された運搬対象物62の下方の空間63pから右アーム3bを離脱させる。以後、シーケンス1に戻り、ステップ(シーケンス)を繰り返せば連続的に動作可能となる。
Claims (12)
- 土台部と、
胴体部と、
上記土台部と上記胴体部を腰関節で接続しかつ上記胴体部を上記土台部に対して相対的に移動させる胴体部移動機構と、
上記胴体部に配設され、かつ、複数のリンクを有するとともに、上記複数のリンクを互いに連結する関節と上記複数のリンクのうちの一方のリンクと上記胴体部とを連結する関節とをそれぞれ機構的に固定可能な関節ロック機構を有するロボットアームと、
上記ロボットアームの上記それぞれの関節を駆動して上記複数のリンクを回動駆動するロボットアーム用アクチュエータと、
上記胴体部移動機構を介して上記胴体部を上記土台部に対して相対的に移動させるように駆動する腰関節用アクチュエータと、
上記関節ロック機構を駆動する関節ロック機構用アクチュエータと、
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボット動作制御手段と、
を備えるロボット。 - 上記ロボットアーム用アクチュエータは空気圧人工筋であり、上記腰関節用アクチュエータは空気圧人工筋であり、
上記ロボットアームは、上記ロボットアームにかかる外力を検出する外力検出装置を有し、
上記ロボット動作制御手段は、上記外力検出装置により検出された上記ロボットアームにかかる外力に基づいて、上記ロボットアーム用アクチュエータの上記空気圧人工筋と上記腰関節用アクチュエータの上記空気圧人工筋とをそれぞれ駆動制御して、ロボットアーム動作モード時の上記ロボットアームの動作制御を行うとともに胴体部移動モード時の胴体部移動制御を行う請求項1に記載のロボット。 - 上記ロボット動作制御手段は、インピーダンス制御により上記外力に基づいたアーム動作制御及び胴体部移動制御を行う請求項2に記載のロボット。
- 上記ロボットアームは、上記複数のリンクのうちの最先端リンクにおいて上記最先端リンクの幅方向断面の外面の略半分かつ長手方向の略全長を覆うように配設された外装部材を有し、上記外力検出装置は上記外装部材にかかる外力を検出する請求項2に記載のロボット。
- 上記胴体部移動機構は、上記土台部に対して上記胴体部を上記腰関節回りに略前後に揺動させる腰機構である請求項1~4のいずれか1つに記載のロボット。
- 上記腰機構は、上記土台部に一端が固定され、他端が上記胴体部に固定されることで上記腰関節を駆動する並進駆動アクチュエータにより駆動されて、上記土台部に対して上記胴体部を上記腰関節回りに略前後に揺動させる機構である請求項5に記載のロボット。
- 上記関節ロック機構はワンウェイクラッチ機構である請求項1に記載のロボット。
- 上記ロボット動作制御手段は、上記関節ロック機構がロック状態のときには、上記いずれかの関節において、上記ワンウェイクラッチ機構の可動方向に作用する外力に対しては上記ロボットアーム動作モードを行い、上記ワンウェイクラッチ機構の非可動方向に作用する外力に対しては上記ロボットアーム動作モードを行わない請求項7に記載のロボット。
- 上記ロボット動作制御手段は、上記関節ロック機構がロック状態のときには上記ロボットアームに対して、非ロック状態のときのサーボ剛性よりも低いサーボ剛性の位置制御を行う請求項7に記載のロボット。
- 土台部と、胴体部と、上記土台部と上記胴体部を腰関節で接続しかつ上記胴体部を上記土台部に対して相対的に移動させる胴体部移動機構と、上記胴体部に配設され、かつ、複数のリンクを有するとともに、上記複数のリンクを互いに連結する関節と上記複数のリンクのうちの一方のリンクと上記胴体部とを連結する関節とをそれぞれ機構的に固定可能な関節ロック機構を有するロボットアームと、上記ロボットアームの上記それぞれの関節を駆動して上記複数のリンクを回動駆動するロボットアーム用アクチュエータと、上記胴体部移動機構を介して上記胴体部を上記土台部に対して相対的に移動させるように駆動する腰関節用アクチュエータと、上記関節ロック機構を駆動する関節ロック機構用アクチュエータとを備えるロボットの動作を制御するロボットの制御装置であって、
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボットの制御装置。 - 土台部と、胴体部と、上記土台部と上記胴体部を腰関節で接続しかつ上記胴体部を上記土台部に対して相対的に移動させる胴体部移動機構と、上記胴体部に配設され、かつ、複数のリンクを有するとともに、上記複数のリンクを互いに連結する関節と上記複数のリンクのうちの一方のリンクと上記胴体部とを連結する関節とをそれぞれ機構的に固定可能な関節ロック機構を有するロボットアームと、上記ロボットアームの上記それぞれの関節を駆動して上記複数のリンクを回動駆動するロボットアーム用アクチュエータと、上記胴体部移動機構を介して上記胴体部を上記土台部に対して相対的に移動させるように駆動する腰関節用アクチュエータと、上記関節ロック機構を駆動する関節ロック機構用アクチュエータとを備えるロボットの動作を制御するロボットの制御方法であって、
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボットの制御方法。 - 土台部と、胴体部と、上記土台部と上記胴体部を腰関節で接続しかつ上記胴体部を上記土台部に対して相対的に移動させる胴体部移動機構と、上記胴体部に配設され、かつ、複数のリンクを有するとともに、上記複数のリンクを互いに連結する関節と上記複数のリンクのうちの一方のリンクと上記胴体部とを連結する関節とをそれぞれ機構的に固定可能な関節ロック機構を有するロボットアームと、上記ロボットアームの上記それぞれの関節を駆動して上記複数のリンクを回動駆動するロボットアーム用アクチュエータと、上記胴体部移動機構を介して上記胴体部を上記土台部に対して相対的に移動させるように駆動する腰関節用アクチュエータと、上記関節ロック機構を駆動する関節ロック機構用アクチュエータとを備えるロボットの動作を制御するロボットの制御プログラムであって、
上記関節ロック機構用アクチュエータと上記ロボットアーム用アクチュエータと上記腰関節用アクチュエータとをそれぞれ駆動制御して、上記ロボットアームの上記いずれかの関節をフリー状態として上記ロボットアームの動作を行うロボットアーム動作モードと、上記ロボットアームの上記いずれかの関節をロック状態として上記胴体部移動機構を使用して上記胴体部を移動させる胴体部移動モードとを切換えるロボット動作制御手段としてコンピュータを機能させるためのロボットの制御プログラム。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010515768A JP4634541B2 (ja) | 2008-06-06 | 2009-06-02 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
CN2009801172394A CN102026783B (zh) | 2008-06-06 | 2009-06-02 | 机器人、机器人的控制装置、控制方法及控制程序 |
US12/935,603 US8401702B2 (en) | 2008-06-06 | 2009-06-02 | Robot, and control apparatus, control method, and control program for robot |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008-148946 | 2008-06-06 | ||
JP2008148946 | 2008-06-06 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2009147832A1 true WO2009147832A1 (ja) | 2009-12-10 |
Family
ID=41397915
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2009/002456 WO2009147832A1 (ja) | 2008-06-06 | 2009-06-02 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
Country Status (4)
Country | Link |
---|---|
US (1) | US8401702B2 (ja) |
JP (1) | JP4634541B2 (ja) |
CN (1) | CN102026783B (ja) |
WO (1) | WO2009147832A1 (ja) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014046292A1 (ja) * | 2012-09-19 | 2014-03-27 | マッスル株式会社 | 介護方法およびそれに用いる介護ロボット |
JP2014061035A (ja) * | 2012-09-19 | 2014-04-10 | Muscle Corp | 介護方法およびそれに用いる介護ロボット |
JP2014104549A (ja) * | 2012-11-28 | 2014-06-09 | Advanced Telecommunication Research Institute International | 外骨格型ロボットおよびリハビリテーション装置 |
JP2014155998A (ja) * | 2013-02-18 | 2014-08-28 | Advanced Telecommunication Research Institute International | パワーアシストロボット |
WO2015056460A1 (ja) * | 2013-10-18 | 2015-04-23 | マッスル株式会社 | ロボット |
WO2015181873A1 (ja) * | 2014-05-26 | 2015-12-03 | 株式会社安川電機 | 移乗補助装置 |
WO2015181874A1 (ja) * | 2014-05-26 | 2015-12-03 | 株式会社安川電機 | 移乗補助装置 |
WO2016042703A1 (ja) * | 2014-09-19 | 2016-03-24 | パナソニックIpマネジメント株式会社 | 起立動作支援システム、起立動作支援システムの制御部の制御方法、起立動作支援システムの制御部用プログラム、ロボット |
CN106142096A (zh) * | 2016-06-04 | 2016-11-23 | 浙江侍维波机器人科技有限公司 | 含可变形态机械臂的搬运和抱抬肥胖症病人的医疗机器人 |
CN107662196A (zh) * | 2016-07-28 | 2018-02-06 | 深圳市赛尔西生物科技有限公司 | 机器人 |
KR20180019684A (ko) | 2015-06-29 | 2018-02-26 | 카와사키 주코교 카부시키 카이샤 | 로봇 시스템 |
KR20200095192A (ko) * | 2019-01-31 | 2020-08-10 | 한국과학기술원 | 회전 고정 장치 및 이를 포함하는 2 자유도 회전 암 |
CN114274118A (zh) * | 2021-12-08 | 2022-04-05 | 珠海格力智能装备有限公司 | 多轴机械手控制系统及机械手主副臂防碰撞的控制方法 |
CN114914873A (zh) * | 2022-04-19 | 2022-08-16 | 上海工程技术大学 | 轨道行走机器人嵌套运动线缆的穿越排布和拖车承载 |
Families Citing this family (48)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140064905A1 (en) * | 2011-01-10 | 2014-03-06 | Sri International | Electroadhesive System for Capturing Objects |
CN103796806B (zh) * | 2011-09-13 | 2016-06-29 | 株式会社安川电机 | 自行机器人和自行台车 |
JP5516610B2 (ja) * | 2012-01-19 | 2014-06-11 | 株式会社安川電機 | ロボット、ロボットハンドおよびロボットハンドの保持位置調整方法 |
DE102012103515A1 (de) * | 2012-04-20 | 2013-10-24 | Demag Cranes & Components Gmbh | Steuerverfahren für ein Balancier-Hebezeug und Balancier-Hebezeug hiermit |
WO2014002678A1 (ja) * | 2012-06-29 | 2014-01-03 | 三菱電機株式会社 | ロボット制御装置およびロボット制御方法 |
CN103085071A (zh) * | 2013-02-04 | 2013-05-08 | 惠州市东扬科技有限公司 | 一种可视化机器人程序编译方法 |
CN103223665B (zh) * | 2013-04-28 | 2015-04-29 | 哈尔滨工业大学 | 一种实体档案全自动运输机器人 |
JP6255724B2 (ja) * | 2013-06-10 | 2018-01-10 | セイコーエプソン株式会社 | ロボットおよびロボットの操作方法 |
US9505133B2 (en) * | 2013-12-13 | 2016-11-29 | Canon Kabushiki Kaisha | Robot apparatus, robot controlling method, program and recording medium |
EP3682837B1 (en) | 2014-03-17 | 2023-09-27 | Intuitive Surgical Operations, Inc. | System and method for breakaway clutching in an articulated arm |
JP5906506B1 (ja) * | 2014-09-12 | 2016-04-20 | 株式会社国際電気通信基礎技術研究所 | アクチュエータ装置、パワーアシストロボットおよびヒューマノイドロボット |
EP3197644B1 (en) | 2014-09-26 | 2023-06-07 | Norgren Automation Solutions, LLC | Automatically positionable joints and transfer tooling assemblies including automatically positionable joints |
US9676097B1 (en) * | 2014-11-11 | 2017-06-13 | X Development Llc | Systems and methods for robotic device authentication |
WO2016086238A2 (en) * | 2014-11-19 | 2016-06-02 | Grand Valley State University | Sitting standing transfer system |
KR20160133191A (ko) * | 2015-05-12 | 2016-11-22 | 현대중공업 주식회사 | 이송용 보조로봇 |
US10602611B2 (en) * | 2015-08-19 | 2020-03-24 | Seiko Epson Corporation | Robot control apparatus, robot, and robot system |
GB2549072B (en) | 2016-03-24 | 2020-07-29 | Cmr Surgical Ltd | Robot control |
CN106272350B (zh) * | 2016-09-05 | 2018-06-15 | 清华大学 | 一种驱动关节可变的rrr并联机构支链装置 |
DE102017102621B3 (de) * | 2017-02-09 | 2018-05-09 | Franka Emika Gmbh | Roboter |
US10509415B2 (en) * | 2017-07-27 | 2019-12-17 | Aurora Flight Sciences Corporation | Aircrew automation system and method with integrated imaging and force sensing modalities |
CN107831679B (zh) * | 2017-11-09 | 2021-01-01 | 深圳市终极进化科技有限公司 | 一种四足仿生机器人的人性化控制系统及其控制方法 |
DE102017011130B4 (de) * | 2017-12-01 | 2021-03-04 | Kuka Deutschland Gmbh | Verfahren und System zum Steuern eines Roboters |
CN108383030B (zh) * | 2018-04-28 | 2023-08-22 | 北京极智嘉科技股份有限公司 | 一种顶举机器人及机器人系统 |
US11065553B2 (en) * | 2018-05-18 | 2021-07-20 | Universal City Studios Llc | Systems and methods for securing a movable arm of a ride vehicle |
JP7172277B2 (ja) * | 2018-08-21 | 2022-11-16 | セイコーエプソン株式会社 | 制御装置及びロボットシステム |
US10328539B1 (en) * | 2018-11-20 | 2019-06-25 | King Saud University | Assistive device for heavy tool operation |
US11198227B2 (en) * | 2018-12-04 | 2021-12-14 | Raytheon Company | Adjustable ballast system and method for same |
US11027435B2 (en) | 2018-12-04 | 2021-06-08 | Raytheon Company | Automated work piece testing system and method for same |
CN109512612B (zh) * | 2019-01-07 | 2023-10-27 | 中国科学院沈阳自动化研究所 | 一种适用于狭窄空间的伤员抢运机器人腰部起重关节 |
CN109849054B (zh) * | 2019-02-18 | 2021-02-26 | 浙江华睿科技有限公司 | 机械臂防抖装置及防抖方法 |
JP6733851B1 (ja) | 2019-03-25 | 2020-08-05 | 株式会社明電舎 | 車両自動運転装置のトランスミッションアクチュエータ支持構造 |
JP6750760B1 (ja) | 2019-03-25 | 2020-09-02 | 株式会社明電舎 | 車両自動運転装置のトランスミッションアクチュエータ取付構造 |
US11474002B2 (en) | 2019-03-25 | 2022-10-18 | Meidensha Corporation | Vehicle automated driving device for mounting a pedal actuator |
JP6787531B1 (ja) * | 2019-03-25 | 2020-11-18 | 株式会社明電舎 | 車両自動運転装置のトランスミッションアクチュエータ取付構造 |
WO2020196259A1 (ja) | 2019-03-25 | 2020-10-01 | 株式会社明電舎 | 車両自動運転装置の支持構造 |
WO2020196264A1 (ja) | 2019-03-25 | 2020-10-01 | 株式会社明電舎 | 車両自動運転装置のペダルアクチュエータ |
CN110040053A (zh) * | 2019-04-28 | 2019-07-23 | 黄娉 | 一种用于物流运输的具有装卸和折叠功能的机器人 |
EP3594498B1 (de) | 2019-11-06 | 2022-01-05 | Pfeiffer Vacuum Gmbh | System mit einer gasrezirkulationseinrichtung |
CN110711096B (zh) * | 2019-11-26 | 2021-06-08 | 燕山大学 | 一种可折叠式转运护理机器人 |
CN110861075A (zh) * | 2019-12-02 | 2020-03-06 | 电子科技大学 | 一种小型气动多关节串并联蛇形机械臂 |
KR102273856B1 (ko) * | 2020-05-13 | 2021-07-06 | 옥재윤 | 기능성 복합 데스크 시스템 |
CN111604902B (zh) * | 2020-05-18 | 2022-06-03 | 哈尔滨工业大学 | 一种适用于机械手在手操作的目标滑动检测方法 |
CN113431811B (zh) * | 2021-06-08 | 2022-04-05 | 江南大学 | 基于壅塞原理的软体机器人气动系统 |
CN113599135B (zh) * | 2021-08-01 | 2023-03-24 | 青岛市城阳区人民医院 | 一种外科手术后病人卧床排便辅助器 |
CN113729951B (zh) * | 2021-10-12 | 2023-08-29 | 中南大学 | 手术机器人的双平行四边形初调机构 |
CN114098297B (zh) * | 2021-10-25 | 2022-12-06 | 重庆理工大学 | 一种互锁式消防机器人控制台 |
CN116460849A (zh) * | 2021-11-05 | 2023-07-21 | 佛山非夕机器人科技有限公司 | 多自由度机器人的运动学标定方法及标定系统 |
CN114147018B (zh) * | 2021-11-09 | 2023-01-20 | 合肥工业大学 | 一种变形能力大的储油罐机械清洗装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61252084A (ja) * | 1985-05-01 | 1986-11-10 | 株式会社 アマダ | マスタ・スレ−ブ方式ロボツト |
JPS63200986A (ja) * | 1987-02-13 | 1988-08-19 | 株式会社日立製作所 | ロボツト装置 |
JPH06297366A (ja) * | 1993-04-16 | 1994-10-25 | Hitachi Ltd | 産業用ロボット |
JPH06320451A (ja) * | 1993-04-26 | 1994-11-22 | Sanyo Electric Co Ltd | マニピュレータ制御方法 |
JP2003011079A (ja) * | 2001-06-27 | 2003-01-15 | Tokai Univ | ロボットの関節制動装置 |
JP2003136440A (ja) * | 2001-10-26 | 2003-05-14 | Tokai Univ | 移動ロボットの制動制御装置 |
JP2004358575A (ja) * | 2003-06-02 | 2004-12-24 | Doshisha | ロボットシステム、ロボットのインピーダンス制御方法 |
Family Cites Families (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0938150A (ja) | 1995-07-26 | 1997-02-10 | Mikuni Corp | 介護用移動リフト |
US5915673A (en) * | 1996-03-27 | 1999-06-29 | Kazerooni; Homayoon | Pneumatic human power amplifer module |
US5996150A (en) * | 1996-04-24 | 1999-12-07 | Blevins; Jerry L. | Cantilevered mobile bed/chair apparatus for safety patient transfer |
EP0849053B1 (en) * | 1996-12-16 | 2002-10-02 | Kabushiki Kaisha Sankyo Seiki Seisakusho | Method of controlling force assisting device and control apparatus using the same |
JP3999888B2 (ja) * | 1998-02-24 | 2007-10-31 | 松下電工株式会社 | 抱き上げ補助装置及びその制御方法 |
JP3504507B2 (ja) * | 1998-09-17 | 2004-03-08 | トヨタ自動車株式会社 | 適切反力付与型作業補助装置 |
US6659939B2 (en) * | 1998-11-20 | 2003-12-09 | Intuitive Surgical, Inc. | Cooperative minimally invasive telesurgical system |
US6386513B1 (en) * | 1999-05-13 | 2002-05-14 | Hamayoon Kazerooni | Human power amplifier for lifting load including apparatus for preventing slack in lifting cable |
WO2004103651A1 (ja) * | 1999-06-01 | 2004-12-02 | Hirohiko Arai | 物体協調運搬ロボットの制御方法及びその装置 |
US6204619B1 (en) * | 1999-10-04 | 2001-03-20 | Daimlerchrysler Corporation | Dynamic control algorithm and program for power-assisted lift device |
JP3188953B2 (ja) * | 1999-10-13 | 2001-07-16 | 経済産業省産業技術総合研究所長 | パワーアシスト装置およびその制御方法 |
JP2001269370A (ja) | 2000-03-23 | 2001-10-02 | Oshiyama Tsutomu | 移乗機器 |
US6385508B1 (en) * | 2000-10-31 | 2002-05-07 | Fanuc Robotics North America, Inc. | Lead-through teach handle assembly and method of teaching a robot assembly |
JP4257570B2 (ja) * | 2002-07-17 | 2009-04-22 | 株式会社安川電機 | 搬送用ロボットのティーチング装置および搬送用ロボットのティーチング方法 |
EP1607191A1 (en) * | 2003-03-23 | 2005-12-21 | Sony Corporation | Robot device and method of controlling the same |
EP1633534B1 (en) * | 2003-04-28 | 2018-09-12 | Nikon Metrology NV | Cmm arm with exoskeleton |
JP2007252469A (ja) | 2006-03-22 | 2007-10-04 | Matsushita Electric Ind Co Ltd | 支持装置およびそれを用いた介護ロボット装置 |
JP2008100053A (ja) | 2006-09-20 | 2008-05-01 | Matsushita Electric Ind Co Ltd | 支持装置およびそれを用いた介護ロボット装置 |
JP2008086542A (ja) | 2006-10-02 | 2008-04-17 | Matsushita Electric Ind Co Ltd | 介護用ロボット装置 |
JP4508263B2 (ja) * | 2008-04-24 | 2010-07-21 | トヨタ自動車株式会社 | パワーアシスト装置およびその制御方法 |
-
2009
- 2009-06-02 US US12/935,603 patent/US8401702B2/en active Active
- 2009-06-02 CN CN2009801172394A patent/CN102026783B/zh active Active
- 2009-06-02 JP JP2010515768A patent/JP4634541B2/ja active Active
- 2009-06-02 WO PCT/JP2009/002456 patent/WO2009147832A1/ja active Application Filing
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61252084A (ja) * | 1985-05-01 | 1986-11-10 | 株式会社 アマダ | マスタ・スレ−ブ方式ロボツト |
JPS63200986A (ja) * | 1987-02-13 | 1988-08-19 | 株式会社日立製作所 | ロボツト装置 |
JPH06297366A (ja) * | 1993-04-16 | 1994-10-25 | Hitachi Ltd | 産業用ロボット |
JPH06320451A (ja) * | 1993-04-26 | 1994-11-22 | Sanyo Electric Co Ltd | マニピュレータ制御方法 |
JP2003011079A (ja) * | 2001-06-27 | 2003-01-15 | Tokai Univ | ロボットの関節制動装置 |
JP2003136440A (ja) * | 2001-10-26 | 2003-05-14 | Tokai Univ | 移動ロボットの制動制御装置 |
JP2004358575A (ja) * | 2003-06-02 | 2004-12-24 | Doshisha | ロボットシステム、ロボットのインピーダンス制御方法 |
Non-Patent Citations (2)
Title |
---|
PANASONIC CORP.: "Dai 34 Kai Kokusai Fukushi Kikiten/Transfer Assist Robot to Rehabilitation Shien", PANASONIC GROUP NO BROADBAND HOSO CHANNEL PANASONIC, 11 October 2007 (2007-10-11) * |
TADASHI ODASHIMA: ""Development and Evaluation of a Human-interactive Robot Platform 'RI-MAN "'", JOURNAL OF THE ROBOTICS SOCIETY OF JAPAN, vol. 25, no. 4, 15 May 2007 (2007-05-15), pages 70 - 81 * |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2014061035A (ja) * | 2012-09-19 | 2014-04-10 | Muscle Corp | 介護方法およびそれに用いる介護ロボット |
WO2014046292A1 (ja) * | 2012-09-19 | 2014-03-27 | マッスル株式会社 | 介護方法およびそれに用いる介護ロボット |
US10272006B2 (en) | 2012-09-19 | 2019-04-30 | Muscle Corporation | Care method and care robot used therein |
AU2013318942B2 (en) * | 2012-09-19 | 2018-12-06 | Muscle Corporation | Care method and care robot used therein |
JP2014104549A (ja) * | 2012-11-28 | 2014-06-09 | Advanced Telecommunication Research Institute International | 外骨格型ロボットおよびリハビリテーション装置 |
JP2014155998A (ja) * | 2013-02-18 | 2014-08-28 | Advanced Telecommunication Research Institute International | パワーアシストロボット |
US10045898B2 (en) | 2013-10-18 | 2018-08-14 | Muscle Corporation | Robot |
WO2015056460A1 (ja) * | 2013-10-18 | 2015-04-23 | マッスル株式会社 | ロボット |
KR102197894B1 (ko) | 2013-10-18 | 2021-01-04 | 맛스루 가부시키가이샤 | 로봇 |
KR20160072098A (ko) * | 2013-10-18 | 2016-06-22 | 맛스루 가부시키가이샤 | 로봇 |
WO2015181874A1 (ja) * | 2014-05-26 | 2015-12-03 | 株式会社安川電機 | 移乗補助装置 |
WO2015181873A1 (ja) * | 2014-05-26 | 2015-12-03 | 株式会社安川電機 | 移乗補助装置 |
JPWO2016042703A1 (ja) * | 2014-09-19 | 2017-09-07 | パナソニックIpマネジメント株式会社 | 起立動作支援システム、起立動作支援システムの制御部の制御方法、起立動作支援システムの制御部用プログラム、ロボット |
WO2016042703A1 (ja) * | 2014-09-19 | 2016-03-24 | パナソニックIpマネジメント株式会社 | 起立動作支援システム、起立動作支援システムの制御部の制御方法、起立動作支援システムの制御部用プログラム、ロボット |
US10940067B2 (en) | 2015-06-29 | 2021-03-09 | Kawasaki Jukogyo Kabushiki Kaisha | Robot system |
KR20180019684A (ko) | 2015-06-29 | 2018-02-26 | 카와사키 주코교 카부시키 카이샤 | 로봇 시스템 |
CN106142096A (zh) * | 2016-06-04 | 2016-11-23 | 浙江侍维波机器人科技有限公司 | 含可变形态机械臂的搬运和抱抬肥胖症病人的医疗机器人 |
CN107662196B (zh) * | 2016-07-28 | 2024-06-04 | 一诺云科技(武汉)有限公司 | 机器人 |
CN107662196A (zh) * | 2016-07-28 | 2018-02-06 | 深圳市赛尔西生物科技有限公司 | 机器人 |
KR102188407B1 (ko) | 2019-01-31 | 2020-12-08 | 한국과학기술원 | 회전 고정 장치 및 이를 포함하는 2 자유도 회전 암 |
KR20200095192A (ko) * | 2019-01-31 | 2020-08-10 | 한국과학기술원 | 회전 고정 장치 및 이를 포함하는 2 자유도 회전 암 |
CN114274118A (zh) * | 2021-12-08 | 2022-04-05 | 珠海格力智能装备有限公司 | 多轴机械手控制系统及机械手主副臂防碰撞的控制方法 |
CN114274118B (zh) * | 2021-12-08 | 2023-12-08 | 珠海格力智能装备有限公司 | 多轴机械手控制系统及机械手主副臂防碰撞的控制方法 |
CN114914873A (zh) * | 2022-04-19 | 2022-08-16 | 上海工程技术大学 | 轨道行走机器人嵌套运动线缆的穿越排布和拖车承载 |
Also Published As
Publication number | Publication date |
---|---|
JP4634541B2 (ja) | 2011-02-16 |
CN102026783A (zh) | 2011-04-20 |
US8401702B2 (en) | 2013-03-19 |
CN102026783B (zh) | 2013-03-27 |
JPWO2009147832A1 (ja) | 2011-10-20 |
US20110029133A1 (en) | 2011-02-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4634541B2 (ja) | ロボット、ロボットの制御装置、制御方法、及び制御プログラム | |
JP5146621B2 (ja) | 多関節型アームロボット、制御方法及び制御プログラム | |
Carignan et al. | Development of an exoskeleton haptic interface for virtual task training | |
JP5074640B2 (ja) | 弾性体アクチュエータ駆動機構の制御装置及び制御方法、並びに、制御プログラム | |
Aschemann et al. | Sliding-mode control of a high-speed linear axis driven by pneumatic muscle actuators | |
JP4768086B2 (ja) | ロボット、ロボットアームの制御装置、及びロボットアームの制御プログラム | |
US20110238217A1 (en) | Transfer supporting apparatus | |
US20110078508A1 (en) | Control apparatus and control method of elastic body actuator as well as control program thereof | |
KR100585421B1 (ko) | 2각 보행식 인간형 로봇 | |
US20130013108A1 (en) | Robotic Agile Lift System With Extremity Control | |
US8253367B2 (en) | Control apparatus, control method, and control program for elastic actuator drive mechanism | |
WO2001038048A1 (fr) | Unite de commande de robot | |
Sutapun et al. | A 4-DOF upper limb exoskeleton for stroke rehabilitation: kinematics mechanics and control | |
JP2013094935A (ja) | ロボットアーム装置 | |
WO2012149402A2 (en) | Robotic agile lift system with extremity control | |
Shut et al. | Development of a humanoid dual arm system for a single spherical wheeled balancing mobile robot | |
JP2014155985A (ja) | ロボット、ロボットの制御装置、制御方法、及び制御プログラム | |
JP2003291080A (ja) | 2足歩行ロボットの下半身モジュール | |
Evrard et al. | Intercontinental, multimodal, wide-range tele-cooperation using a humanoid robot | |
JP3936991B2 (ja) | 人間型ロボットの遠隔制御装置 | |
JP4450908B2 (ja) | バイラテラル位置・力伝達装置 | |
Ramos et al. | Improving humanoid posture teleoperation by dynamic synchronization through operator motion anticipation | |
JP2021030368A (ja) | ロボットシステム、コントローラ及び制御方法 | |
Oh et al. | Hybrid Hard-Soft Robotic Joint and Robotic Arm Based on Pneumatic Origami Chambers | |
Kawashima et al. | Application of robots using pneumatic artificial rubber muscles for operating construction machines |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 200980117239.4 Country of ref document: CN |
|
DPE2 | Request for preliminary examination filed before expiration of 19th month from priority date (pct application filed from 20040101) | ||
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 09758099 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2010515768 Country of ref document: JP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 12935603 Country of ref document: US |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 09758099 Country of ref document: EP Kind code of ref document: A1 |