WO2017217294A1 - 作業装置および双腕型作業装置 - Google Patents

作業装置および双腕型作業装置 Download PDF

Info

Publication number
WO2017217294A1
WO2017217294A1 PCT/JP2017/021112 JP2017021112W WO2017217294A1 WO 2017217294 A1 WO2017217294 A1 WO 2017217294A1 JP 2017021112 W JP2017021112 W JP 2017021112W WO 2017217294 A1 WO2017217294 A1 WO 2017217294A1
Authority
WO
WIPO (PCT)
Prior art keywords
work
end side
link
linear motion
work area
Prior art date
Application number
PCT/JP2017/021112
Other languages
English (en)
French (fr)
Inventor
浩 磯部
清悟 坂田
祐紀 志村
Original Assignee
Ntn株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Ntn株式会社 filed Critical Ntn株式会社
Priority to CN201780036825.0A priority Critical patent/CN109311174A/zh
Priority to EP17813192.6A priority patent/EP3473389B1/en
Publication of WO2017217294A1 publication Critical patent/WO2017217294A1/ja
Priority to US16/217,474 priority patent/US11247329B2/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0084Programme-controlled manipulators comprising a plurality of manipulators
    • B25J9/0087Dual arms
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06Safety devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • B25J17/02Wrist joints
    • B25J17/0283Three-dimensional joints
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0075Means for protecting the manipulator from its environment or vice versa
    • B25J19/0083Means for protecting the manipulator from its environment or vice versa using gaiters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0091Shock absorbers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J21/00Chambers provided with manipulation devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0045Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base
    • B25J9/0048Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base with kinematics chains of the type rotary-rotary-rotary
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/023Cartesian coordinate type
    • B25J9/026Gantry-type
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/106Programme-controlled manipulators characterised by positioning means for manipulator elements with articulated links
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/12Programme-controlled manipulators characterised by positioning means for manipulator elements electric
    • B25J9/123Linear actuators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676Avoiding collision or forbidden zones
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16HGEARING
    • F16H21/00Gearings comprising primarily only links or levers, with or without slides
    • F16H21/46Gearings comprising primarily only links or levers, with or without slides with movements in three dimensions
    • F16H21/50Gearings comprising primarily only links or levers, with or without slides with movements in three dimensions for interconverting rotary motion and reciprocating motion
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16PSAFETY DEVICES IN GENERAL; SAFETY DEVICES FOR PRESSES
    • F16P3/00Safety devices acting in conjunction with the control or operation of a machine; Control arrangements requiring the simultaneous use of two or more parts of the body
    • F16P3/12Safety devices acting in conjunction with the control or operation of a machine; Control arrangements requiring the simultaneous use of two or more parts of the body with means, e.g. feelers, which in case of the presence of a body part of a person in or near the danger zone influence the control or operation of the machine

Definitions

  • the present invention relates to a working device and a double-armed type used in a device that requires high-speed and high-precision work such as medical equipment and industrial equipment, equipment that requires fine work such as assembly, a robot that coexists with humans, and the like. It relates to a working device.
  • Patent Documents 1 and 2 propose an articulated robot type working device having 6 degrees of freedom.
  • Patent Document 1 has a single-arm configuration
  • Patent Document 2 has a dual-arm configuration.
  • These working devices have a total of 6 degrees of freedom by combining six mechanisms with one degree of freedom of rotation.
  • JP 2005-329521 A Japanese Patent No. 4528312
  • the working device of Patent Document 2 Since the working device of Patent Document 2 is also configured by a combination of mechanisms with one degree of freedom of rotation, there is a problem similar to that of the working device of Patent Document 1.
  • the working device of Patent Document 2 that is a double-arm type has the following problems 7 to 8.
  • the object of the present invention is to reduce the amount of movement of the work device main body when performing fine work, and to prevent the object from coming into contact with the work device main body, and automatically perform work close to manual work performed by a person. It is to provide a working device that can be performed. Another object of the present invention is that the amount of movement of the working device main body when performing a fine work can be reduced, and that an object can be prevented from coming into contact with the working device main body. It is to provide a double-arm type working device capable of working.
  • the working device is a working device having six degrees of freedom that performs work using an end effector, and includes a working device main body and contact preventing means for preventing an object from unnecessarily contacting the working device main body.
  • the work apparatus main body includes a three-degree-of-freedom linear motion unit combining three linear motion actuators and a three-degree-of-freedom rotation unit combining a plurality of rotation mechanisms having one or more degrees of freedom of rotation.
  • the linear motion unit is installed with a base fixed to a gantry, the base of the rotary unit is fixed to an output of the linear motion unit, and the end effector is mounted on the output of the rotary unit. Yes.
  • the said contact prevention means isolate
  • the contact prevention means includes an intrusion part that allows an object to enter the work area from the non-work area, and an intrusion detection sensor that detects that an object has entered the work area from the intrusion part. Yes.
  • the position of the end effector is determined mainly by the three-degree-of-freedom linear motion unit, and the position of the end effector is determined by the three-degree-of-freedom rotation unit.
  • Each linear motion actuator of the linear motion unit and each rotation mechanism of the rotary unit respectively correspond to the position of the end effector expressed in the orthogonal coordinate system and the attitude of the end effector expressed in the polar coordinate system. Therefore, it is easy to imagine the operation of each linear actuator and each rotation mechanism with respect to the position and posture of the end effector, and it is easy to set an operation pattern such as posture teaching work. Further, the operation position of each linear actuator and the operation angle of each rotation mechanism are uniquely determined with respect to the position and posture of the end effector. That is, it has no singularity. Therefore, the working device can be operated without skilled knowledge and experience.
  • the contact preventing means operates as follows (effects 5 to 6).
  • (Effect 5) An intrusionable portion is provided in the contact prevention means, and objects cannot enter the work area from other than the intrusionable portion. Therefore, the range in which an object and the work apparatus main body can contact is limited.
  • (Effect 6) Since the intrusion detection sensor is provided, it is possible to reliably detect that an object has entered the work area. When the intrusion detection sensor detects an intrusion, the operation of the work apparatus body can be stopped or decelerated. Thereby, when there is no detection of intrusion by the intrusion detection sensor and an object is not approaching the work apparatus main body, the work apparatus main body can be operated at high speed, and productivity is improved.
  • the contact prevention means includes a plurality of face materials, and the plurality of face materials surround the work device main body, and each of the plurality of face materials includes the three linear motions. It is good to be parallel to two movable directions among the three movable directions of the actuator.
  • the contact preventing means is a cover having the above shape, the volume of the internal space of the cover and the volume of the area in which the movable part of the work apparatus body moves can be made substantially equal. For this reason, even if a contact prevention means is included, the compact structure of a working device is realizable. Since there is no contact between the work apparatus main body and the object other than the intrusion from the intrusion part, it is possible to work with peace of mind even if the worker is near the work apparatus.
  • the intrusionable portion has a length in a movable direction of the two linear motion actuators parallel to a plane in which the intrusionable portion exists, which is longer than a movable range of the two linear motion actuators, respectively. It may be small. With this configuration, an object cannot be put between the cover and the work apparatus main body, so that contact between the work apparatus main body and the object can be reliably prevented.
  • the rotating unit may be a link operating device in which at least one of the plurality of rotating mechanisms has two degrees of freedom.
  • the distal end side link hub is connected to the proximal end side link hub via three or more sets of link mechanisms so that the posture can be changed.
  • Each of the link mechanisms includes a base end side and a front end side end link member, one end of which is rotatably connected to the base end side link hub and the front end side link hub, and the base end side and the front end side.
  • a central link member having both ends rotatably connected to the other end of the end link member.
  • the link actuating device is composed of a link hub on the base end side, a link hub on the front end side, and three or more sets of link mechanisms.
  • the link hub on the front end side is rotatable about two orthogonal axes with respect to the link hub on the base end side.
  • a two-degree-of-freedom mechanism Although this two-degree-of-freedom mechanism is compact, the movable range of the link hub on the distal end side can be widened.
  • the maximum bending angle between the central axis of the link hub on the proximal end side and the central axis of the link hub on the distal end side is about ⁇ 90 °
  • the swivel angle of the link hub on the distal end side with respect to the link hub on the proximal end side is It can be set in the range of 0 ° to 360 °.
  • a smooth operation having no singular point is possible in the operation range of the bending angle of 90 ° and the turning angle of 360 °.
  • the link operating device has a compact movable structure and a wide movable range, the entire working device has a compact structure.
  • each of the attitude control actuators has torque detection means, and contact detection for detecting that an object has contacted the rotary unit from a detection signal of the torque detection means.
  • Means may be provided.
  • the link actuating device is configured to move smoothly in all directions without any singular point within the movable range. Therefore, even if a foreign object contacts the link hub on the tip side from various directions, torque is reliably transmitted to the attitude control actuator. Thereby, the torque detection means can detect torque in various directions, and the contact detection means can accurately detect that an object has come into contact.
  • the torque detection means provided in the attitude control actuator for contact detection there is no need to provide another contact detection sensor. As a result, the working apparatus main body can be made compact and the cost can be reduced.
  • an intrusion prevention cover is provided to prevent an object from entering the internal space between the proximal end side link hub and the distal end side link hub. It is good to have. By providing the intrusion prevention cover, it is possible to prevent an object from entering the internal space by mistake.
  • the rotating unit may be provided with a cushioning material that reduces an impact when contacting the object.
  • a cushioning material that reduces an impact when contacting the object.
  • each of the linear motion actuators of the linear motion unit may be arranged such that a stage made up of each forward / backward portion faces outward with respect to a work space in which work is performed by the end effector.
  • a control device for controlling the operation speed of the work apparatus main body to be reduced or to be stopped. Good.
  • the operation of the work apparatus main body is controlled by the control device according to the detection result of the intrusion detection sensor.
  • the worker can carry out the work unloading / loading work into the work area and the auxiliary work of the work apparatus body with peace of mind.
  • the contact prevention means is provided with one or more workpiece loading / unloading sections for unloading / loading a workpiece between the work area and the non-work area, and an object is transferred from the workpiece loading / unloading section to the work area. It is preferable that an intrusion detection sensor for a work carry-in / out section that detects the intrusion is provided. If the workpiece carrying-in / out section is provided in the contact preventing means, the work device main body can be installed on a line of a device for carrying out / loading the workpiece into / from the work area, for example, a conveyor device.
  • the auxiliary work of the work apparatus main body is performed by putting a hand from the intrusion enabled part, normally, an object does not enter the work area from the work carry-in / out part. Therefore, by providing an intrusion detection sensor for the workpiece loading / unloading section, it is possible to detect an abnormal situation in which an object has entered the work area from the workpiece loading / unloading section. This makes it possible to take a quick response.
  • the two-arm type work device of the present invention is arranged side by side so as to be geometrically symmetrical with each other, and each of the two work devices has a six-degree-of-freedom work device body that performs work using an end effector.
  • Contact prevention means for preventing an object from unnecessarily contacting the main body.
  • the work apparatus main body includes a three-degree-of-freedom linear motion unit combining three linear motion actuators and a three-degree-of-freedom rotation unit combining a plurality of rotation mechanisms having one or more degrees of freedom of rotation. Yes.
  • the linear motion unit is installed with a base fixed to a gantry, the base of the rotary unit is fixed to an output of the linear motion unit, and the end effector is mounted on the output of the rotary unit.
  • the contact preventing means separates a work area that is a space in which the two work apparatus main bodies are installed and a non-work area that is a space outside the work area.
  • the contact prevention means includes an intrusion part that allows an object to enter the work area from the non-work area, and an intrusion detection sensor that detects that an object has entered the work area from the intrusion part. Yes.
  • the two working device main bodies of the dual-arm working device with this configuration also have the same effects as the working device main body of the working device of the present invention described above.
  • the double-arm type work device can be operated by a person using both hands by arranging two work device bodies. This makes it possible to perform operations that take the place of people, particularly operations such as assembly of parts.
  • FIG. 12 is a sectional view taken along line XIV-XIV in FIG. 11. It is the figure which expressed one link mechanism of the link actuating device with a straight line. It is a block diagram which shows the structure of the controller of the work apparatus.
  • FIG. 20 is a cross-sectional view taken along line XX-XX in FIG. It is a front view which shows the principal part of the rotation unit of the working device main body of the working device concerning 5th Embodiment of this invention. It is the front view which represented a part of double arm type working device concerning a 6th embodiment of this invention by the section.
  • the working device 1 includes a working device main body 1A and a cover 130 surrounding the working device main body 1A.
  • the cover 130 is a contact preventing means for preventing an object from unnecessarily coming into contact with the work apparatus main body 1A.
  • the work apparatus main body 1A includes a gantry 2, a linear motion unit 3 installed with the base fixed to the gantry 2, a rotation unit 4 installed with the base fixed to the output of the linear motion unit 3, And an end effector 5 mounted on the output unit of the rotating unit 4.
  • the end effector 5 performs an operation on the workpiece 7 placed on the workpiece placement table 6.
  • the end effector 5 may perform work while contacting the workpiece 7 or may perform work without contact. Work on the work 7 by the end effector 5 is possible within the range of the work space S.
  • the linear motion unit 3 has a configuration of three degrees of freedom by combining three linear motion actuators.
  • the rotation unit 4 has a configuration with three degrees of freedom by combining a plurality of rotation mechanisms having one degree of freedom or more.
  • the rotation unit 4 is constituted by combining three one-free rotation mechanisms. Therefore, the work apparatus main body 1A has a configuration with six degrees of freedom as a whole.
  • the linear motion unit 3 includes a first linear motion actuator 11, a second linear motion actuator 12, and a third linear motion actuator 13.
  • the first linear actuator 11 is installed in the horizontal portion 2a of the gantry 2 and the stage 11a moves back and forth in the left-right direction (X-axis direction) (effective stroke sX).
  • the second linear actuator 12 is installed on the stage 11a of the first linear actuator 11, and the stage 12a moves back and forth (Y-axis direction) (effective stroke sY).
  • the third linear actuator 13 is installed on the stage 12a of the second linear actuator 12, and the stage 13a moves back and forth in the vertical direction (Z-axis direction) (effective stroke sZ).
  • Each of the linear motion actuators 11, 12, and 13 is an electric actuator that uses the motors 11b, 12b, and 13b as drive sources.
  • Each of these linear motion actuators 11, 12, 13 is arranged such that its stages 11 a, 12 a, 13 a face outward with respect to the work space S (FIG. 1).
  • the base portion of the linear motion unit 3 fixed to the gantry 2 is a portion of the first linear motion actuator 11 that does not advance and retreat.
  • the output unit of the linear motion unit 3 to which the base of the rotation unit 4 is fixed is the stage 13 a of the third linear motion actuator 13.
  • the rotation unit 4 includes a rotation unit attachment member 20 fixed to the output portion of the linear motion unit 3 (FIG. 1), a first rotation mechanism 21 attached to the rotation unit attachment member 20, and the first rotation.
  • a second rotating mechanism 22 attached to the rotating portion 21a of the mechanism 21 and a third rotating mechanism 23 attached to the rotating portion 22a of the second rotating mechanism 22 are provided.
  • the rotation axes 21b, 22b, and 23b of the first to third rotation mechanisms 21, 22, and 23 are orthogonal to each other.
  • the rotation drive sources of these rotation mechanisms 21, 22, and 23 are, for example, motors 21c, 22c, and 23c.
  • the base of the rotary unit 4 fixed to the output part of the linear motion unit 3 is the rotary unit mounting member 20.
  • the output unit of the rotary unit 4 to which the end effector 5 is attached is the rotary portion 23 a of the third rotary mechanism 23.
  • screw holes 14 and 15 and a positioning hole 16 for fixing the rotary unit mounting member 20 are provided in the stage 13 a of the third linear actuator 13 which is an output portion of the linear motion unit 3. It has been. Only one screw hole 14 is provided at the center of the location where the rotary unit mounting member 20 is fixed. A plurality of screw holes 15 are provided on the circumference around the screw hole 14. The same number of positioning holes 16 as the screw holes 15 are provided on the circumference having the radius smaller than that of the screw holes 15 on the circumference centered on the screw holes 14.
  • the rotating unit mounting member 20 has three bolt insertion holes (not shown) aligned in a straight line corresponding to the screw holes 14 and the two screw holes 15, and two positioning protrusions (not shown) corresponding to the positioning holes 16. ) And are provided.
  • the mounting bolt 24 is inserted into each of the three bolt insertion holes of the rotary unit mounting member 20, and is screwed into the screw hole 14 and the two screw holes 15 at the center of the stage 13a. To do. Thereby, the rotation unit attachment member 20 is fixed to the stage 13a. By changing the positioning hole 16 of the stage 13a with which the positioning projection of the rotating unit mounting member 20 is engaged, the mounting angle of the base portion of the rotating unit 4 with respect to the output portion of the linear motion unit 3 can be changed.
  • the position of the end effector 5 is mainly determined by the linear motion unit 3 having three degrees of freedom, and the posture of the end effector 5 is determined by the rotation unit 4 having three degrees of freedom.
  • Each linear motion actuator 11, 12, 13 of the linear motion unit 3 corresponds to the position of the end effector 5 expressed in an orthogonal coordinate system.
  • Each rotation mechanism 21, 22, 23 of the rotation unit 4 corresponds to the posture of the end effector 5 expressed in a polar coordinate system. Therefore, it is easy to imagine the operation of each of the linear actuators 11, 12, 13 with respect to the position of the end effector 5 and the operation of each of the rotation mechanisms 21, 22, 23 with respect to the posture. Therefore, it is easy to set an operation pattern such as posture teaching work.
  • the operation positions of the linear actuators 11, 12, and 13 and the operation angles of the rotation mechanisms 21, 22, and 23 are uniquely determined. That is, it has no singularity. For these reasons, it is possible to operate the work apparatus main body 1A without skilled knowledge and experience.
  • the work can be performed mainly by moving only the rotating unit 4. Therefore, the operation amount of the linear motion unit 3 can be small, and the entire movable range of the work apparatus main body 1A can be reduced. Further, the installation area of the cover 130 can be reduced.
  • linear motion actuators 11, 12, and 13 Since the position of the end effector 5 is determined by the linear motion actuators 11, 12, and 13, the linear motion of the end effector 5 can be performed quickly and accurately. Further, linear actuators 11, 12, and 13 are used in portions that greatly affect the movable range. For this reason, the operation range can be easily limited using a mechanical stopper and a limit sensor according to the work content and the surrounding environment.
  • the linear actuators 11, 12, and 13 of the linear motion unit 3 are arranged so that the stages 11 a, 12 a, and 13 a, which are forward and backward portions thereof, face the outside with respect to the work space S. Thereby, the work space S can be widened. In addition, when an object enters the work space S, the possibility that the object will contact the work apparatus main body 1A can be reduced.
  • the linear motion unit 3 and the rotation unit 4 are provided separately, only one of the units can be changed when the specifications of the work apparatus main body 1A are changed.
  • the rotation unit 4 can be changed from the form shown in FIG. 3 to the form shown in FIG. 11 described later, the form shown in FIG. 17, the form shown in FIG. As a result, it is possible to share parts between the work apparatus main bodies 1A having different specifications.
  • the rotating unit mounting member 20, which is the base of the rotating unit 4 is attached to the stage 13 a of the third linear actuator 13 that is the output unit of the linear moving unit 3 by using the mounting bolt 24 so that the mounting angle can be changed. It has been. For this reason, the apparatus configuration can be easily changed according to the work content and the surrounding environment.
  • the work apparatus main body 1A has a small total operation amount of the work apparatus main body 1A when performing fine work. For this reason, contact with an object can be easily avoided. Therefore, it is possible to automatically perform a work close to a manual work performed by a person. In addition, the setup change time and adjustment time can be shortened, and high-speed operation is possible, thereby improving productivity.
  • the cover 130 includes four elevation materials (face materials) 131, 132, 133, and 134 and one top surface material (face material) 135. That is, the cover 130 has a rectangular parallelepiped shape with the lower surface opened. These face materials 131 to 135 are arranged so that two adjacent face materials are orthogonal to each other.
  • the work area R1 shown in FIG. 1 is separated from the non-work area R2 (FIG. 1).
  • the work area R1 is a space in which the work apparatus main body 1A is installed.
  • the non-work area R2 is a space outside the work area R1.
  • each of the four elevation members 131 to 134 and one top member 135 has two movable directions out of the movable directions of the three linear actuators 11, 12, 13 (FIG. 1). It is installed to be parallel. Specifically, the elevation members 131 and 133 are parallel to the movable directions (X-axis direction and Z-axis direction) of the first linear motion actuator 11 and the third linear motion actuator 13. The elevation members 132 and 134 are parallel to the movable directions (Y-axis direction and Z-axis direction) of the second linear actuator 12 and the third linear actuator 13. Furthermore, the top surface material 135 is parallel to the movable directions (X-axis direction and Y-axis direction) of the first linear motion actuator 11 and the second linear motion actuator 13.
  • An intrusion portion 136 capable of allowing an object or the hand of the operator P to enter the work area R1 from the non-work area R2 is provided at the lower part of the vertical surface material 132 facing the side surface.
  • the intruder 136 is a rectangular opening.
  • the height dimension H of the intrusionable portion 136 is smaller than the movable range (effective stroke sZ (FIG. 2)) of the third linear actuator 13. Further, the width dimension W of the intrusionable portion 136 is smaller than the movable range (effective stroke sY (FIG. 2)) of the second linear actuator 12.
  • An intrusion detection sensor 137 is provided on the cover 130.
  • the intrusion detection sensor 137 detects that an object has entered the work area R1 from the intrusion enabled portion 136.
  • the intrusion detection sensor 137 is, for example, an optical sensor in which a light emitting unit 137a and a light receiving unit 137b are arranged side by side at the upper end and the lower end of the intrusion possible unit 136.
  • the intrusion detection sensor 137 is connected to the control device 138.
  • the control device 138 is of a numerical control type by a computer, for example. When the intrusion detection sensor 137 detects the intrusion, the control device 138 restricts driving of the motors 11b, 12b, 13b of the linear motion unit 3 and the motors 21c, 22c, 23c of the rotation unit 4.
  • FIG. 5 is a flowchart showing an example of control by the control device 138.
  • the operation command is OFF and the operation completion is ON.
  • the operation command and the operation completion signal are output by an operator's switch operation or the like.
  • the work apparatus main body 1A starts operation (step 1).
  • step 2 it is determined whether or not the operation completion is ON (step 2). When it is ON, the operation of the work apparatus main body 1A is stopped and the work is finished. If not ON, the operation of the work apparatus main body 1A is continued.
  • step 3 it is determined whether or not the intrusion detection sensor 137 is ON during the operation of the work apparatus main body 1A (step 3). If it is ON, the operation of the work apparatus main body 1A is stopped (step 4). If not, the normal operation of the work apparatus main body 1A is continued (step 5). The normal operation is an operation that performs a commanded operation at a commanded speed. Even when the intrusion detection sensor 137 is turned on and the operation of the work apparatus main body 1A is stopped, if the intrusion detection sensor 137 is not turned on, the operation of the work apparatus main body 1A is resumed (step 5).
  • step 3 the intrusion detection sensor 137 is turned off (step 3), and the work apparatus body 1A resumes operation (step 5).
  • FIG. 6 is a flowchart showing another example of control by the control device 138.
  • this control does not stop the operation of the work apparatus main body 1A as shown in FIG. 5, but decelerates the operation of the work apparatus main body 1A (step 4). .
  • the intrusion detection sensor 137 is not turned ON, the work apparatus body 1A is returned to the normal operation (step 5).
  • the operation completion signal is turned ON during the deceleration operation (YES in step 2), the operation of the actuator main body 1A is stopped and the operation is finished.
  • Other controls are the same as in FIG.
  • each of the four elevation members 131, 132, 133, 134 and one top member 135 has two movable directions among the movable directions of the three linear actuators 11, 12, 13. Parallel. Therefore, the internal space volume of the cover 130 and the volume of the region in which the movable part of the work apparatus main body 1A moves can be made substantially equal. Therefore, even if the cover 130 is included, a compact configuration of the work device 1 can be realized. In addition, since there is no contact between the work apparatus main body 1 and an object other than the intrusion part 136, it is possible to work with peace of mind even if the worker is near the work apparatus.
  • the configuration of the three linear actuators 11 to 13 and the cover 130 is not limited to this. That is, the movable directions of the three linear actuators 11 to 13 do not have to be orthogonal to each other.
  • each of the four upright members 131 to 134 and the one top member 135 is parallel to two of the movable directions of the three linear actuators 11 to 13, and the working device main body 1A is What is necessary is just to arrange
  • the height dimension H of the intrusion portion 136 is smaller than the movable range (effective stroke sZ) of the third linear actuator 13, and the width dimension W is the movable range (effective stroke) of the second linear actuator 12. sY). Therefore, an object does not enter between the cover 130 and the work apparatus main body 1.
  • FIG. 7 shows another example of contact prevention means comprising a cover.
  • the cover 130 is provided with two work loading / unloading portions 141 and 142 separately from the intrusionable portion 136.
  • the two workpiece loading / unloading portions 141 and 142 are respectively provided at the lower portions of the elevation materials 131 and 133 that are orthogonal to the elevation material 132 on which the intrusionable portion 136 is provided and face each other.
  • the work loading / unloading portions 141 and 142 are arranged with their positions in the left-right direction (X-axis direction) and the vertical direction (Z-axis direction) aligned.
  • a device for example, a conveyor device that loads and unloads workpieces into the work area R1 (FIG. 1) in the cover 130 passes through the workpiece loading / unloading portions 141 and 142.
  • the working device main body 1A (FIG. 1) can be installed on the line of the conveyor device.
  • intrusion detection sensors 143 and 144 for the workpiece loading / unloading section that detect that an object has entered the work area R1 from the workpiece loading / unloading sections 141 and 142 in the workpiece loading / unloading sections 141 and 142.
  • These intrusion detection sensors 143 and 144 for the work carry-in / out section are, for example, optical sensors having light emitting sections 143a and 144a and light receiving sections 143b and 144b.
  • the intrusion detection sensors 143 and 144 for the work carry-in / out section are also connected to the control device 138 in the same manner as the intrusion detection sensor 137 for the intrusion enabled section.
  • FIG. 8 is a flowchart showing an example of control by the control device 138.
  • a process (step 3) for determining whether or not the intrusion detection sensors 143 and 144 for the work loading / unloading section are ON is added between step 2 and step 3 shown in FIG. If at least one of the intrusion detection sensors 143 and 144 for the work loading / unloading unit is ON in step 3, the operation completion is set to ON (step 4), and the operation is completed.
  • the intrusion detection sensors 143 and 144 for the work loading / unloading section are both OFF, it is determined whether or not the intrusion detection sensor 137 for the intrusion capable section is ON (step 5). Similar to the control of FIG. 6, when the intrusion detection sensor 137 is ON, the operation of the work apparatus body 1A is decelerated (step 6). When the intrusion detection sensor 137 is OFF, the normal operation of the work apparatus main body 1A is continued (step 5).
  • the intrusion detection sensors 143 and 144 for the work carry-in / out section it is possible to detect an abnormal situation in which an object has entered the work area R1 from the work carry-in / out sections 141 and 142. As a result, it is possible to take a quick response to stop the operation cycle of the work apparatus main body 1A.
  • FIG. 9 shows the configuration of another contact prevention means.
  • This contact preventing means 170 is not a cover that completely surrounds the work area R1, but has a form in which the boundary between the work area R1 and the non-work area R2 is opened. That is, a rectangular parallelepiped frame 171 is configured by combining a plurality of bar members, and a work area R1 is formed inside the frame 171.
  • the frame 171 includes four vertical members 171a erected at rectangular corners in plan view and four horizontal members 171b spanned between the upper ends of adjacent vertical members 171a.
  • An elevation member 132 is attached to the elevation surface of the frame 171 on the front side as viewed from the operator.
  • An intrusionable portion 136 through which an object can enter the work area R1 is provided at the bottom of the elevation member 132.
  • An intrusion detection sensor 137 for detecting that an object has entered the work area R1 from the intrusion capable portion 136 is provided in the intrusion possible portion 136.
  • intrusion detection sensors 172 and 173 that detect that an object has entered the work area R1 from the open portion of the frame 171 are provided in the four horizontal members 171b of the frame 171.
  • the three intrusion detection sensors 172 respectively detect intrusions from three open vertical surfaces of the frame 171.
  • the intrusion detection sensor 173 detects an intrusion from the open top surface of the frame 171.
  • These intrusion detection sensors 172 and 173 for open portions are, for example, infrared cameras.
  • the intrusion detection sensor 137 for the intrusionable portion and the intrusion detection sensors 172 and 173 for the open portion are connected to the control device 138, and the control device 138 performs the control shown in FIG.
  • the control device 138 controls the motors 11b, 12b, and 13b of the linear motion unit 3 and the motors 21c, 22c, and 23c of the rotary unit 4 to obtain a work area.
  • the work 7 can be unloaded and carried into R1 and the auxiliary work of the work apparatus body 1 can be reliably performed.
  • the working apparatus body 1 ⁇ / b> A of the working apparatus 1 includes a first rotating mechanism 21, which is a rotating mechanism 4 having a one degree of freedom, and a link actuator 29 having two degrees of freedom. And two rotation mechanisms. That is, the second rotation mechanism 22 and the third rotation mechanism 23 in the first embodiment of FIG. Other than this, the second embodiment is the same as the first embodiment shown in FIG.
  • the link actuating device 29 has a parallel link mechanism 30 and an attitude control actuator 31 for actuating the parallel link mechanism 30.
  • 12 and 13 are perspective views of the parallel link mechanism 30.
  • FIG. 12 and 13 show different states of the parallel link mechanism 30.
  • FIG. 11 shows only one set of link mechanisms 34. The number of link mechanisms 34 may be four or more.
  • Each link mechanism 34 includes a base end side end link member 35, a front end side end link member 36, and a central link member 37. That is, each link mechanism 34 constitutes a four-joint link mechanism composed of four rotating pairs.
  • the end link members 35 and 36 on the proximal end side and the distal end side are L-shaped.
  • One end of the end link member 35 on the base end side is rotatably connected to the link hub 32 on the base end side.
  • One end of the distal end side end link member 36 is rotatably connected to the distal end side link hub 33.
  • the other ends of the end link members 35 and 36 on the proximal end side and the distal end side are rotatably connected to both ends of the central link member 37, respectively.
  • the parallel link mechanism 30 has a structure in which two spherical link mechanisms are combined.
  • the central axis of each rotational pair of the proximal side link hub 32 and the proximal side end link member 35 and each rotational pair of the proximal side end link member 35 and the central link member 37 are at the proximal side. It intersects at the spherical link center PA (FIG. 11) on the base end side.
  • the central axis of each rotational pair of the distal end side link hub 33 and the distal end side end link member 36 and each rotational pair of the distal end side end link member 36 and the central link member 37 is the distal end on the distal end side. It intersects at the spherical link center PB (FIG. 11) on the side.
  • each rotation pair of the base end side link hub 32 and the base end side end link member 35 to the base end side spherical link center PA is the same. Further, the distance from the rotation pair of the end-side end link member 35 and the center link member 37 to the base-side spherical link center PA is also the same.
  • the distance from each rotational pair of the distal end side link hub 33 and the distal end side end link member 36 to the spherical link center PB on the distal end side is the same. Further, the distance from each rotation pair of the end-side end link member 36 and the central link member 37 to the front-end spherical link center PB is the same.
  • the central axis of each rotational pair of the proximal and distal end link members 35, 36 and the central link member 37 may have a certain crossing angle ⁇ (FIG. 11) or may be parallel. Good.
  • FIG. 14 is a cross-sectional view taken along the line XIV-XIV in FIG.
  • FIG. 14 shows the central axis O1 of the rotational pair of the link hub 32 on the base end side and the end link member 35 on the base end side, and the central axis of the rotational pair of the central link member 37 and the end link member 35 on the base end side.
  • the relationship between O2 and the spherical link center PA on the base end side is shown. That is, the point where the central axis O1 and the central axis O2 intersect is the spherical link center PA.
  • the shape and positional relationship of the distal end side link hub 33 and the distal end side end link member 36 are also the same as in FIG. In FIG.
  • the angle ⁇ formed by is 90 °. However, the angle ⁇ may be other than 90 °.
  • the three sets of link mechanisms 34 have the same geometric shape.
  • the geometrically identical shape is expressed by a geometric model in which each link member 35, 36, 37 is expressed by a straight line, that is, by each rotation pair and a straight line connecting these rotation pairs.
  • the model means that the base end side portion and the tip end side portion are symmetrical with respect to the center portion of the center link member 37.
  • FIG. 15 is a diagram in which a set of link mechanisms 34 is expressed by a straight line.
  • the parallel link mechanism 30 of this embodiment is a rotationally symmetric type.
  • the positional relationship between the proximal-side link hub 32 and the proximal-side end link member 35 and the distal-end-side link hub 33 and distal-end-side end link member 36 is the center line C of the central link member 37. Is rotationally symmetric.
  • the central portion of the central link member 37 is located on a common track circle D.
  • the link hub 32 on the proximal end side, the link hub 33 on the distal end side, and the three sets of link mechanisms 34 allow the link hub 33 on the distal end side to rotate about two orthogonal axes with respect to the link hub 32 on the proximal end side.
  • the degree mechanism is configured.
  • the position of the link hub 33 on the distal end side with respect to the link hub 32 on the proximal end side is a mechanism whose posture can be freely changed with two degrees of freedom.
  • this two-degree-of-freedom mechanism is compact, the movable range of the link hub 33 on the distal end side with respect to the link hub 32 on the proximal end side can be widened.
  • a straight line that passes through the spherical link center PA on the base end side and intersects the central axis O1 (FIG. 14) of the rotation pair of the link hub 32 on the base end side and the end link member 35 on the base end side at a right angle is the base end side.
  • the center axis QA of the link hub 32 of FIG. Similarly, a straight line that passes through the spherical link center PB on the distal end side and intersects the central axis O1 (FIG. 14) of the rotational pair of the distal end side link hub 33 and the distal end side end link member 36 at a right angle is connected to the distal end side link hub.
  • the central axis QB of 33 is assumed.
  • the maximum value of the bending angle ⁇ (FIG. 15) between the center axis QA of the link hub 32 on the proximal end side and the center axis QB of the link hub 33 on the distal end side can be about ⁇ 90 °.
  • the turning angle ⁇ (FIG. 15) of the distal end side link hub 33 with respect to the proximal end side link hub 32 can be set in a range of 0 ° to 360 °.
  • the bending angle ⁇ is a vertical angle at which the central axis QB of the distal link hub 33 is inclined with respect to the central axis QA of the proximal link hub 32.
  • the turning angle ⁇ is a horizontal angle at which the central axis QB of the distal link hub 33 is inclined with respect to the central axis QA of the proximal link hub 32.
  • the posture change of the distal end side link hub 33 with respect to the proximal end side link hub 32 is performed with an intersection O between the central axis QA of the proximal end side link hub 32 and the central axis QB of the distal end side link hub 33 as a rotation center. Is called.
  • FIG. 12 shows a state where the central axis QA of the link hub 32 on the proximal end side and the central axis QB of the link hub 33 on the distal end side are on the same line.
  • FIG. 13 shows a state in which the central axis QB of the distal end side link hub 33 takes a predetermined operating angle with respect to the central axis QA of the proximal end side link hub 32. Even if the posture changes, the distance L (FIG. 15) between the spherical link centers PA and PB on the proximal end side and the distal end side does not change.
  • the parallel link mechanism 30 functions as a constant velocity universal joint that rotates at a constant speed with the same rotation angle on the proximal end side and the distal end side when transmitting rotation from the proximal end side to the distal end side.
  • Condition 1 The angles and lengths of the central axes O1 of the rotational pairs of the link hubs 32 and 33 and the end link members 35 and 36 in each link mechanism 34 are equal to each other.
  • Condition 3 The geometric shapes of the proximal end side end link member 35 and the distal end side end link member 36 are equal.
  • Condition 4 The geometric shapes of the proximal end portion and the distal end portion of the central link member 37 are equal.
  • Condition 5 With respect to the symmetry plane of the central link member 37, the angular positional relationship between the central link member 37 and the end link members 35 and 36 is the same on the proximal end side and the distal end side.
  • the base end side link hub 32 has a base end member 40 and three rotary shaft connecting members 41 provided integrally with the base end member 40.
  • the base end member 40 has a circular through hole 40a at the center.
  • three rotary shaft connecting members 41 are arranged at equal intervals in the circumferential direction.
  • the center of the through hole 40a is located on the central axis QA (FIG. 11) of the link hub 32 on the proximal end side.
  • a rotating shaft 42 is rotatably connected to each rotating shaft connecting member 41.
  • the axis of the rotary shaft 42 intersects the central axis QA of the link hub 32 on the proximal end side.
  • the rotating shaft 42 has a head portion 42a and a screw portion 42b. One end of an end link member 35 on the base end side is connected to the rotating shaft 42.
  • the rotating shaft 42 is rotatably supported by the rotating shaft connecting member 41 through two bearings 43.
  • the bearing 43 is a ball bearing such as a deep groove ball bearing or an angular ball bearing. These bearings 43 are installed in a fitted state in an inner diameter hole 44 provided in the rotary shaft connecting member 41, and are fixed by a method such as press fitting, bonding, or caulking. The same applies to the types and installation methods of the bearings provided in other rotating pairs.
  • a base end side end link member 35 and a fan-shaped bevel gear 45 described later are coupled to the rotating shaft 42.
  • the proximal end side end link member 35 and the bevel gear 45 rotate integrally with the rotation shaft 42.
  • a notch 46 is formed at one end of the end link member 35 on the base end side.
  • Rotating shaft support portions 47 and 48 are formed on the inside and outside in the radial direction of the notch portion 46.
  • the rotary shaft connecting member 41 is disposed between the rotary shaft support portions 47 and 48.
  • the bevel gear 45 is disposed in contact with the inner surface of the inner rotary shaft support portion 47. From the inside in the radial direction, the rotating shaft 42 has a through hole formed in the bevel gear 45, a through hole formed in the inner rotating shaft support portion 47, an inner ring of the bearing 43, and a through hole formed in the outer rotating shaft support portion 48. Insert in the order of the holes. Further, the nut 50 is screwed onto the screw portion 42 b of the rotating shaft 42. As a result, the bevel gear 45, the inner and outer rotary shaft support portions 47 and 48, and the inner ring of the bearing 43 are clamped and coupled by the head portion 42a of the rotary shaft 42 and the nut 50, respectively. In the present embodiment, spacers 51 and 52 are interposed between the inner and outer rotary shaft support portions 47 and 48 and the bearing 43. Thus, a preload is applied to the bearing 43 when the nut 50 is screwed.
  • the rotation shaft 55 is coupled to the other end of the end link member 35 on the base end side.
  • the rotating shaft 55 has a head portion 55a and a screw portion 55b.
  • the rotating shaft 55 is rotatably connected to one end of the central link member 37 via two bearings 53.
  • a notch 56 is formed at the other end of the end link member 35 on the base end side.
  • Inner and outer rotary shaft support portions 57 and 58 are formed inside and outside the cutout portion 56 in the radial direction.
  • One end of the central link member 37 is disposed between the rotating shaft support portions 57 and 58.
  • Rotating shaft 55 is inserted from the outside in the radial direction in the order of a through hole formed in outer rotating shaft support portion 58, an inner ring of bearing 53, and a through hole formed in inner rotating shaft support portion 57. Further, the nut 60 is screwed onto the screw portion 55 b of the rotating shaft 55. As a result, the inner and outer rotary shaft support portions 57 and 58 and the inner ring of the bearing 53 are clamped by the head portion 55a of the rotary shaft 55 and the nut 60 and coupled to each other. In the present embodiment, spacers 61 and 62 are interposed between the inner and outer rotary shaft support portions 57 and 58 and the bearing 53. Thus, a preload is applied to the bearing 53 when the nut 60 is screwed.
  • the link hub 33 on the distal end side has a distal end member 70 and three rotary shaft connecting members 71 provided on the inner surface of the distal end member 70.
  • the three rotating shaft connecting members 71 are provided on the inner surface of the tip member 70 at equal intervals in the circumferential direction.
  • the center of the circumference where the rotation shaft connecting member 71 is arranged is located on the center axis QB of the link hub 33 on the distal end side.
  • a rotary shaft 73 is rotatably connected to the rotary shaft connecting member 71.
  • the axis of the rotation shaft 73 intersects the link hub center axis QB.
  • One end of the end link member 36 on the front end side is connected to the rotation shaft 73 of the link hub 33 on the front end side.
  • a rotating shaft 75 is connected to the other end of the end link member 36 on the front end side.
  • the rotating shaft 75 is rotatably connected to the other end of the central link member 37.
  • the rotary shaft 73 of the link hub 33 on the distal end side is rotatably connected to the other end of the rotary shaft connecting member 71 via two bearings (not shown), like the rotary shaft 42 described above.
  • the rotating shaft 75 of the central link member 37 is rotatably connected to the other end of the central link member 37 via two bearings (not shown), like the rotating shaft 55 described above.
  • the base end member 40 and the base member 80 are connected via a plurality of shafts 81. Thereby, the parallel link mechanism 30 is installed in the first rotation mechanism 21.
  • the central axis QA of the link hub 32 on the proximal end side and the rotation axis 21b of the first rotation mechanism 21 are located on the same line.
  • the base member 80 is fixed to the rotating portion 21 a of the first rotating mechanism 21.
  • a cylindrical protective cover 82 that covers the link actuator 29 is provided around the link actuator 29.
  • the protective cover 82 is made of an elastic material such as rubber.
  • the protective cover 82 is attached to the outer peripheral edge of the base member 80, the outer peripheral edge of the base end member 40, and the outer peripheral edge of the distal end member 70.
  • the protective cover 82 can be deformed in accordance with the change in the attitude of the distal end side link hub 33 relative to the proximal end side link hub 32.
  • the protective cover 82 is inserted into the internal space 83 between the link hub 32 on the proximal end side and the link hub 33 on the distal end side, and the shielding space 84 between the link hub 32 on the proximal end side and the base member 80.
  • This is an intrusion prevention cover that prevents the intrusion.
  • a protective cover 85 is provided on the outer peripheral surface of the fixed portion of the first rotating mechanism 21 in a state of being attached.
  • the protective cover 85 is made of a material having a shock absorbing property such as rubber.
  • the protective cover 85 functions as a cushioning material that reduces an impact when an object comes into contact.
  • the parallel link mechanism 30 is operated by an attitude control actuator 31.
  • the attitude control actuator 31 is disposed in the shielding space 84 and is disposed on the proximal end member 40.
  • the number of attitude control actuators 31 is three, which is the same as the number of link mechanisms 34.
  • the attitude control actuator 31 is a rotary actuator such as a motor, for example.
  • a gear 76 is attached to the rotation output shaft 31 a of the attitude control actuator 31.
  • the fan-shaped bevel gear 45 described above is attached to the rotating shaft 42 of the link hub 32 on the proximal end side. These bevel gears 76 and 45 mesh with each other.
  • a bevel gear 76 and a fan-shaped bevel gear 45 constitute an axis orthogonal reduction gear 77.
  • an axis orthogonal reduction device may be configured using a mechanism other than the bevel gear (for example, a worm mechanism).
  • the same number of posture control actuators 31 as the link mechanisms 34 are provided. However, it is only necessary that the posture control actuators 31 are provided in at least two of the three sets of link mechanisms 34. Accordingly, the posture of the link hub 33 on the distal end side with respect to the link hub 32 on the proximal end side can be determined.
  • the link actuating device 29 actuates the parallel link mechanism 30 by rotationally driving the attitude control actuator 31. Specifically, when the attitude control actuator 31 is rotationally driven, the rotation is transmitted to the rotary shaft 42 via the axis orthogonal type reduction gear 77. As a result, the angle of the end link member 35 on the base end side with respect to the link hub 32 on the base end side changes. As a result, the position and posture of the distal end side link hub 33 with respect to the proximal end side link hub 32 are determined. Since the central axis QA of the link hub 32 on the proximal end side and the rotation axis 21b of the first rotation mechanism 21 are located on the same line, coordinate calculation is easy.
  • the center axis QA of the link hub 32 on the base end side and the rotation axis 21b of the first rotation mechanism 21 are located on the same line, the operator can easily imagine the operation of the work apparatus main body 1A. For this reason, operation is easy.
  • the position of 3 degrees of freedom determined by the linear motion unit 3 is fixed, and the angle of 2 degrees of freedom among the angles of 3 degrees of freedom determined by the rotation unit 4 is fixed, and the remaining one degree of freedom angle
  • only the angle around the central axis QB of the link hub 33 on the distal end side is changed.
  • the work can be easily performed while changing the posture of the end effect 5.
  • the link actuating device 31 has a wide movable range and can operate smoothly. Therefore, if the rotation unit 4 includes the link actuating device 29, it is possible to perform fine work at high speed. Moreover, the link actuator 31 has a wide movable range although it is a compact structure. For this reason, the whole working apparatus main body 1A becomes a compact structure.
  • the first rotation mechanism 21 is disposed on the proximal end side of the link operating device 29, and the end effector 5 is mounted on the link hub 33 on the distal end side.
  • the link actuator 29 can be made compact and lightweight.
  • the parallel link mechanism 30 of the link operating device 29 has a constant velocity universal joint configuration. Therefore, as described above, the work can be easily performed while changing the attitude of the end effect 5 by changing only the angle of one degree of freedom. However, since it is necessary to consider the cable connected to the attitude control actuator 31, the rotation angle is limited.
  • FIG. 16 shows the configuration of a controller 200 that controls each attitude control actuator 31.
  • the controller 200 includes posture control means 201 and contact detection means 202.
  • the posture control means 201 outputs a command to each posture control actuator 31 in accordance with the posture change command given from the host control means (not shown) or the manual input operation means (not shown).
  • the contact detection means 202 detects that an object has come into contact with the rotary unit 4 based on the detection signal of the torque detection means 203 provided in each attitude control actuator 31. Specifically, the load acting on the link hub 33 on the distal end side is estimated from the detection signal of the torque detection means 203. It is determined from the magnitude of the load whether or not an object has come into contact with the rotary unit 4. The estimation of the acting load of the link hub 33 on the distal end side does not necessarily have to be estimated as a numerical value, and may be a stepwise estimation that can determine whether contact has occurred, for example.
  • the torque detection means 203 is, for example, a current sensor that detects a current flowing through each attitude control actuator 31.
  • the link actuating device 29 has a singularity within its movable range and can move smoothly in all directions. For this reason, even if a foreign object contacts the link hub 33 on the distal end side from various directions, torque is reliably transmitted to the attitude control actuator 31. Thereby, the torque detection means 203 can detect the torque of various directions. Accordingly, the contact detection means 202 can accurately detect that an object has come into contact.
  • the posture control unit 201 stops the output to the posture control actuator 31. Thereby, the rotation unit 4 is protected. In this way, by using the torque detection means 203 of the attitude control actuator 31 for contact detection, there is no need to provide another contact detection sensor. As a result, the apparatus is downsized and the cost is reduced.
  • a protective cover 82 as an intrusion prevention cover is provided around the link actuator 29. For this reason, it is possible to prevent an object from entering the internal space 83 between the link hub 32 on the proximal end side and the link hub 33 on the distal end side. Further, a protective cover 85 as a cushioning material is provided on the outer peripheral surface of the first rotation mechanism 21. For this reason, even if an object contacts the first rotation mechanism 21, the impact is reduced.
  • the work area R1 in the cover 130 can only enter from the intrusion part 136. Therefore, the portion of the work apparatus main body 1A that may come into contact with an object is limited to the rotation unit 4 only. For this reason, if the cushioning material is provided only in the rotation unit 4, the apparatus can be protected. As a result, installation of equipment for preventing contact is minimized, and the entire apparatus is inexpensive.
  • FIG. 17 shows the rotating unit 4 of the working device body of the working device according to the third embodiment.
  • the arrangement of the first rotating mechanism 21 and the link actuator 29 is reversed from the configuration of FIG.
  • the central axis QB of the link hub 33 on the distal end side of the link actuator 29 and the rotation axis 21 b of the first rotation mechanism 21 are located on the same line.
  • a protective cover 82 as an intrusion prevention cover is provided around the link actuator 29.
  • a protective cover as a cushioning material is not provided on the outer peripheral surface of the first rotating mechanism 21.
  • a protective cover as a cushioning material may be provided on the outer peripheral surface of the first rotating mechanism 21.
  • Other structures are the same as those of the second embodiment shown in FIG.
  • the cable connected to the attitude control actuator 31 can be easily wired and is not easily limited by the rotation angle.
  • the load of the link actuator 29 increases.
  • the working device 1 also has a first rotating mechanism 21 in which the rotating unit 4 of the working device main body 1 ⁇ / b> A is a rotating mechanism with one degree of freedom, as in the second embodiment of FIG. 10. It is comprised with the link actuator 29 which is a rotation mechanism of 2 degrees of freedom.
  • the work device 1 of the fourth embodiment is different from the second embodiment of FIG. 10 in that the first rotation mechanism 21 is disposed at the center of each posture control actuator 31 of the link actuator 29. .
  • the first rotation mechanism 21 rotates to the fixed portion 90 fixed to the base member 80, the rotary portion 91 fixed to the base end member 40 of the link actuator 29, and the fixed portion 90.
  • Two bearings 92 that rotatably support the portion 91, a motor 93 that is a drive source installed in the fixed portion 90, and a pair of spur gears 94 and 95 that transmit the rotation of the motor 93 to the rotating portion 91.
  • the base member 80 is fixed to the rotating unit mounting member 20.
  • the fixed portion 90 includes a first mounting member 96 fixed to the base member 80 and a second mounting member 97 fixed to the first mounting member 96.
  • the second attachment member 97 has a bottom portion 97a fixed to the first attachment member 96, and a cylindrical portion 97b extending upward from the outer peripheral edge of the bottom portion 97a.
  • the rotating portion 91 is fixed to the proximal end member 40 of the proximal end side link hub 32 so that the rotational axis 91a thereof is positioned coaxially with the central axis QA of the proximal end side link hub 32.
  • a screw portion is provided at the lower end of the rotating portion 91, and a nut 98 is screwed into the screw portion.
  • the two bearings 92 are disposed on the inner periphery of the cylindrical portion 97 b of the second mounting member 97.
  • the first mounting member 96 has a substantially U-shaped horizontal cross section.
  • a motor 93 is disposed in the concave portion 96 a of the U-shaped first attachment member 96.
  • the motor 93 is fixed to the bottom 97 a of the second mounting member 97.
  • the output shaft 93 a of the motor 93 extends upward through the bottom 97 a of the second mounting member 97.
  • a drive-side spur gear 94 is attached to the upper end of the output shaft 93 a of the motor 93.
  • the drive-side spur gear 94 meshes with the driven-side spur gear 95.
  • the driven side spur gear 95 is attached to the rotating portion 91.
  • the driven side spur gear 95 is fitted to the outer periphery of the rotating portion 91.
  • the driven side spur gear 95 is fixed to the rotating portion 91 by a nut 98.
  • Wiring holes 100, 101, 102 are provided in the bottom 97 a, the rotating portion 91, and the base end member 40 of the second mounting member 97. Each wiring hole 100, 101, 102 is penetrated along the rotation axis 91 a of the rotating portion 91.
  • a cylindrical protective cover 82 made of an elastic material is attached to the outer peripheral edge of the base end member 40 and the outer peripheral edge of the distal end member (not shown).
  • the protective cover 82 includes an inner space 83 between the proximal end side link hub 32 and the distal end side link hub (not shown), and a shielded space between the proximal end side link hub 32 and the base member 80.
  • 84 is an intrusion prevention cover that prevents an object from entering 84.
  • the protective cover 82 extends to the vicinity of the outer peripheral edge of the base member 80, but is not coupled to the base member 80.
  • the three posture control actuators 31 of the link actuating device 29 are arranged on a virtual circumference of the base end member 40 as in the second embodiment of FIG.
  • the rotational driving force of the rotational output shaft 31 a of the attitude control actuator 31 is transmitted to the link mechanism 34 via an axis orthogonal type speed reducer 77.
  • the first rotation mechanism 21 can be arranged at the center of the arrangement of the attitude control actuators 31 as in the fourth embodiment. Thereby, the rotation unit 4 becomes a compact structure.
  • FIG. 21 is a front view of the main part of the rotating unit of the working device according to the fifth embodiment of the present invention.
  • the first rotation mechanism 21 is arranged at the center of the attitude control actuator 31 of the link actuator 29. This arrangement is the same as that of the fourth embodiment shown in FIG. 19, but differs from the fourth embodiment shown in FIG. 19 in that the drive source of the first rotating mechanism 21 is the hollow shaft motor 110.
  • the motor body 110 a of the hollow shaft motor 110 is fixed to the base member 80 via the motor mounting member 111.
  • the base end member 40 of the base end side link hub 32 is fixed to the output shaft 110 b of the hollow shaft motor 110.
  • the hollow shaft motor 110 has a wiring hole 112 that penetrates the motor body 110a and the output shaft 110b in the axial direction.
  • the base end member 40 of the link hub 32 on the base end side is provided with a wiring hole 113 coaxially with the wiring hole 112.
  • the dual-arm working device 120 includes two working device main bodies 1A and 1A and a cover 150 surrounding these two working device main bodies 1A and 1A.
  • the cover 150 is a contact prevention means for preventing an object from unnecessarily coming into contact with the work apparatus main bodies 1A and 1A.
  • the two work apparatus main bodies 1A and 1A are arranged side by side so as to be geometrically symmetrical to each other.
  • the tops 2 and 2 of the two work apparatus main bodies 1A and 1A are connected to each other at the ends of the horizontal portions 2a and 2a, thereby forming a gate-shaped base 2A as a whole.
  • the working apparatus main body 1A of the fourth embodiment shown in FIG. 18 is used. However, you may use the working device main body of other embodiment.
  • the work 7 to be worked can be passed under the work apparatus main bodies 1A and 1A.
  • the workpiece mounting table 6 can be a conveyor device that can transport the workpiece 7 in a direction orthogonal to the paper surface of FIG. 22, and the work device main bodies 1A and 1A can be installed on the conveyor line.
  • the movable range in the width direction of the work apparatus main bodies 1A and 1A can be limited to the width direction of the gantry 2A. Therefore, the occupation area of the work apparatus main bodies 1A and 1A can be small. Furthermore, since the movable range of the work apparatus main bodies 1A and 1A is limited, the possibility that an object will contact the work apparatus main bodies 1A and 1A is small.
  • FIG. 24A is a plan view of the linear motion units 3 and 3 of the two work apparatus main bodies 1A. These linear motion units 3 and 3 are similar to the linear motion unit 3 of each work apparatus main body 1A shown in FIG. 1, FIG. 10, and FIG. 18, respectively, of the first linear motion actuator 11 and the second linear motion actuator 12.
  • the motors 11b and 12b are disposed on the central axes of the linear actuators 11 and 12, respectively.
  • FIG. 24B is a plan view showing another example of the linear motion units 3 and 3.
  • the motors 11 b and 12 b of the first linear motion actuator 11 and the second linear motion actuator 12 are arranged at positions shifted from the central axes of the linear motion actuators 11 and 12. Yes.
  • the rotations of the motors 11b and 12b are transmitted to the drive units of the linear motion actuators 11 and 12 through power transmission means 121 such as a chain.
  • the linear motion unit 3 can be changed to the configuration shown in FIG. 24A or the configuration shown in FIG. Since the linear motion unit 3 and the rotation unit 4 are provided separately, such a configuration change is easy.
  • FIG. 25 is a perspective view of the cover 150.
  • the cover 150 includes four vertical surfaces (surface materials) 151, 152, 153, and 154 and one top surface material (surface material) 155 arranged so that two adjacent surface materials are orthogonal to each other. That is, the cover 150 has a rectangular parallelepiped shape opened downward. As shown in FIG. 22, the cover 150 surrounds the two work apparatus main bodies 1A and 1A. Thereby, the work area R1 which is a space where the work apparatus main bodies 1A and 1A are installed is separated from the non-work area R2 which is a space outside the work area R1.
  • Each of the four elevation members 151 to 154 (FIG. 25) and one top member 155 of the cover 150 is movable between two of the three linear motion actuators 11, 12, 13 (FIG. 22) of the work apparatus main body 1A. It is installed so as to be parallel to the direction. Specifically, the elevation members 151 and 153 are parallel to the movable directions (X-axis direction and Z-axis direction) of the first linear motion actuator 11 and the third linear motion actuator 13. The elevation members 152 and 154 are parallel to the movable directions (Y-axis direction and Z-axis direction) of the second linear actuator 12 and the third linear actuator 13. The top member 155 is parallel to the movable directions (X-axis direction and Y-axis direction) of the first linear actuator 11 and the second linear actuator 12.
  • An intrusionable portion 156 capable of allowing an object or an operator's hand to enter the work area R1 from the non-work area R2 is provided at the lower part of the front surface material 151.
  • the intruder 156 is a rectangular opening.
  • the height dimension H of the intrusionable portion 156 is smaller than the movable range (effective stroke sZ (FIG. 2A)) of the third linear actuator 13.
  • the width dimension W of the intrusionable portion 156 is smaller than the movable range (effective stroke sx + sx (FIG. 2B)) of the first linear motion actuator 11.
  • the intrusion enabling part 156 is provided with an intrusion detection sensor 157 for detecting that an object has entered from the intrusion enabling part 156 into the work area R1.
  • the intrusion detection sensor 157 is, for example, the same as the intrusion detection sensor 137 of the single-arm type work apparatus 1, and is connected to a control device (not shown).
  • the motors of the linear motion unit 3 and the rotation unit 4 are controlled by the control device in accordance with the detection signal of the intrusion detection sensor 157.
  • the work 7 can be carried out and carried into the work area R1 and the auxiliary work of the work apparatus main body 1A can be facilitated.
  • Each of the four upright materials 151 to 154 and the one top surface material 155 is parallel to two movable directions among the movable directions of the three linear motion actuators 11 to 13. For this reason, the internal space volume of the cover 150 can be made substantially equal to the volume of the region in which the movable part of the apparatus moves. Thereby, a compact configuration of the contact prevention means including the cover 150 can be realized. Further, the object and the work apparatus main body 1 ⁇ / b> A are not in contact with each other except for the intruder 156. Therefore, contact between the object and the work apparatus main body 1A can be reliably prevented.
  • the height dimension H of the intrusionable portion 146 is smaller than the movable range (effective stroke sZ) of the third linear actuator 13, and the width dimension W is the movable range (effective stroke sx + sx) of the first linear actuator 11. ) Is set smaller. For this reason, it is difficult for an object to enter between the cover 150 and the work apparatus main body 1A.
  • FIG. 26 shows another example of the cover.
  • the cover 150 is provided with two work loading / unloading portions 161 and 162 separately from the intrusionable portion 156.
  • the two work loading / unloading portions 161 and 162 are provided below the vertical surface materials 152 and 154 which are orthogonal to the front surface material 151 on which the intrusionable portion 156 is provided and face each other.
  • the two workpiece loading / unloading portions 161 and 162 are arranged with their positions in the front-rear direction (Y-axis direction) and the vertical direction (Z-axis direction) aligned.
  • a device for example, a conveyor device for loading and unloading the workpiece into the work area R1 (FIG. 22) in the cover 150 passes through the workpiece loading / unloading portions 161 and 162.
  • the work apparatus main bodies 1A and 1A (FIG. 22) can be installed on the line of the conveyor apparatus.
  • intrusion detection sensors 163 and 164 for the workpiece loading / unloading section that detect that an object has entered the work area R1 from the workpiece loading / unloading sections 161 and 162 in the workpiece loading / unloading sections 161 and 162.
  • Intrusion possible part 157 Intrusion detection sensors 161 and 162 for intrusion possible part.
  • Intrusion detecting sensor 170 for work carrying in and out part.

Abstract

作業装置(1)は、作業装置本体(1A)と接触防止手段(130)とを備える。作業装置本体(1A)は、3自由度の直動ユニット(3)と、3自由度の回転ユニット(4)とを備える。回転ユニット(4)の出力部に、エンドエフェクタ(5)が搭載されている。接触防止手段(130)は、作業装置本体(1A)が設置される作業領域(R1)と、作業領域(R1)の外側の非作業領域(R2)とを分離する。接触防止手段(130)は、作業領域(R1)に物が侵入可能な侵入可能部(136)と、侵入可能部(136)から作業領域(R1)に物が侵入したことを検知する侵入検知センサ(137)とを有する。

Description

作業装置および双腕型作業装置 関連出願
 この出願は、2016年6月15日出願の特願2016-118617の優先権を主張するものであり、その全体を参照により本願の一部をなすものとして引用する。
 この発明は、医療機器や産業機器等の高速、高精度の作業を必要とする機器、組立てのような細かい作業を必要とする機器、人と共存するロボット等に用いられる作業装置および双腕型作業装置に関する。
 特許文献1、2に、6自由度の多関節ロボット型の作業装置が提案されている。特許文献1は単腕型の構成であり、特許文献2は双腕型の構成である。これらの作業装置は、回転1自由度の機構を6つ組み合わせることで、全体で6自由度の構成としている。
特開2005-329521号公報 特許第4528312号公報
 特許文献1の作業装置は、すべて回転1自由度の機構の組合せで構成されているので、以下の課題1~6がある。
(課題1)先端に搭載するエンドエフェクタの姿勢を少し変更する場合や直線移動する場合、複数のモータを協調させて駆動する必要があり、細かい作業を高速に行うことができない。
(課題2)エンドエフェクタの姿勢を少し変更するだけの場合でも、手首関節(エンドエフェクタに近い関節)だけでなく腕(エンドエフェクタから離れた部位)の移動量が大きくなってしまう。そのため、作業装置の一部が周囲の物と接触し易い。接触を完全に避けるためには、大きな囲いを設ける必要があり、専有面積が広くなる。
(課題3)エンドエフェクタの1つの姿勢に対して複数の解が存在する場合があり、教示を行う際に各軸を動かしても先端がどのような方向に移動するかイメージし難い。このため、操作を行うには知識や経験が必要である。
(課題4)可動範囲が広いので、物との接触を想定して接触防止機能を充実させる必要がある。そのため、装置全体が高価になる。
(課題5)物との接触を避けるために、動作速度を落として作業を行ったり、動作範囲であっても能力以下に抑えて作業を行ったりする必要がある。そのため能力を十分に発揮できない。
(課題6)接触防止機能が充実していても、作業者は作業装置と接触することに対して抵抗があるので、人と作業装置が共存するのが難しい。
 特許文献2の作業装置も、すべて回転1自由度の機構の組合せで構成されているので、特許文献1の作業装置と同様の課題がある。加えて、双腕型である特許文献2の作業装置には、以下の課題7~8がある。
(課題7)各アームの可動範囲が広いので、アーム同士が干渉する領域も広い。アーム同士が接触しないように動作を行うには知識や経験が必要である。
(課題8)可動範囲が広いアームを2つ有するので、囲いを設ける場合にはさらに専有面積が広くなる。
 この発明の目的は、細かい作業を行うときの作業装置本体の動作量が小さくて済み、かつ作業装置本体に物が接触すること防止することができ、人が行う手作業に近い作業を自動で行うことが可能な作業装置を提供することである。
 この発明の他の目的は、細かい作業を行うときの作業装置本体の動作量が小さくて済み、かつ作業装置本体に物が接触すること防止することができ、人が両手を使って行うような作業が可能な双腕型作業装置を提供することである。
 この発明の作業装置は、エンドエフェクタを用いて作業を行う6自由度の作業装置であって、作業装置本体と、この作業装置本体に物が不要に接触することを防止する接触防止手段とを備えている。前記作業装置本体は、3つの直動アクチュエータを組み合わせた3自由度の直動ユニットと、1自由度以上の回転自由度を持つ複数の回転機構を組み合わせた3自由度の回転ユニットとを備えている。前記直動ユニットは基部を架台に固定して設置され、前記回転ユニットの基部が前記直動ユニットの出力部に固定して設置され、かつ前記回転ユニットの出力部に前記エンドエフェクタが搭載されている。前記接触防止手段は、前記作業装置本体が設置された空間である作業領域と、この作業領域の外側の空間である非作業領域とを分離する。前記接触防止手段は、前記非作業領域から前記作業領域に物が侵入可能な侵入可能部と、この侵入可能部から前記作業領域に物が侵入したことを検知する侵入検知センサとを有している。
 この構成の作業装置本体によると、エンドエフェクタで作業を行う際に、主に3自由度の直動ユニットによってエンドエフェクタの位置を決め、かつ3自由度の回転ユニットによってエンドエフェクタの姿勢を決める。直動ユニットの各直動アクチュエータおよび回転ユニットの各回転機構が、直交座標系で表現されるエンドエフェクタの位置、および極座標系で表現されるエンドエフェクタの姿勢にそれぞれ対応する。そのため、エンドエフェクタの位置、姿勢に対する各直動アクチュエータおよび各回転機構の動作をイメージし易く、姿勢教示作業等の動作パターンの設定が容易である。また、エンドエフェクタの位置、姿勢に対して、各直動アクチュエータの動作位置および各回転機構の動作角度が一意に決まる。つまり、特異点を持たない。これらのことから、熟練した知識や経験が無くても、作業装置の操作を行うことができる。
 他に、以下の作用・効果(効果1~4)が得られる。
(効果1)組立て作業のような細かい作業を行う場合、主に回転ユニットだけを動かして作業を行うことができる。そのため、直動ユニットの動作量が小さくて済むので、作業装置本体全体の稼働量を小さくできる。また、囲い等の接触防止手段を設置する必要のある面積を狭くできる。
(効果2)可動範囲に大きく影響する部分に直動アクチュエータを使用しているので、作業内容や周囲の環境に応じて、メカストッパやリミットセンサを用いて容易に動作範囲を制限できる。
(効果3)直動ユニットと回転ユニットを別々に設けているので、作業装置本体を仕様変更する場合にどちらかのユニットのみを変更することが可能である。これにより、仕様が異なる作業装置本体間での部品の共通化を図ることができる。
(効果4)直動アクチュエータによってエンドエフェクタの位置を決めるので、エンドエフェクタの直線動作を高速かつ正確に行うことができる。
 また、接触防止手段は以下のように作用(効果5~6)をする。
(効果5)接触防止手段に侵入可能部が設けられ、この侵入可能部以外からは物が作業領域に侵入することができない。そのため、物と作業装置本体とが接触できる範囲が限定される。
(効果6)侵入検知センサが設けられているので、物が作業領域に侵入したことを確実に検知できる。侵入検知センサが侵入を検知した場合、作業装置本体の動作を停止させるか、または減速させることができる。これにより、侵入検知センサによる侵入の検知がなく、物が作業装置本体に近づいていない状態では、作業装置本体を高速で動作でき、生産性が向上する。
 この発明の作業装置において、前記接触防止手段は、複数の面材を備え、前記複数の面材が前記作業装置本体を囲むカバーであり、前記複数の面材のそれぞれは、前記3つの直動アクチュエータの3つの可動方向のうち2つの可動方向と平行であるとよい。接触防止手段を上記形状のカバーとすると、カバーの内部空間の体積と作業装置本体の可動部が移動する領域の体積とをほぼ等しくできる。このため、接触防止手段を含めても、作業装置のコンパクトな構成を実現できる。侵入可能部から侵入する以外に物と作業装置本体とが接触することがないので、作業者が作業装置の近くにいても安心して作業できる。
 この発明の作業装置において、前記侵入可能部は、この侵入可能部が存在する平面に平行な2つの前記直動アクチュエータの可動方向の長さが、それぞれ前記2つの直動アクチュエータの可動範囲よりも小さくしてもよい。この構成であると、カバーと作業装置本体との間に物を入れることができないので、作業装置本体と物との接触を確実に防止できる。
 この発明の作業装置において、前記回転ユニットは前記複数の回転機構のうちの少なくとも1つが2自由度のリンク作動装置であってもよい。このリンク作動装置は、基端側のリンクハブに対し先端側のリンクハブが3組以上のリンク機構を介して姿勢を変更可能に連結されている。前記各リンク機構は、それぞれ前記基端側のリンクハブおよび前記先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とを有している。前記3組以上のリンク機構のうちの2組以上のリンク機構に、前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を任意に変更させる姿勢制御用アクチュエータが設けられた構成とするとよい。
 リンク作動装置は、基端側のリンクハブと、先端側のリンクハブと、3組以上のリンク機構とで、基端側のリンクハブに対し先端側のリンクハブが直交2軸周りに回転自在な2自由度機構を構成する。この2自由度機構は、コンパクトでありながら、先端側のリンクハブの可動範囲を広くとれる。例えば、基端側のリンクハブの中心軸と先端側のリンクハブの中心軸の折れ角の最大値は約±90°であり、基端側のリンクハブに対する先端側のリンクハブの旋回角を0°~360°の範囲に設定できる。また、折れ角90°、旋回角360°の作動範囲において特異点を持たないスムーズな動作が可能である。
 上記のように可動範囲が広くスムーズな動作が可能なリンク作動装置を回転ユニットに使用することで、高速で細かい作業を行うことができる。また、リンク作動装置はコンパクトな構成でありながら可動範囲が広いので、作業装置全体がコンパクトな構成になる。
 回転ユニットにリンク作動装置が含まれている場合、前記姿勢制御用アクチュエータはそれぞれがトルク検出手段を有し、このトルク検出手段の検出信号から前記回転ユニットに物が接触したことを検知する接触検出手段が設けられているとよい。リンク作動装置は、その可動範囲内において、特異点が無く全方向にスムーズに動ける構成である。そのため、先端側のリンクハブに対して異物が様々な方向から接触しても、姿勢制御用アクチュエータに確実にトルクが伝達される。これにより、トルク検出手段は様々な方向のトルクを検出可能であり、物が接触したことを接触検出手段が正確に検知することができる。このように姿勢制御用アクチュエータに設けられているトルク検出手段を接触の検知に利用することで、別の接触検出用のセンサを設ける必要がなくなる。その結果、作業装置本体のコンパクト化やコスト低減に繋がる。
 前記回転ユニットにリンク作動装置が含まれている場合、前記基端側のリンクハブと前記先端側のリンクハブとの間の内部空間に、物が侵入することを防止する侵入防止カバーが設けられているとよい。侵入防止カバーを設けることで、誤って物が前記内部空間に入り込むのを防ぐごとができる。
 この発明の作業装置において、前記回転ユニットに、物と接触したときの衝撃を軽減する緩衝材が設けられているとよい。この構成によれば、接触防止手段の侵入可能部からのみ作業領域に侵入可能である。したがって、物と接触する可能性のある作業装置本体の部分は、ほぼ回転ユニットだけに限定される。このため、回転ユニットのみに緩衝材が設けられていれば、物を保護することができる。これにより、接触防止用設備の設置が最小限で済み、装置全体が安価になる。
 この発明において、前記直動ユニットの前記各直動アクチュエータは、それぞれの進退部分からなるステージが、前記エンドエフェクタによって作業が行われる作業空間に対して外側を向くように配置されているとよい。各直動アクチュエータのステージを作業空間に対して外側を向くように配置することで、作業空間を広くするだけでなく、作業空間内に物が侵入した場合の接触の可能性が小さくなる。
 この発明において、前記侵入検知センサが前記作業領域に物が侵入したことを検知すると、前記作業装置本体の動作速度を低下させるか、または動作を停止させるように制御する制御装置が設けられているとよい。この構成によれば、侵入検知センサの検知結果に従って、制御装置により作業装置本体の動作が制御される。これにより、作業領域へのワークの搬出・搬入作業や、作業装置本体の補助作業を作業者が安心して行える。
 この発明において、前記接触防止手段に、前記作業領域と前記非作業領域間でワークを搬出・搬入するためのワーク搬出入部が1つ以上設けられ、かつ前記ワーク搬出入部から前記作業領域に物が侵入したことを検知するワーク搬出入部用の侵入検知センサが設けられているとよい。接触防止手段にワーク搬出入部が設けられていると、作業領域にワークを搬出・搬入する装置、例えばコンベア装置のライン上に作業装置本体を設置することができる。作業装置本体の補助作業は侵入可能部から手を入れて行うので、通常ではワーク搬出入部から作業領域に物が侵入することはない。よって、ワーク搬出入部用の侵入検知センサを設けることで、ワーク搬出入部から作業領域に物が侵入したという異常事態を検知できる。これにより、迅速な対応をとることが可能となる。
 この発明の双腕型作業装置は、互いに幾何学的に対称となるように2つ並べて配置され、それぞれがエンドエフェクタを用いて作業を行う6自由度の作業装置本体と、これら2つの作業装置本体に物が不要に接触することを防止する接触防止手段とを備えている。前記作業装置本体は、3つの直動アクチュエータを組み合わせた3自由度の直動ユニットと、1自由度以上の回転自由度を持つ複数の回転機構を組み合わせた3自由度の回転ユニットとを備えている。前記直動ユニットは基部を架台に固定して設置され、前記回転ユニットの基部が前記直動ユニットの出力部に固定して設置され、かつ前記回転ユニットの出力部に前記エンドエフェクタが搭載されている。前記接触防止手段は、前記2つの作業装置本体が設置された空間である作業領域と、この作業領域の外側の空間である非作業領域とを分離するものである。前記接触防止手段は、前記非作業領域から前記作業領域に物が侵入可能な侵入可能部と、この侵入可能部から前記作業領域に物が侵入したことを検知する侵入検知センサとを有している。
 この構成の双腕型作業装置の2つの作業装置本体も、上述の本発明の作業装置の作業装置本体と同様の効果を奏する。双腕型作業装置は、作業装置本体を2つ並べたことで、人が両手を使って行うような作業が可能である。これにより、人の代わりとなる作業、特に部品の組立てのような作業を行うことができる。
 請求の範囲および/または明細書および/または図面に開示された少なくとも2つの構成のどのような組合せも、この発明に含まれる。特に、請求の範囲の各請求項の2つ以上のどのような組合せも、この発明に含まれる。
 この発明は、添付の図面を参考にした以下の好適な実施形態の説明からより明瞭に理解されるであろう。しかしながら、実施形態および図面は単なる図示および説明のためのものであり、この発明の範囲を定めるために利用されるべきものではない。この発明の範囲は添付の請求の範囲によって定まる。添付図面において、複数の図面における同一の部品番号は、同一または相当部分を示す。
この発明の第1実施形態にかかる作業装置の一部を断面で表した正面図である。 同作業装置の作業装置本体の直動ユニットの正面図である。 同作業装置の作業装置本体の直動ユニットの平面図である。 同作業装置本体の回転ユニットの正面図である。 同作業装置本体の回転ユニットの平面図である。 同作業装置のカバーからなる接触防止手段の外観斜視図に制御系のブロック図を付加した図である。 同制御系の制御装置による制御の一例のフローチャートである。 同制御系の制御装置による制御の他の例のフローチャートである。 他のカバーからなる接触防止手段の外観斜視図に制御系のブロック図を付加した図である。 同制御系の制御装置による制御の一例のフローチャートである。 他の接触防止手段の外観斜視図に制御系のブロック図を付加した図である。 この発明の第2実施形態にかかる作業装置の一部を断面で表した正面図である。 同作業装置の作業装置本体の回転ユニットの一部を断面で表した正面図である。 同回転ユニットのリンク作動装置のパラレルリンク機構の斜視図である。 同パラレルリンク機構の異なる状態の斜視図である。 図11のXIV-XIV線に沿った断面図である。 同リンク作動装置の1つのリンク機構を直線で表現した図である。 同作業装置のコントローラの構成を示すブロック図である。 この発明の第3実施形態にかかる作業装置の作業装置本体の回転ユニットの一部を断面で表した正面図である。 この発明の第4実施形態にかかる作業装置の一部を断面で表した正面図である。 同作業装置の作業装置本体の回転ユニットの要部を示す正面図である。 図19のXX-XX線に沿った断面図である。 この発明の第5実施形態にかかる作業装置の作業装置本体の回転ユニットの要部を示す正面図である。 この発明の第6実施形態にかかる双腕型作業装置の一部を断面で表した正面図である。 同双腕型作業装置の作業装置本体の斜視図である。 同作業装置本体の直動ユニットの平面図である。 同作業装置本体の直動ユニットの別の形態の平面図である。 同双腕型作業装置のカバーからなる接触防止手段の外観斜視図である。 他のカバーからなる接触防止手段の外観斜視図である。
 以下、図面と共にこの発明の実施形態を説明する。
 図1~図5は、この発明の第1実施形態に係る作業装置を示す。図1に概略構成を示すように、この作業装置1は、作業装置本体1Aと、この作業装置本体1Aを囲むカバー130とを備える。カバー130は、作業装置本体1Aに物が不要に接触することを防止する接触防止手段である。
 作業装置本体1Aは、架台2と、この架台2に基部を固定して設置された直動ユニット3と、この直動ユニット3の出力部に基部を固定して設置された回転ユニット4と、この回転ユニット4の出力部に搭載されたエンドエフェクタ5とを備える。エンドエフェクタ5は、ワーク載置台6の上に載置されたワーク7に対して作業を行う。エンドエフェクタ5は、ワーク7に対して接触して作業を行うものであってもよく、非接触で作業を行うものであってもよい。エンドエフェクタ5によるワーク7に対する作業は、作業空間Sの範囲内で可能である。
 直動ユニット3は、3つの直動アクチュエータを組み合わせた3自由度の構成である。回転ユニット4は、1自由度以上の回転自由度を持つ複数の回転機構を組み合わせた3自由度の構成である。この実施形態では、1自由の回転機構を3つ組み合わせて回転ユニット4が構成されている。よって、この作業装置本体1Aは、全体で6自由度の構成である。
 図2Aおよび図2Bはそれぞれ、直動ユニット3の正面図および平面図である。直動ユニット3は、第1の直動アクチュエータ11と、第2の直動アクチュエータ12と、第3の直動アクチュエータ13とを備える。第1の直動アクチュエータ11は、架台2の水平部2aに設置され、ステージ11aが左右方向(X軸方向)に進退する(有効ストロークsX)。第2の直動アクチュエータ12は、第1の直動アクチュエータ11のステージ11aに設置され、ステージ12aが前後方向(Y軸方向)に進退する(有効ストロークsY)。
 第3の直動アクチュエータ13は、第2の直動アクチュエータ12のステージ12aに設置され、ステージ13aが上下方向(Z軸方向)に進退する(有効ストロークsZ)。各直動アクチュエータ11,12,13は、モータ11b,12b,13bを駆動源とする電動アクチュエータである。これらの各直動アクチュエータ11,12,13は、そのステージ11a,12a,13aが、前記作業空間S(図1)に対して外側を向くように配置されている。なお、架台2に固定される直動ユニット3の基部は、第1の直動アクチュエータ11のうち進退しない部分のことである。また、回転ユニット4の基部が固定される直動ユニット3の出力部は、第3の直動アクチュエータ13のステージ13aのことである。
 図3Aおよび図3Bはそれぞれ、回転ユニット4の正面図および平面図である。回転ユニット4は、直動ユニット3(図1)の出力部に固定された回転ユニット取付部材20と、この回転ユニット取付部材20に取り付けられた第1の回転機構21と、この第1の回転機構21の回転部分21aに取り付けられた第2の回転機構22と、この第2の回転機構22の回転部分22aに取り付けられた第3の回転機構23とを備える。第1~3の回転機構21,22,23の各回転軸心21b,22b,23bは、互いに直交している。これら各回転機構21,22,23の回転駆動源は、例えばモータ21c,22c,23cである。なお、直動ユニット3の出力部に固定される回転ユニット4の基部は、回転ユニット取付部材20のことである。また、エンドエフェクタ5が取り付けられる回転ユニット4の出力部は、第3の回転機構23の回転部分23aのことである。
 図2Aに示すように、直動ユニット3の出力部である第3の直動アクチュエータ13のステージ13aには、回転ユニット取付部材20を固定するためのねじ孔14,15および位置決め孔16が設けられている。ねじ孔14は、回転ユニット取付部材20が固定される箇所の中心部に1つだけ設けられている。ねじ孔15は、ねじ孔14を中心とする円周上に複数設けられている。位置決め孔16は、ねじ孔14を中心とする円周上で、ねじ孔15よりも半径が小さい円周上に、ねじ孔15と同数だけ設けられている。回転ユニット取付部材20には、ねじ孔14と2つのねじ孔15に対応する一直線に並ぶ3つのボルト挿通孔(図示せず)と、位置決め孔16に対応する2つの位置決め用突起(図示せず)とが設けられている。
 第3の直動アクチュエータ13の出力部であるステージ13aに、回転ユニット取付部材20を固定する手順を説明する。まず、回転ユニット取付部材20の2つの位置決め用突起を、ステージ13aの2つ位置決め孔16に係合させる。これにより、ステージ13aに対する回転ユニット取付部材20の正面視の角度が決まる。
 この状態で、図1に示すように、回転ユニット取付部材20の3つのボルト挿通孔のそれぞれに取付ボルト24を挿通し、ステージ13aの中央部のねじ孔14および2つのねじ孔15に螺合する。これにより、ステージ13aに回転ユニット取付部材20が固定される。回転ユニット取付部材20の位置決め用突起が係合するステージ13aの位置決め孔16を変更することで、直動ユニット3の出力部に対する回転ユニット4の基部の取付角度が変更可能である。
 この作業装置本体1Aの作用を説明する。
 この構成によると、主に3自由度の直動ユニット3によってエンドエフェクタ5の位置が決められ、かつ3自由度の回転ユニット4によってエンドエフェクタ5の姿勢が決められる。直動ユニット3の各直動アクチュエータ11,12,13が、直交座標系で表現されるエンドエフェクタ5の位置に対応する。また、回転ユニット4の各回転機構21,22,23が、極座標系で表現されるエンドエフェクタ5の姿勢に対応する。そのため、エンドエフェクタ5の位置に対する各直動アクチュエータ11,12,13の動作、および姿勢に対する各回転機構21,22,23の動作をイメージし易い。したがって、姿勢教示作業等の動作パターンの設定が容易である。
 また、エンドエフェクタ5の位置、姿勢に対して、各直動アクチュエータ11,12,13の動作位置および各回転機構21,22,23の動作角度が一意に決まる。つまり、特異点を持たない。これらのことから、熟練した知識や経験が無くても、作業装置本体1Aの操作を行うことができる。
 エンドエフェクタ5でワーク7に対して組立て作業のような細かい作業を行う場合、主に回転ユニット4だけを動かして作業を行うことができる。そのため、直動ユニット3の動作量が小さくて済み、作業装置本体1Aの全体の可動範囲を小さくできる。また、カバー130の設置面積を狭くできる。
 直動アクチュエータ11,12,13によってエンドエフェクタ5の位置を決めるので、エンドエフェクタ5の直線動作を高速かつ正確に行うことができる。また、可動範囲に大きく影響する部分に直動アクチュエータ11,12,13が使用されている。このため、作業内容や周囲の環境に応じて、メカストッパやリミットセンサを用いて容易に動作範囲を制限できる。
 直動ユニット3の各直動アクチュエータ11,12,13は、その進退部分からなるステージ11a,12a,13aが作業空間Sに対して外側を向くように配置されている。これにより、作業空間Sを広くすることができる。また、作業空間S内に物が侵入した場合に、物が作業装置本体1Aに接触する可能性を小さくできる。
 直動ユニット3と回転ユニット4を別々に設けているので、作業装置本体1Aを仕様変更する場合にどちらかのユニットのみを変更することが可能である。例えば、回転ユニット4を、図3に示す形態から、後述の図11に示す形態、図17に示す形態、図19に示す形態等に変更することができる。これにより、仕様が異なる作業装置本体1A間での部品の共通化を図ることができる。
 また、直動ユニット3の出力部である第3の直動アクチュエータ13のステージ13aに対して、回転ユニット4の基部である回転ユニット取付部材20が、取付ボルト24によって取付角度を変更可能に取り付けられている。このため、作業内容や周囲の環境に応じて装置構成を容易に変更することができる。
 以上に説明したように、この作業装置本体1Aは、細かい作業を行うときの作業装置本体1Aの全体の動作量が小さい。このため、物との接触を容易に回避することができる。したがって、人が行う手作業に近い作業を自動で行うことができる。また、段取り替え時間や調整時間の短縮が可能で、高速動作ができることから、生産性が向上する。
 図4に示すように、カバー130は、4つの立面材(面材)131,132,133,134と1つの天面材(面材)135とからなる。つまり、カバー130は、下面が開放された直方体の形状である。これら面材131~135は、隣り合う2つの面材が互いに直交するように配置されている。カバー130で作業装置本体1Aを囲むことで、図1に示す作業領域R1が、非作業領域R2(図1)から分離される。作業領域R1は、作業装置本体1Aが設置された空間である。非作業領域R2は、作業領域R1の外側の空間である。
 図4のカバー130では、4つの立面材131~134および1つの天面材135のそれぞれが、3つの直動アクチュエータ11,12,13(図1)の可動方向のうち2つの可動方向と平行となるように設置されている。具体的には、立面材131,133は、第1の直動アクチュエータ11および第3の直動アクチュエータ13の可動方向(X軸方向、Z軸方向)と平行である。また、立面材132,134は、第2の直動アクチュエータ12および第3の直動アクチュエータ13の可動方向(Y軸方向、Z軸方向)と平行である。さらに、天面材135は、第1の直動アクチュエータ11および第2の直動アクチュエータ13の可動方向(X軸方向、Y軸方向)と平行である。
 側面を向く立面材132の下部に、非作業領域R2から作業領域R1に物あるいは作業者Pの手を侵入させることが可能な侵入可能部136が設けられている。この侵入可能部136は長方形の開口である。侵入可能部136の高さ寸法Hは、第3の直動アクチュエータ13の可動範囲(有効ストロークsZ(図2))よりも小さい。また、侵入可能部136の幅寸法Wは、第2の直動アクチュエータ12の可動範囲(有効ストロークsY(図2))よりも小さい。
 カバー130に、侵入検知センサ137が設けられている。侵入検知センサ137は、侵入可能部136から作業領域R1に物が侵入したことを検知する。侵入検知センサ137は、例えば、侵入可能部136の上端と下端に発光部137aと受光部137bとを並べて配置した光学式センサである。侵入検知センサ137は、制御装置138に接続されている。制御装置138は、例えば、コンピュータによる数値制御式のものである。制御装置138は、侵入検知センサ137が侵入を検知すると、直動ユニット3のモータ11b,12b,13bおよび回転ユニット4のモータ21c,22c,23cの駆動を制限する。
 図5は、制御装置138による制御の一例を示すフローチャートである。初期状態では、動作指令がOFF、動作完了がONとなっている。動作指令および動作完了の信号は、作業者のスイッチ操作等により出力される。初期状態から動作指令がONになる(動作完了はOFFになる)と、作業装置本体1Aが動作を開始する(ステップ1)。
 作業装置本体1Aの動作中、動作完了がONであるか否かを判定する(ステップ2)。ONである場合、作業装置本体1Aの動作を停止して作業を終了する。ONでない場合、作業装置本体1Aの動作を継続する。
 また、作業装置本体1Aの動作中、侵入検知センサ137がONであるか否かを判定する(ステップ3)。ONである場合、作業装置本体1Aの動作を停止する(ステップ4)。ONでない場合、作業装置本体1Aの通常動作を継続する(ステップ5)。通常動作とは、指令された動作を指令された速度で行う動作のことである。侵入検知センサ137がONになって作業装置本体1Aの動作を停止させた場合でも、侵入検知センサ137がONでなくなれば、作業装置本体1Aの動作を再開する(ステップ5)。
 つまり、図5の制御によると、侵入可能部136から物が作業領域R1(図1)に侵入した場合、作業装置本体1Aの動作サイクルを停止させる。このように制御することで、作業領域R1へワーク7の搬出・搬入作業や、作業装置本体1の補助作業を行う場合、作業装置本体1Aが停止状態に維持される。このため、このような作業を安心して行える。また、作業装置本体1Aの動作中、物が侵入可能部136から作業領域R1に侵入した場合でも、侵入検知センサ137がONとなり(ステップ3)、作業装置本体1Aが自動的に停止する(ステップ4)。このため、物と作業装置本体1Aとの接触を防止できる。その後、作業領域R1から物を取り出せば、侵入検知センサ137がOFFになり(ステップ3)、作業装置本体1Aが動作を再開する(ステップ5)。
 図6は、制御装置138による制御の他の例を示すフローチャートである。この制御は、侵入検知センサ137がONである場合に(ステップ3)、図5のように作業装置本体1Aの動作を停止させるのではなく、作業装置本体1Aの動作を減速させる(ステップ4)。作業装置本体1Aの動作を減速した後、侵入検知センサ137がONでなくなれば、作業装置本体1Aを通常動作を戻す(ステップ5)。ただし、減速動作中に、動作完了信号がONになれば(ステップ2でYES)作動装置本体1Aの動作を停止し、作業を終了する。他の制御は、図5と同じである。
 つまり、図6の制御によると、侵入可能部136から物が作業領域R1(図1)に侵入すると、作業装置本体1Aの動作を減速させる。このように制御することにより、図5の制御と同様に、作業領域R1へのワーク7の搬出・搬入作業や、作業装置本体1の補助作業を安心して行える。
 図4のカバー130では、4つの立面材131,132,133,134および1つの天面材135のそれぞれが、3つの直動アクチュエータ11,12,13の可動方向のうち2つの可動方向と平行である。そのため、カバー130の内部空間体積と作業装置本体1Aの可動部が移動する領域の体積とをほぼ等しくできる。したがって、カバー130を含めても、作業装置1のコンパクトな構成を実現できる。また、侵入可能部136以外で物と作業装置本体1とが接触することがないので、作業者が作業装置の近くにいても安心して作業できる。
 本実施形態では、3つの直動アクチュエータ11~13の可動方向が互いに直交し、カバー130が、隣り合う2つの面材が互いに直交するように配置された4つの立面材131~134と1つの天面材135とを有している。しかしながら、3つの直動アクチュエータ11~13およびカバー130の構成は、これに限定されない。すなわち、3つの直動アクチュエータ11~13の可動方向は、互いに直交していなくてもよい。この場合、4つの立面材131~134および1つの天面材135のそれぞれは、3つの直動アクチュエータ11~13の可動方向のうち2つの可動方向と平行であり、作業装置本体部1Aを囲うように配置されていればよい。このような構成であっても、カバー130の内部空間体積と作業装置本体1Aの可動部が移動する領域の体積とをほぼ等しくできる。したがって、作業装置1のコンパクトな構成を実現できる。
 さらに、侵入可能部136の高さ寸法Hが、第3の直動アクチュエータ13の可動範囲(有効ストロークsZ)よりも小さく、かつ幅寸法Wが第2の直動アクチュエータ12の可動範囲(有効ストロークsY)よりも小さく設定されている。そのため、カバー130と作業装置本体1との間に、物が侵入することがない。
 図7は、カバーからなる接触防止手段の他の例を示す。このカバー130は、侵入可能部136とは別に、2つのワーク搬出入部141,142が設けられている。2つのワーク搬出入部141,142は、侵入可能部136が設けられる立面材132と直交し互いに対向する立面材131,133の下部にそれぞれ設けられている。ワーク搬出入部141,142は、左右方向(X軸方向)および上下方向(Z軸方向)の位置を揃えて配置されている。
 ワーク搬出入部141,142が設けられていると、カバー130内の作業領域R1(図1)にワークを搬出・搬入させる装置(例えばコンベア装置)を、ワーク搬出入部141,142を貫通するように設置できる。このコンベア装置のライン上に、作業装置本体1A(図1)を設置することができる。
 ワーク搬出入部141,142に、ワーク搬出入部141,142から作業領域R1に物が侵入したことを検知するワーク搬出入部用の侵入検知センサ143,144を設けるのが望ましい。これらワーク搬出入部用の侵入検知センサ143,144は、例えば、発光部143a,144aと受光部143b,144bとを有する光学式センサである。ワーク搬出入部用の侵入検知センサ143,144も、侵入可能部用の侵入検センサ137と同様に、制御装置138に接続されている。
 図8は、制御装置138の制御の一例を示すフローチャートである。この制御は、図6に示すステップ2とステップ3の間に、ワーク搬出入部用の侵入検知センサ143,144がONであるか否かを判定する過程(ステップ3)が追加されている。このステップ3で、ワーク搬出入部用の侵入検知センサ143,144の少なくとも一方がONである場合、動作完了をONにして(ステップ4)、作業を終了する。ワーク搬出入部用の侵入検知センサ143,144がいずれもOFFである場合、侵入可能部用の侵入検知センサ137がONであるか否かを判定する(ステップ5)。図6の制御と同様に、侵入検知センサ137がONである場合、作業装置本体1Aの動作を減速(ステップ6)する。侵入検知センサ137がOFFである場合、作業装置本体1Aの通常動作を継続する(ステップ5)。
 図8の制御によると、侵入可能部136から物が作業領域R1(図1)に侵入した場合、作業装置本体1Aの動作を減速する。さらに、ワーク搬出入部141,142から物が作業領域R1に侵入した場合、作業装置本体1Aの動作サイクルを停止する。作業装置本体1Aの補助作業は、侵入可能部136から手を入れて行う。したがって、通常、ワーク搬出入部141,142から作業領域R1に物が侵入することはない。よって、ワーク搬出入部用の侵入検知センサ143,144を設けることで、ワーク搬出入部141,142から作業領域R1に物が侵入したという異常事態を検知できる。これにより、作業装置本体1Aの動作サイクルを停止するという迅速な対応をとることが可能である。
 図9は、他の接触防止手段の構成を示す。この接触防止手段170は、作業領域R1を完全に囲むカバーではなく、作業領域R1と非作業領域R2の境界部が開放した形態である。すなわち、複数本の棒材を組み合わせて直方体状のフレーム171を構成し、このフレーム171の内側に作業領域R1を形成している。フレーム171は、平面視で長方形の角部に立てられた4本の縦材171aと、隣り合う縦材171aの上端間に架け渡された4本の水平材171bとを有している。作業者から見て正面側となるフレーム171の立面に、立面材132が取り付けられている。この立面材132の下部に、作業領域R1に物が侵入することが可能な侵入可能部136が設けられている。
 侵入可能部136に、侵入可能部136から作業領域R1に物が侵入したことを検知する侵入検知センサ137が設けられている。また、フレーム171の4本の水平材171bに、フレーム171の開放部分から作業領域R1に物が侵入したことを検知する侵入検知センサ172,173が設けられている。3つの侵入検知センサ172は、フレーム171の開放した3面の立面からの侵入をそれぞれ検知する。侵入検知センサ173は、フレーム171の開放した天面からの侵入を検知する。これら開放部分用の侵入検知センサ172,173は、例えば、赤外線カメラである。侵入可能部用の侵入検知センサ137、および開放部分用の侵入検知センサ172,173は、制御装置138に接続されており、制御装置138により、図8に示す制御が行われる。
 この接触防止手段170の構成によると、作業領域R1と非作業領域R2とが密閉されていないので、フレーム171の開放部分から物が作業領域R1に侵入することを物理的には規制できない。しかしながら、侵入検知センサ137,172,173の検知に基づいて、制御装置138により直動ユニット3のモータ11b,12b,13bおよび回転ユニット4のモータ21c,22c,23cを制御することで、作業領域R1へのワーク7の搬出・搬入作業や作業装置本体1の補助作業を確実に行うことができる。
 図10~図16はこの発明の第2実施形態を示す。図10に示すように、この作業装置1の作業装置本体1Aは、回転ユニット4が、1自由度の回転機構である第1の回転機構21と、2自由度のリンク作動装置29からなる第2の回転機構とで構成されている。つまり、図1の第1実施形態における第2の回転機構22および第3の回転機構23がリンク作動装置29に置き換わっている。これ以外は図1の第1実施形態と同じである。
 図11に示すように、リンク作動装置29は、パラレルリンク機構30と、このパラレルリンク機構30を作動させる姿勢制御用アクチュエータ31とを有している。図12および図13は、パラレルリンク機構30の斜視図である。図12と図13は、パラレルリンク機構30の異なる状態を示している。これら図11~図13に示すように、パラレルリンク機構30では、基端側のリンクハブ32に対し先端側のリンクハブ33を3組のリンク機構34を介して姿勢変更可能に連結されている。なお、図11は、1組のリンク機構34のみを示している。リンク機構34の数は、4組以上であっても良い。
 各リンク機構34は、基端側の端部リンク部材35、先端側の端部リンク部材36、および中央リンク部材37で構成されている。つまり、各リンク機構34は、4つの回転対偶からなる4節連鎖のリンク機構を構成している。基端側および先端側の端部リンク部材35,36はL字状をなしている。基端側の端部リンク部材35一端は、基端側のリンクハブ32に回転自在に連結されている。先端側の端部リンク部材36一端は、先端側のリンクハブ33に回転自在に連結されている。中央リンク部材37の両端に、基端側および先端側の端部リンク部材35,36の他端がそれぞれ回転自在に連結されている。
 パラレルリンク機構30は、2つの球面リンク機構を組み合わせた構造である。基端側のリンクハブ32と基端側の端部リンク部材35の各回転対偶、および基端側の端部リンク部材35と中央リンク部材37の各回転対偶の中心軸が、基端側において基端側の球面リンク中心PA(図11)で交差している。同様に、先端側のリンクハブ33と先端側の端部リンク部材36の各回転対偶、および先端側の端部リンク部材36と中央リンク部材37の各回転対偶の中心軸が、先端側において先端側の球面リンク中心PB(図11)で交差している。
 基端側において、基端側のリンクハブ32と基端側の端部リンク部材35の各回転対偶から基端側の球面リンク中心PAまでの距離は同じである。また、基端側の端部リンク部材35と中央リンク部材37の各回転対偶から基端側の球面リンク中心PAまでの距離も同じである。同様に、先端側において、先端側のリンクハブ33と先端側の端部リンク部材36の各回転対偶から先端側の球面リンク中心PBまでの距離は同じである。また、先端側の端部リンク部材36と中央リンク部材37の各回転対偶から先端側の球面リンク中心PBまでの距離も同じである。基端側および先端側の端部リンク部材35,36と中央リンク部材37との各回転対偶の中心軸は、ある交差角γ(図11)を持っていてもよいし、平行であってもよい。
 図14は、図11のXIV-XIV線に沿った断面図である。図14に、基端側のリンクハブ32と基端側の端部リンク部材35の回転対偶の中心軸O1と、中央リンク部材37と基端側の端部リンク部材35の回転対偶の中心軸O2と、基端側の球面リンク中心PAとの関係が示されている。つまり、中心軸O1と中心軸O2とが交差する点が球面リンク中心PAである。先端側のリンクハブ33および先端側の端部リンク部材36の形状ならびに位置関係も図14と同様である。図14では、リンクハブ32(33)と端部リンク部材35(36)との回転対偶の中心軸O1と、端部リンク部材35(36)と中央リンク部材37との回転対偶の中心軸O2とが成す角度αは90°である。ただし、角度αは90°以外であってもよい。
 3組のリンク機構34は、幾何学的に同一形状をなす。幾何学的に同一形状とは、図15に示すように、各リンク部材35,36,37を直線で表現した幾何学モデル、すなわち各回転対偶と、これら回転対偶間を結ぶ直線とで表現したモデルが、中央リンク部材37の中央部に対する基端側部分と先端側部分が対称を成す形状であることをいう。図15は、一組のリンク機構34を直線で表現した図である。この実施形態のパラレルリンク機構30は回転対称タイプである。つまり、基端側のリンクハブ32および基端側の端部リンク部材35と、先端側のリンクハブ33および先端側の端部リンク部材36との位置関係が、中央リンク部材37の中心線Cに対して回転対称となる。中央リンク部材37の中央部は、共通の軌道円D上に位置している。
 基端側のリンクハブ32と先端側のリンクハブ33と3組のリンク機構34とで、基端側のリンクハブ32に対し先端側のリンクハブ33が直交2軸回りに回転自在な2自由度機構が構成されている。言い換えると、基端側のリンクハブ32に対して先端側のリンクハブ33を、回転が2自由度で姿勢変更自在な機構である。この2自由度機構は、コンパクトでありながら、基端側のリンクハブ32に対する先端側のリンクハブ33の可動範囲を広くとれる。
 例えば、基端側の球面リンク中心PAを通り、基端側のリンクハブ32と基端側の端部リンク部材35の回転対偶の中心軸O1(図14)と直角に交わる直線を基端側のリンクハブ32の中心軸QAとする。同様に、先端側の球面リンク中心PBを通り、先端側のリンクハブ33と先端側の端部リンク部材36の回転対偶の中心軸O1(図14)と直角に交わる直線を先端側のリンクハブ33の中心軸QBとする。この場合、基端側のリンクハブ32の中心軸QAと先端側のリンクハブ33の中心軸QBとの折れ角θ(図15)の最大値を約±90°とすることができる。また、基端側のリンクハブ32に対する先端側のリンクハブ33の旋回角φ(図15)を0°~360°の範囲に設定できる。
 折れ角θは、基端側のリンクハブ32の中心軸QAに対して先端側のリンクハブ33の中心軸QBが傾斜した垂直角度のことである。旋回角φは、基端側のリンクハブ32の中心軸QAに対して先端側のリンクハブ33の中心軸QBが傾斜した水平角度のことである。
 基端側のリンクハブ32に対する先端側のリンクハブ33の姿勢変更は、基端側のリンクハブ32の中心軸QAと先端側のリンクハブ33の中心軸QBとの交点Oを回転中心として行われる。図12は、基端側のリンクハブ32の中心軸QAと先端側のリンクハブ33の中心軸QBが同一線上にある状態を示す。図13は、基端側のリンクハブ32の中心軸QAに対して先端側のリンクハブ33の中心軸QBが、所定の作動角をとった状態を示す。姿勢が変化しても、基端側と先端側の球面リンク中心PA,PB間の距離L(図15)は変化しない。
 各リンク機構34が次の条件1~5を満たす場合、幾何学的対称性から基端側のリンクハブ32および基端側の端部リンク部材35と、先端側のリンクハブ33および先端側の端部リンク部材36とは同じに動く。よって、パラレルリンク機構30は、基端側から先端側へ回転伝達を行う場合、基端側と先端側は同じ回転角になって等速で回転する等速自在継手として機能する。
 条件1:各リンク機構34におけるリンクハブ32,33と端部リンク部材35,36との回転対偶の中心軸O1の角度および長さが互いに等しい。
 条件2:リンクハブ32,33と端部リンク部材35,36との回転対偶の中心軸O1および端部リンク部材35,36と中央リンク部材37との回転対偶の中心軸O2が、基端側および先端側において球面リンク中心PA,PBで交差する。
 条件3:基端側の端部リンク部材35と先端側の端部リンク部材36の幾何学的形状が
等しい。
 条件4:中央リンク部材37における基端側部分と先端側部分の幾何学的形状が等しい。
 条件5:中央リンク部材37の対称面に対して、中央リンク部材37と端部リンク部材35,36との角度位置関係が基端側と先端側とで同じである。
 図11~図13に示すように、基端側のリンクハブ32は、基端部材40と、この基端部材40と一体に設けられた3つの回転軸連結部材41とを有している。図14に示すように、基端部材40は中央部に円形の貫通孔40aを有している。この貫通孔40aの周囲に、3つの回転軸連結部材41が周方向に等間隔で配置されている。貫通孔40aの中心は、基端側のリンクハブ32の中心軸QA(図11)上に位置する。各回転軸連結部材41には、回転軸42が回転自在に連結されている。回転軸42の軸心は、基端側のリンクハブ32の中心軸QAと交差する。回転軸42は、頭部42aとねじ部42bとを有している。この回転軸42に、基端側の端部リンク部材35の一端が連結されている。
 図14に示すように、回転軸42は、2つの軸受43を介して回転軸連結部材41に回転自在に支持されている。軸受43は、例えば深溝玉軸受、アンギュラ玉軸受等の玉軸受である。これらの軸受43は、回転軸連結部材41に設けられた内径孔44に嵌合状態で設置され、圧入、接着、加締め等の方法で固定されている。他の回転対偶部に設けられる軸受の種類および設置方法も同様である。
 回転軸42に、基端側の端部リンク部材35の一端と後述の扇形のかさ歯車45とが結合されている。基端側の端部リンク部材35とかさ歯車45は、回転軸42と一体に回転する。詳しくは、基端側の端部リンク部材35の一端に、切欠き部46が形成されている。この切欠き部46の径方向内側および外側に、回転軸支持部47,48が形成されている。この回転軸支持部47,48の間に、回転軸連結部材41が配置されている。
 かさ歯車45は、内側の回転軸支持部47の内側面に当接して配置されている。回転軸42を径方向内側から、かさ歯車45に形成された貫通孔、内側の回転軸支持部47に形成された貫通孔、軸受43の内輪、外側の回転軸支持部48に形成された貫通孔の順に挿通する。さらに、回転軸42のねじ部42bに、ナット50を螺着する。これにより、回転軸42の頭部42aとナット50とで、かさ歯車45、内外の回転軸支持部47,48および軸受43の内輪がそれぞれ挟持され、結合される。本実施形態では、内外の回転軸支持部47,48と軸受43との間にスペーサ51,52が介在されている。これにより、ナット50の螺着時に、軸受43に予圧が付与される。
 基端側の端部リンク部材35の他端に、回転軸55が結合されている。回転軸55は、頭部55aとねじ部55bとを有している。回転軸55は、2つの軸受53を介して中央リンク部材37の一端に回転自在に連結されている。詳しくは、基端側の端部リンク部材35の他端に、切欠き部56が形成されている。この切欠き部56の径方向内側および外側に、内外の回転軸支持部57,58が形成されている。この回転軸支持部57,58の間に、中央リンク部材37の一端が配置されている。
 回転軸55を径方向外側から、外側の回転軸支持部58に形成された貫通孔、軸受53の内輪、内側の回転軸支持部57に形成された貫通孔の順に挿通する。さらに、回転軸55のねじ部55bに、ナット60を螺着する。これにより、回転軸55の頭部55aとナット60とで、内外の回転軸支持部57,58および軸受53の内輪が挟持され、互いに結合される。本実施形態では、内外の回転軸支持部57,58と軸受53との間に、スペーサ61,62が介在されている。これにより、ナット60の螺着時に、軸受53に予圧が付与される。
 図12、図13に示すように、先端側のリンクハブ33は、先端部材70と、この先端部材70の内面に設けられた3つの回転軸連結部材71とを有している。3つの回転軸連結部材71は、先端部材70の内面に周方向に等間隔で設けられている。回転軸連結部材71が配置される円周の中心は、先端側のリンクハブ33の中心軸QB上に位置する。回転軸連結部材71に、回転軸73が回転自在に連結されている。回転軸73の軸心は、リンクハブ中心軸QBと交差する。
 先端側のリンクハブ33の回転軸73に、先端側の端部リンク部材36の一端が連結されている。先端側の端部リンク部材36の他端に、回転軸75が連結されている。回転軸75は、中央リンク部材37の他端に回転自在に連結されている。先端側のリンクハブ33の回転軸73は、前述の回転軸42と同様に、2つの軸受(図示せず)を介して回転軸連結部材71の他端に回転自在に連結されている。一方、中央リンク部材37の回転軸75は、前述の回転軸55と同様に、2つの軸受(図示せず)を介して中央リンク部材37の他端に回転自在に連結されている。
 図11に示すパラレルリンク機構30では、基端部材40とベース部材80が、複数本のシャフト81を介して連結されている。これにより、パラレルリンク機構30が、第1の回転機構21に設置されている。基端側のリンクハブ32の中心軸QAと、第1の回転機構21の回転軸心21bとは同一線上に位置する。ベース部材80は、第1の回転機構21の回転部分21aに固定されている。
 リンク作動装置29の周囲に、リンク作動装置29を覆う筒状の保護カバー82が設けられている。保護カバー82は、ゴム等の弾性材からなる。保護カバー82は、ベース部材80の外周縁と、基端部材40の外周縁と、先端部材70の外周縁とに取り付けられている。基端側のリンクハブ32に対する先端側のリンクハブ33の姿勢変更に応じて、保護カバー82が変形可能である。保護カバー82は、基端側のリンクハブ32と先端側のリンクハブ33との間の内部空間83、および基端側のリンクハブ32とベース部材80との間の遮蔽空間84に物が侵入することを防止する侵入防止カバーである。
 また、第1の回転機構21の固定部分の外周面に、保護カバー85が貼り付け状態で設けられている。保護カバー85は、ゴムのような衝撃吸収性を有する材料からなる。保護カバー85は、物が接触したときの衝撃を軽減する緩衝材として機能する。
 パラレルリンク機構30は、姿勢制御用アクチュエータ31により作動される。姿勢制御用アクチュエータ31は、遮蔽空間84に配置され、基端部材40に設置されている。姿勢制御用アクチュエータ31の数は、リンク機構34と同数の3個である。姿勢制御用アクチュエータ31は、例えば、モータのようなロータリアクチュエータからなる。姿勢制御用アクチュエータ31の回転出力軸31aに、歯車76が取り付けられている。また、基端側のリンクハブ32の回転軸42に、前述の扇形のかさ歯車45が取り付けられている。これらのかさ歯車76,45が互いに噛み合っている。本実施形態では、かさ歯車76と扇形のかさ歯車45とで軸直交型の減速機77が構成されている。ただし、かさ歯車以外の他の機構(例えばウォーム機構)を用いて軸直交型の減速機を構成してもよい。
 この実施形態では、リンク機構34と同数の姿勢制御用アクチュエータ31が設けられている。しかしながら、3組のリンク機構34のうち少なくとも2組に姿勢制御用アクチュエータ31が設けられていればよい。これにより、基端側のリンクハブ32に対する先端側のリンクハブ33の姿勢を確定することができる。
 リンク作動装置29は、姿勢制御用アクチュエータ31を回転駆動することで、パラレルリンク機構30を作動させる。詳しくは、姿勢制御用アクチュエータ31を回転駆動すると、その回転が軸直交型の減速機77を介して回転軸42に伝達される。これにより、基端側のリンクハブ32に対する基端側の端部リンク部材35の角度が変更する。その結果、基端側のリンクハブ32に対する先端側のリンクハブ33の位置および姿勢が決まる。基端側のリンクハブ32の中心軸QAと第1の回転機構21の回転軸心21bとが、同一線上に位置するので、座標計算が容易である。
 また、基端側のリンクハブ32の中心軸QAと第1の回転機構21の回転軸心21bとが同一線上に位置すると、作業者が作業装置本体1Aの動作をイメージし易い。このため、操作が容易である。例えば、直動ユニット3で決定される3自由度の位置を固定し、かつ回転ユニット4で決定される3自由度の角度のうち2自由度の角度を固定し、残りの1自由度の角度(例えば、前記先端側のリンクハブ33の中心軸QB周りの角度)だけを変更する。このように、エンドエフェクト5の姿勢を変えながら作業を容易に行うことができる。
 上述のように、リンク作動装置31は可動範囲が広くスムーズな動作が可能である。したがって、回転ユニット4にリンク作動装置29が含まれていると、高速で細かい作業を行うことができる。また、リンク作動装置31はコンパクトな構成でありながら可動範囲が広い。このため、作業装置本体1Aの全体がコンパクトな構成になる。
 この実施形態では、リンク作動装置29の基端側に第1の回転機構21が配置され、先端側のリンクハブ33にエンドエフェクタ5が搭載されている。これにより、リンク作動装置29の負荷を軽減できるので、リンク作動装置29のコンパクト化、軽量化を実現できる。リンク作動装置29のパラレルリンク機構30は等速自在継手の構成である。したがって、前述のように、1自由度の角度だけを変更してエンドエフェクト5の姿勢を変えながら、容易に作業を行うことができる。ただし、姿勢制御用アクチュエータ31に接続するケーブルについて考慮する必要があるので、回転角は制限される。
 図16は、各姿勢制御用アクチュエータ31を制御するコントローラ200の構成を示す。コントローラ200は、姿勢制御手段201と接触検出手段202とを有する。
 姿勢制御手段201は、上位の制御手段(図示せず)または手入力の操作手段(図示せず)から与えられた姿勢変更の指令に従って、各姿勢制御用アクチュエータ31に指令を出力する。
 接触検出手段202は、各姿勢制御用アクチュエータ31に設けられたトルク検出手段203の検出信号に基づいて、回転ユニット4に物が接触したことを検知する。具体的には、トルク検出手段203の検出信号から、先端側のリンクハブ33に作用する荷重を推定する。その荷重の大きさから、回転ユニット4に物が接触したか否かを判定する。先端側のリンクハブ33の作用荷重の推定は、必ずしも数値として推定しなくてもよく、例えば接触が生じたか否かの判定を行える程度の段階的な推定であってもよい。トルク検出手段203は、例えば、各姿勢制御用アクチュエータ31に流れる電流を検出する電流センサである。
 リンク作動装置29は、その可動範囲内において、特異点が無く全方向にスムーズに動ける構成である。このため、先端側のリンクハブ33に対して異物が様々な方向から接触しても、姿勢制御用アクチュエータ31に確実にトルクが伝達される。これにより、トルク検出手段203は、様々な方向のトルクを検出可能である。したがって、物が接触したことを、接触検出手段202が正確に検知することができる。
 接触検出手段202が接触を検知した場合、姿勢制御手段201により姿勢制御用アクチュエータ31への出力を停止する。これにより、回転ユニット4が保護される。このように、姿勢制御用アクチュエータ31のトルク検出手段203を接触の検知に利用することで、別の接触検出用のセンサを設ける必要がなくなる。その結果、装置のコンパクト化やコスト低減に繋がる。
 リンク作動装置29の周囲に、侵入防止カバーとしての保護カバー82が設けられている。このため、物が基端側のリンクハブ32と先端側のリンクハブ33との間の内部空間83に入り込むことを防ぐごとができる。また、第1の回転機構21の外周面に、緩衝材としての保護カバー85が設けられている。このため、物が第1の回転機構21に接触したとしても、その衝撃が軽減される。
 カバー130内の作業領域R1には侵入可能部136からのみ侵入可能である。したがって、物と接触する可能性のある作業装置本体1Aの部分は、ほぼ回転ユニット4だけに限定される。このため、回転ユニット4のみに緩衝材が設けられていれば、装置を保護することができる。これにより、接触防止用の設備の設置が最小限で済み、装置全体が安価になる。
 図17は、第3実施形態にかかる作業装置の作業装置本体の回転ユニット4を示す。第3実施形態では、第1の回転機構21とリンク作動装置29の並びを図11の構成と逆にしている。この回転ユニット4では、リンク作動装置29の先端側のリンクハブ33の中心軸QBと、第1の回転機構21の回転軸心21bとが同一線上に位置している。第3実施形態では、リンク作動装置29の周囲に、侵入防止カバーとしての保護カバー82が設けられている。第3実施形態では、第1の回転機構21の外周面に、緩衝材としての保護カバーは設けられていない。ただし、第1の回転機構21の外周面に、緩衝材としての保護カバーを設けてもよい。その他の構造は、図11の第2実施形態と同じである。
 第3実施形態の回転ユニット4の構成であると、姿勢制御用アクチュエータ31に接続されるケーブルの配線が容易であり、回転角の制限を受け難い。反面、リンク作動装置29の負荷が増大するという欠点がある。その他は、図11の第2実施形態と同じ作用、効果が得られる。
 図18~図20は、この発明の第4実施形態を示す。図18に示すように、この作業装置1も、図10の第2実施形態と同様に、作業装置本体1Aの回転ユニット4が、1自由度の回転機構である第1の回転機構21と、2自由度の回転機構であるリンク作動装置29とで構成されている。第4実施形態の作業装置1は、リンク作動装置29の各姿勢制御用アクチュエータ31の中心部に第1の回転機構21が配置されている点で、図10の第2実施形態と異なっている。
 図19に示すように、第1の回転機構21は、ベース部材80に固定された固定部分90と、リンク作動装置29の基端部材40に固定された回転部分91と、固定部分90に回転部分91を回転自在に支持する2つの軸受92と、固定部分90に設置された駆動源であるモータ93と、このモータ93の回転を回転部分91に伝達する一対の平歯車94,95とを備える。
 ベース部材80は、回転ユニット取付部材20に固定されている。固定部分90は、ベース部材80に固定された第1取付部材96と、この第1取付部材96に固定された第2取付部材97とを有している。第2取付部材97は、第1取付部材96に固定される底部97aと、底部97aの外周縁から上方に延びる筒状部97bとを有している。回転部分91は、その回転軸心91aが基端側のリンクハブ32の中心軸QAと同軸上に位置するように、基端側のリンクハブ32の基端部材40に固定されている。回転部分91の下端にねじ部が設けられており、このねじ部にナット98が螺合されている。2つの軸受92は、第2取付部材97の筒状部97bの内周に配置されている。
 第1取付部材96は、水平断面形状がほぼU字形状である。このU字形の第1取付部材96の凹部96aに、モータ93が配置されている。モータ93は、第2取付部材97の底部97aに固定されている。モータ93の出力軸93aは、第2取付部材97の底部97aを貫通して上方へ延びている。モータ93の出力軸93aの上端に、駆動側の平歯車94が取り付けられている。駆動側の平歯車94は、従動側の平歯車95と噛み合っている。従動側の平歯車95は、回転部分91に取り付けられている。従動側の平歯車95は、回転部分91の外周に嵌合している。従動側の平歯車95は、ナット98により、回転部分91に固定されている。
 第2取付部材97の底部97a、回転部分91および基端部材40に、配線用孔100,101,102がそれぞれ設けられている。各配線用孔100,101,102は、回転部分91の回転軸心91aに沿って貫通されている。基端部材40の外周縁と先端部材(図示せず)の外周縁に、弾性材からなる筒状の保護カバー82が取り付けられている。この保護カバー82は、基端側のリンクハブ32と先端側のリンクハブ(図示せず)との間の内部空間83、および基端側のリンクハブ32とベース部材80との間の遮蔽空間84に物が侵入することを防止する侵入防止カバーである。保護カバー82はベース部材80の外周縁近傍にかけて延びているが、ベース部材80に結合されていない。
 図11の第2実施形態と同様に、リンク作動装置29の3つの姿勢制御用アクチュエータ31は、基端部材40における仮想の円周上に配置されている。姿勢制御用アクチュエータ31の回転出力軸31aの回転駆動力は、軸直交型の減速機77を介してリンク機構34に伝達されている。このように姿勢制御用アクチュエータ31が配置されると、第4実施形態のように、各姿勢制御用アクチュータ31の並びの中心部に第1の回転機構21を配置することができる。これにより、回転ユニット4がコンパクトな構成になる。
 モータ93を駆動すると、回転部分91と一体にリンク作動装置29の全体および保護カバー82が回転する。配線用孔100,101,102にケーブルを通すことで、リンク機構34と干渉することなく、リンク作動装置29の内部空間83の側からエンドエフェクタ5に配線を行うことができる。このため、姿勢制御用アクチュエータ31に接続されるケーブルの配線に関する制約が少なくなる。
 図21は、この発明の第5実施形態にかかる作業装置の回転ユニットの要部の正面図である。この回転ユニット4は、リンク作動装置29の姿勢制御用アクチュエータ31の中心部に第1の回転機構21が配置されている。この配置は、図19に示す第4実施形態と同じであるが、第1の回転機構21の駆動源が中空軸モータ110である点で、図19に示す第4実施形態と異なっている。
 中空軸モータ110のモータ本体110aが、モータ取付部材111を介してベース部材80に固定されている。中空軸モータ110の出力軸110bに、基端側のリンクハブ32の基端部材40が固定されている。中空軸モータ110は、モータ本体110aおよび出力軸110bを軸方向に貫通する配線用孔112を有する。また、基端側のリンクハブ32の基端部材40にも、配線用孔112と同軸上に配線用孔113が設けられている。これ以外の構成は、図19に示す第4実施形態と同じであり、図19に示す第4実施形態と同様の作用、効果が得られる。
 図22~図25は、この発明の第6実施形態にかかる双腕型作業装置を示す。図22の全体正面図に示すように、この双腕型作業装置120は、2つの作業装置本体1A,1Aと、これら2つの作業装置本体1A,1Aを囲むカバー150とを備える。カバー150は、作業装置本体1A,1Aに物が不要に接触することを防止する接触防止手段である。
 図22の正面図、図23の斜視図に示すように、2つの作業装置本体1A,1Aは、互いに幾何学的に対称となるように2つ並べて配置してある。2つの作業装置本体1A,1Aの架台2,2は、互いの水平部2a,2aの先端同士が繋がっていて、全体で門形の架台2Aとなっている。この実施形態では、図18に示す第4実施形態の作業装置本体1Aを使用している。ただし、他の実施形態の作業装置本体を使用してもよい。
 このように、作業装置本体1Aを2つ並べた双腕型とすることで、人が両手を使って行うような作業が可能となる。これにより、人の代わりとなる作業、特に部品の組立てのような作業を行うことができる。
 2つの作業装置本体1A,1Aが門形の架台2Aに設置されていると、作業装置本体1A,1Aの下を作業対象のワーク7を通過させることができる。例えば、ワーク載置台6を、図22の紙面と直交する方向にワーク7を搬送可能なコンベア装置とし、そのコンベアライン上に作業装置本体1A,1Aを設置することができる。また、作業装置本体1A,1Aの幅方向の可動範囲を架台2Aの幅方向内に制限することができる。そのため、作業装置本体1A,1Aの占有面積が小さくて済む。さらに、作業装置本体1A,1Aの可動範囲が制限されるので、作業装置本体1A,1Aに物が接触する可能性が小さい。
 図24Aは、2つの作業装置本体1Aの各直動ユニット3,3の平面図である。これらの直動ユニット3,3は、図1、図10、図18に示す各作業装置本体1Aの直動ユニット3と同様に、第1の直動アクチュエータ11および第2の直動アクチュータ12の各モータ11b,12bが、直動アクチュエータ11,12の中心軸上に配置されている。
 図24Bは、直動ユニット3,3の別の例を示す平面図である。これらの直動ユニット3,3は、第1の直動アクチュエータ11および第2の直動アクチュータ12の各モータ11b,12bが、直動アクチュエータ11,12の中心軸からずれた位置に配置されている。モータ11b,12bの回転は、チェーンのような動力伝達手段121を介して直動アクチュエータ11,12の駆動部へ伝達されている。
 双腕型作業装置120の仕様に応じて、直動ユニット3を図24Aの構成、または図24Bの構成に変更することが可能である。直動ユニット3と回転ユニット4が、別々に設けられているので、このような構成の変更が容易である。
 図25は、カバー150の斜視図である。カバー150は、隣り合う2つの面材が互いに直交するように配置された4つの立面材(面材)151,152,153,154と1つの天面材(面材)155とからなる。つまり、カバー150は、下方に開放した直方体の形状である。図22に示すように、カバー150は、2つ作業装置本体1A,1Aを囲んでいる。これにより、作業装置本体1A,1Aが設置された空間である作業領域R1が、この作業領域R1の外側の空間である非作業領域R2から分離されている。
 カバー150の4つの立面材151~154(図25)および1つの天面材155のそれぞれが、作業装置本体1Aの3つの直動アクチュエータ11,12,13(図22)のうち2つの可動方向と平行となるように設置されている。具体的には、立面材151,153は、第1の直動アクチュエータ11および第3の直動アクチュエータ13の可動方向(X軸方向、Z軸方向)と平行である。立面材152,154は、第2の直動アクチュエータ12および第3の直動アクチュエータ13の可動方向(Y軸方向、Z軸方向)と平行である。天面材155は、第1の直動アクチュエータ11および第2の直動アクチュエータ12の可動方向(X軸方向、Y軸方向)と平行である。
 正面の立面材151の下部には、非作業領域R2から作業領域R1に物あるいは作業者の手を侵入させることが可能な侵入可能部156が設けられている。この侵入可能部156は長方形の開口である。侵入可能部156の高さ寸法Hは、第3の直動アクチュエータ13の可動範囲(有効ストロークsZ(図2A))よりも小さい。また、侵入可能部156の幅寸法Wは、第1の直動アクチュエータ11の可動範囲(有効ストロークsx+sx(図2B))よりも小さい。
 侵入可能部156には、この侵入可能部156から作業領域R1に物が侵入したことを検知する侵入検知センサ157が設けられている。侵入検知センサ157は、例えば、単腕型の作業装置1の侵入検知センサ137と同様のものであり、制御装置(図示せず)に接続されている。単腕型の作業装置1の場合と同様に、侵入検知センサ157の検出信号に応じて、制御装置で直動ユニット3および回転ユニット4の各モータを制御する。これにより、作業領域R1へのワーク7の搬出、搬入作業や、作業装置本体1Aの補助作業が容易になる。
 4つの立面材151~154および1つの天面材155のそれぞれが、3つの直動アクチュエータ11~13の可動方向のうち2つの可動方向と平行である。このため、カバー150の内部空間体積と装置の可動部が移動する領域の体積とをほぼ等しくできる。これにより、カバー150を含めた接触防止手段をコンパクトな構成を実現できる。また、侵入可能部156以外で物と作業装置本体1Aとが接触することがない。したがって、物と作業装置本体1Aとの接触を確実に防止できる。
 さらに、侵入可能部146の高さ寸法Hが第3の直動アクチュエータ13の可動範囲(有効ストロークsZ)よりも小さく、かつ幅寸法Wは第1の直動アクチュエータ11の可動範囲(有効ストロークsx+sx)よりも小さく設定されている。このため、カバー150と作業装置本体1Aとの間に、物が侵入し難い。
 図26は、カバーの他の例を示す。このカバー150は、侵入可能部156とは別に、2つのワーク搬出入部161,162が設けられている。2つのワーク搬出入部161,162は、侵入可能部156が設けられている正面の立面材151と直交し互いに対向する側面の立面材152,154の下部に設けられている。2つのワーク搬出入部161,162は、前後方向(Y軸方向)および上下方向(Z軸方向)の位置を揃えて配置されている。
 ワーク搬出入部161,162が設けられていると、カバー150内の作業領域R1(図22)にワークを搬出、搬入させる装置(例えば、コンベア装置)を、ワーク搬出入部161,162を貫通するように設置できる。そのコンベア装置のライン上に作業装置本体1A,1A(図22)を設置することができる。
 ワーク搬出入部161,162に、このワーク搬出入部161,162から作業領域R1に物が侵入したことを検知するワーク搬出入部用の侵入検知センサ163,164を設けるのが望ましい。これにより、単腕型の作業装置1の場合と同様に制御することで(図6)、ワーク搬出入部161,162から作業領域R1に物が侵入したという異常事態を検知できる。したがって、作業装置本体1A,1Aの動作サイクルを停止するという迅速な対応をとることが可能である。
 以上のとおり、図面を参照しながら好適な実施形態を説明したが、本発明は、以上の実施形態に限定されるものでなく、本発明の要旨を逸脱しない範囲内で、種々の追加、変更または削除が可能である。したがって、そのようなものも本発明の範囲内に含まれる。
1…作業装置
1A…作業装置本体
2…架台
3…直動ユニット
4…回転ユニット
5…エンドエフェクタ
11…第1の直動アクチュエータ
11a…ステージ
12…第2の直動アクチュエータ
12a…ステージ
13…第3の直動アクチュエータ
13a…ステージ
21…第1の回転機構
22…第2の回転機構
23…第3の回転機構
23a…回転部分(回転ユニットの出力部)
29…リンク作動装置
31…姿勢制御用アクチュエータ
32…基端側のリンクハブ
33…先端側のリンクハブ(回転ユニットの出力部)
34…リンク機構
35…基端側の端部リンク部材
36…先端側の端部リンク部材
37…中央リンク部材
82…保護カバー(侵入防止カバー)
83…内部空間
85…保護カバー(緩衝材)
120…双腕型作業装置
130…カバー(接触防止手段)
131,132,133,134…立面材(面材)
135…天面材(面材)
136…侵入可能部
137…侵入可能部用の侵入検知センサ
138…制御装置
141,142…ワーク搬出入部
143,144…ワーク搬出入部用の侵入検知センサ
150…カバー(接触防止手段)
151,152,153,154…立面材(面材)
155…天面材(面材)
156…侵入可能部
157…侵入可能部用の侵入検知センサ
161,162…ワーク搬出入部
163,164…ワーク搬出入部用の侵入検知センサ
170…接触防止手段
202…接触検出手段
203…トルク検出手段
R1…作業領域
R2…非作業領域
S…作業空間
 

Claims (11)

  1.  エンドエフェクタを用いて作業を行う6自由度の作業装置であって、
     作業装置本体と、この作業装置本体に物が不要に接触することを防止する接触防止手段とを備え、
     前記作業装置本体は、3つの直動アクチュエータを組み合わせた3自由度の直動ユニットと、1自由度以上の回転自由度を持つ複数の回転機構を組み合わせた3自由度の回転ユニットとを備え、
     前記直動ユニットは基部を架台に固定して設置され、前記回転ユニットの基部が前記直動ユニットの出力部に固定して設置され、かつ前記回転ユニットの出力部に前記エンドエフェクタが搭載され、
     前記接触防止手段は、前記作業装置本体が設置された空間である作業領域と、この作業領域の外側の空間である非作業領域とを分離するものであり、
     前記接触防止手段は、前記非作業領域から前記作業領域に物が侵入可能な侵入可能部と、この侵入可能部から前記作業領域に物が侵入したことを検知する侵入検知センサとを有する作業装置。
  2.  請求項1に記載の作業装置において、前記接触防止手段は、複数の面材を備え、
     前記複数の面材が前記作業装置本体を囲むカバーであり、
     前記複数の面材のそれぞれは、前記3つの直動アクチュエータの3つの可動方向のうち2つの可動方向と平行である作業装置。
  3.  請求項1または2に記載の作業装置において、前記侵入可能部は、この侵入可能部が存在する平面に平行な2つの前記直動アクチュエータの可動方向の長さが、それぞれ前記2つの直動アクチュエータの可動範囲よりも小さい作業装置。
  4.  請求項1から3のいずれか一項に記載の作業装置において、前記回転ユニットは、前記複数の回転機構のうちの少なくとも1つが2自由度のリンク作動装置であり、
     前記リンク作動装置は、基端側のリンクハブに対し先端側のリンクハブが3組以上のリンク機構を介して姿勢を変更可能に連結され、
     前記各リンク機構は、それぞれ前記基端側のリンクハブおよび前記先端側のリンクハブに一端が回転可能に連結された基端側および先端側の端部リンク部材と、これら基端側および先端側の端部リンク部材の他端に両端がそれぞれ回転可能に連結された中央リンク部材とを有し、
     前記3組以上のリンク機構のうちの2組以上のリンク機構に、前記基端側のリンクハブに対する前記先端側のリンクハブの姿勢を任意に変更させる姿勢制御用アクチュエータが設けられている作業装置。
  5.  請求項4に記載の作業装置において、前記姿勢制御用アクチュエータはそれぞれがトルク検出手段を有し、
     前記トルク検出手段の検出信号から前記回転ユニットに物が接触したことを検知する接触検出手段が設けられている作業装置。
  6.  請求項4または5に記載の作業装置において、前記基端側のリンクハブと前記先端側のリンクハブとの間の内部空間に、物が侵入することを防止する侵入防止カバーが設けられている作業装置。
  7.  請求項1から6のいずれか一項に記載の作業装置において、前記回転ユニットに、物と接触したときの衝撃を軽減する緩衝材が設けられている作業装置。
  8.  請求項1から7のいずれか一項に記載の作業装置において、前記直動ユニットの前記直動アクチュエータは、それぞれの進退部分からなるステージが、前記エンドエフェクタによって作業が行われる作業空間に対して外側を向くように配置されている作業装置。
  9.  請求項1から8のいずれか一項に記載の作業装置において、前記侵入検知センサが前記作業領域に物が侵入したことを検知すると、前記作業装置本体の動作速度を低下させるか、または動作を停止させるように制御する制御装置が設けられている作業装置。
  10.  請求項1から9のいずれか一項に記載の作業装置において、前記接触防止手段に、前記作業領域と前記非作業領域間でワークを搬出・搬入するためのワーク搬出入部が1つ以上設けられ、かつ前記ワーク搬出入部から前記作業領域に物が侵入したことを検知するワーク搬出入部用の侵入検知センサが設けられている作業装置。
  11.  互いに幾何学的に対称となるように2つ並べて配置され、それぞれがエンドエフェクタを用いて作業を行う6自由度の作業装置本体と、これら2つの作業装置本体に物が不要に接触することを防止する接触防止手段とを備え、
     前記作業装置本体は、3つの直動アクチュエータを組み合わせた3自由度の直動ユニットと、1自由度以上の回転自由度を持つ複数の回転機構を組み合わせた3自由度の回転ユニットとを備え、
     前記直動ユニットは基部を架台に固定して設置され、前記回転ユニットの基部が前記直動ユニットの出力部に固定して設置され、かつ前記回転ユニットの出力部に前記エンドエフェクタが搭載され、
     前記接触防止手段は、前記2つの作業装置本体が設置された空間である作業領域と、この作業領域の外側の空間である非作業領域とを分離するものであり、
     前記接触防止手段は、前記非作業領域から前記作業領域に物が侵入可能な侵入可能部と、この侵入可能部から前記作業領域に物が侵入したことを検知する侵入検知センサとを有する双腕型作業装置。
     
PCT/JP2017/021112 2016-06-15 2017-06-07 作業装置および双腕型作業装置 WO2017217294A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201780036825.0A CN109311174A (zh) 2016-06-15 2017-06-07 作业装置和双臂型作业装置
EP17813192.6A EP3473389B1 (en) 2016-06-15 2017-06-07 Work device and dual-arm work device
US16/217,474 US11247329B2 (en) 2016-06-15 2018-12-12 Work device and dual-arm work device

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2016-118617 2016-06-15
JP2016118617A JP6799950B2 (ja) 2016-06-15 2016-06-15 作業装置および双腕型作業装置

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US16/217,474 Continuation US11247329B2 (en) 2016-06-15 2018-12-12 Work device and dual-arm work device

Publications (1)

Publication Number Publication Date
WO2017217294A1 true WO2017217294A1 (ja) 2017-12-21

Family

ID=60664091

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/021112 WO2017217294A1 (ja) 2016-06-15 2017-06-07 作業装置および双腕型作業装置

Country Status (5)

Country Link
US (1) US11247329B2 (ja)
EP (1) EP3473389B1 (ja)
JP (1) JP6799950B2 (ja)
CN (1) CN109311174A (ja)
WO (1) WO2017217294A1 (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6719956B2 (ja) * 2016-04-20 2020-07-08 Ntn株式会社 双腕型作動装置
US10754305B2 (en) * 2016-08-08 2020-08-25 Mitsubishi Electric Corporation Controller for parallel link mechanism
CN108748262A (zh) * 2018-05-28 2018-11-06 安徽沃屹智能装备有限公司 一种机械手臂安全装置
JP7290439B2 (ja) * 2019-03-25 2023-06-13 Ntn株式会社 嵌合作業装置
DE102019214849A1 (de) * 2019-09-27 2021-04-01 Bausch + Ströbel Maschinenfabrik Ilshofen GmbH + Co. KG Produktionseinrichtung, insbesondere für die pharmaindustrie
EP3815856A1 (de) * 2019-11-04 2021-05-05 Skan Ag Anordnung zur überwachung von zustand und bewegungsablauf in einer aseptischen arbeitskammer eines containments
JP7243603B2 (ja) * 2019-12-09 2023-03-22 トヨタ自動車株式会社 搬送ロボットシステム
JP2022154177A (ja) * 2021-03-30 2022-10-13 Ntn株式会社 球面リンク機構及び球面リンク作動装置

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6133894A (ja) * 1984-07-25 1986-02-17 神鋼電機株式会社 産業用ロボツトの安全ア−ム及び安全ハンド
JPH0589337U (ja) * 1992-05-18 1993-12-07 積水化学工業株式会社 ロボットパレタイザ
JPH07178684A (ja) * 1993-12-22 1995-07-18 Toshiba Corp ロボットアーム
JPH0811085A (ja) * 1994-06-28 1996-01-16 Toyota Motor Corp ロボット
JPH0810935A (ja) * 1994-06-27 1996-01-16 Riyouei Eng Kk 自動バリ取り装置
JP2002336994A (ja) * 2001-03-14 2002-11-26 Hitachi Zosen Corp 搬送装置及び溶接装置
JP2004036776A (ja) * 2002-07-04 2004-02-05 Star Seiki Co Ltd 産業用機械の安全機構
JP2014065098A (ja) * 2012-09-25 2014-04-17 Canon Inc ロボット装置及び多関節ロボットの軌道シミュレーション装置並びに軌道生成方法
JP2014087922A (ja) * 2012-10-29 2014-05-15 Electronics And Telecommunications Research Institute ロボット制御装置及び方法
JP2014119069A (ja) * 2012-12-18 2014-06-30 Ntn Corp リンク作動装置
JP2015055262A (ja) * 2013-09-10 2015-03-23 Ntn株式会社 リンク作動装置
JP2015145057A (ja) * 2014-02-04 2015-08-13 セイコーエプソン株式会社 ロボットハンド、ロボット、及びロボットハンドの製造方法

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3888362A (en) * 1973-05-31 1975-06-10 Nasa Cooperative multiaxis sensor for teleoperation of article manipulating apparatus
US4229136A (en) * 1979-03-19 1980-10-21 International Business Machines Corporation Programmable air pressure counterbalance system for a manipulator
US4752160A (en) * 1984-03-19 1988-06-21 Ltv Aerospace & Defense Company Automated tool positioning system
DE3604470A1 (de) * 1986-02-13 1987-08-20 Held Laser Systems Ag Bearbeitungsstation fuer grosse werkstuecke
DE3704952A1 (de) * 1987-02-17 1988-08-25 Fraunhofer Ges Forschung Industrieroboter zum bearbeiten und/oder handhaben insbesondere montieren von gegenstaenden
IT1235796B (it) * 1989-09-11 1992-10-26 Josb S P A Macchina utensile a sostituzione automatica di "attuatori multifunzione" per eseguire automaticamente una sequenza di operazioni diverse, in particolare per l'installazione di organi di collegamento per l'assemblaggio di sottoinsiemi meccanici quali strutture aeronautiche, automobilistiche, nautiche ecc
JPH0589337A (ja) 1991-07-23 1993-04-09 Toshiba Corp 自動販売機
WO2005009691A1 (en) * 2003-07-18 2005-02-03 Fanuc Robotics America, Inc. Handling large, heavy workpieces using gantry robots with two robot arms
JP2005329521A (ja) 2004-05-21 2005-12-02 Denso Wave Inc 多関節型ロボット
JP4528312B2 (ja) 2007-02-02 2010-08-18 川田工業株式会社 双腕ロボットの肩幅空間制限装置及びその装置を具えた双腕ロボット
DE102007062245A1 (de) * 2007-12-21 2009-06-25 Robert Bosch Gmbh Kollisionsdetektionsvorrichtung sowie Handhabungsgerät
FR2938508B1 (fr) * 2008-11-14 2010-12-17 Sidel Participations Installation de palettisation combinee avec acces securise
FR2948339A1 (fr) * 2009-07-22 2011-01-28 Sidel Participations Perfectionnement a une installation de palettisation combinee avec acces securise.
JP5454491B2 (ja) 2011-02-25 2014-03-26 株式会社安川電機 作業システム
EP3511129B1 (en) * 2012-03-23 2021-03-10 NTN Corporation Method of controlling operation of link actuation device and control device therefor
CN102785239B (zh) * 2012-07-23 2015-04-29 东莞市李群自动化设备有限公司 一种六自由度工业机器人
JP6123307B2 (ja) * 2013-01-23 2017-05-10 株式会社デンソーウェーブ ロボット周辺への物体の侵入を監視する監視システムおよび監視方法
US9475077B2 (en) * 2013-03-28 2016-10-25 Specialty Coating Systems, Inc. High speed coating and dispensing apparatus
CN104816310A (zh) 2014-02-04 2015-08-05 精工爱普生株式会社 机器人手、机器人、以及机器人手的制造方法
WO2016084685A1 (ja) * 2014-11-28 2016-06-02 Ntn株式会社 パラレルリンク機構を用いた作業装置

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6133894A (ja) * 1984-07-25 1986-02-17 神鋼電機株式会社 産業用ロボツトの安全ア−ム及び安全ハンド
JPH0589337U (ja) * 1992-05-18 1993-12-07 積水化学工業株式会社 ロボットパレタイザ
JPH07178684A (ja) * 1993-12-22 1995-07-18 Toshiba Corp ロボットアーム
JPH0810935A (ja) * 1994-06-27 1996-01-16 Riyouei Eng Kk 自動バリ取り装置
JPH0811085A (ja) * 1994-06-28 1996-01-16 Toyota Motor Corp ロボット
JP2002336994A (ja) * 2001-03-14 2002-11-26 Hitachi Zosen Corp 搬送装置及び溶接装置
JP2004036776A (ja) * 2002-07-04 2004-02-05 Star Seiki Co Ltd 産業用機械の安全機構
JP2014065098A (ja) * 2012-09-25 2014-04-17 Canon Inc ロボット装置及び多関節ロボットの軌道シミュレーション装置並びに軌道生成方法
JP2014087922A (ja) * 2012-10-29 2014-05-15 Electronics And Telecommunications Research Institute ロボット制御装置及び方法
JP2014119069A (ja) * 2012-12-18 2014-06-30 Ntn Corp リンク作動装置
JP2015055262A (ja) * 2013-09-10 2015-03-23 Ntn株式会社 リンク作動装置
JP2015145057A (ja) * 2014-02-04 2015-08-13 セイコーエプソン株式会社 ロボットハンド、ロボット、及びロボットハンドの製造方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3473389A4 *

Also Published As

Publication number Publication date
EP3473389A1 (en) 2019-04-24
EP3473389A4 (en) 2020-01-15
JP6799950B2 (ja) 2020-12-16
JP2017221998A (ja) 2017-12-21
EP3473389B1 (en) 2022-12-14
CN109311174A (zh) 2019-02-05
US20190111561A1 (en) 2019-04-18
US11247329B2 (en) 2022-02-15

Similar Documents

Publication Publication Date Title
WO2017217294A1 (ja) 作業装置および双腕型作業装置
EP3446836B1 (en) Work device and dual-arm work device
US8322250B2 (en) Humanoid robot and shoulder joint assembly thereof
US11420322B2 (en) Working device and double-arm type working device
WO2016129624A1 (ja) リンク作動装置を用いた多関節ロボット
WO2019194138A1 (ja) ロボットの制御装置
KR101309652B1 (ko) 축마다 중공형 구동모듈 및 1축 토크센서가 장착된 산업용 직접교시 로봇
WO2018181040A1 (ja) 多関節ロボット
CN107363851B (zh) 控制装置以及机器人系统
JPWO2013175554A1 (ja) ロボットおよびロボットシステム
JP6576646B2 (ja) リンク作動装置を用いた多関節ロボット
US11130225B2 (en) Working device and double-arm type working device
KR20180099623A (ko) 로봇 팔 및 로봇 손목
JP6883073B2 (ja) リンク作動装置を用いた多関節ロボット
WO2010060475A1 (en) Industrial robot
JP2001300871A (ja) マスターアーム装置
WO2018088446A1 (ja) 作業装置および双腕型作業装置
US20170371321A1 (en) Robot, control device, and robot system
Park et al. Design of an industrial dual arm robot manipulator for a Human-Robot hybrid manufacturing
CN115502960B (zh) 末端组件、作业装置及其控制方法
JP7260987B2 (ja) 双腕型の作業装置

Legal Events

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

Ref document number: 17813192

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2017813192

Country of ref document: EP

Effective date: 20190115