This application is based on and claims priority to Japanese Patent Application No. 2017-227876 filed on Nov. 28, 2017, the content of which is incorporated herein by reference in its entirety.
The present invention relates to a robot, and more specifically relates to a robot that detects contact with a person and performs a stop motion, a deceleration motion, or an avoidance motion.
As such a robot, there is known a robot that stops a motion of an articulated arm upon determining that a person has come into contact with the arm by using a detection result of a torque sensor for each axis of the arm or a contact sensor disposed on the entire surface of the arm (e.g., see Japanese Unexamined Patent Application, Publication No. 2017-030137).
Further, there is known a robot that is an industrial robot in a motion range of which a person is not present, the robot including: a device mounted on a wrist member of an articulated arm; and a cable having one end connected to the device and the other end connected to a controller, the cable being disposed in the arm (e.g., see Japanese Unexamined Patent Application, Publication No. 2000-000792).
A robot of an aspect of the present disclosure includes: a base; an articulated arm provided on the base; a sensor that is provided on the base and detects external force applied to the articulated arm; a controller that causes the articulated arm to make a stop motion, a deceleration motion, or an avoidance motion on a basis of a detected value of the sensor; and a cable having one end connected to a device mounted on a tip-side member of the articulated arm, and having the other end connected to a cable-connected device that controls the device and supplies a fluid or electric power to the device. The robot is configured such that the cable enters into the articulated arm from a member subjected to insertion which is a member of the articulated arm on which the device is mounted or a member near the member of the articulated arm, passes through a member of the articulated arm which is disposed closer to the base side than the member subjected to insertion is, and is connected to the cable-connected device.
A robot 10 according to one embodiment of the present invention will be described below with reference to the drawings.
As shown in
The articulated arm 20 of the robot 10 includes a plurality of arm members 21, 22, 23, 24, 25, 26, and joints 21a, 22a, 23a, 24a, 25a, 26a, and also includes a plurality of servo motors 11 that respectively drive the plurality of joints 21a, 22a, 23a, 24a, 25a, 26a (cf.
As each servo motor 11, a variety of servo motors such as a rotary motor and a linear motor can be used. An operating position detector such as an encoder for detecting the operating position of each servo motor 11 is integrated in each servo motor 11, and a detected value of the operating position detector is transmitted to a controller 40.
It is configured such that the base 10a of the robot 10 is provided with a force sensor (sensor) 12 made up of six-axial force sensors, for example, and a detection result of the force sensor 12 is also transmitted to the controller 40 (cf.
As shown in
In the present embodiment, the robot tool 31 and the position/posture confirmation sensor 32 are mounted on the arm member 26, but for example, the position/posture confirmation sensor 32 can be mounted on the arm members 24, 25. The robot tool 31 is provided with a motor for driving the robot tool 31. The motor and the position/posture confirmation sensor 32 are connected to the controller (cable-connected device) 40 via the cable CA and controlled by the controller 40.
As shown in
The storage unit 43 stores a system program 43a, and the system program 43a serves a basic function of the controller 40. The storage unit 43 stores at least one motion program 43b created by using the teach pendant 45. Further, the storage unit 43 stores a safe motion program 43c for causing the articulated arm 20 to make a motion for safety based on a detection result of the force sensor 12.
The control unit 41 operates in accordance with the system program 43a, reads the motion program 43b stored in the storage unit 43, temporarily stores the motion program 43b into the RAM, transmits a control signal to each servo controller 44 in accordance with the read motion program 43b while using a result of detection by the position/posture confirmation sensor 32, and controls with the control signal the motor of the robot tool 31 while controlling a servo amplifier of each servo motor 11 of the robot 10.
At this time, the control unit 41 reads the safe motion program 43c stored in the storage unit 43, temporarily stores the safe motion program 43c into the RAM, monitors the detection result of the force sensor 12 based on the read safe motion program 43c. When the detection result of the force sensor 12 exceeds a predetermined reference range, the control unit 41 determines that a protection target such as a person or an object has come into contact with the robot 10, and stops the operation of each servo motor 11 of the robot 10 (safe motion function).
Here, the control unit 41 appropriately changes the predetermined reference range in consideration of whether or not the robot 10 is holding the workpiece, the position of the tip of the robot 10, the posture of the robot 10, the motion speed of the robot 10, a weight of each of constituent parts constituting the robot 10, an inertial mass thereof, and the like.
The cable CA includes a plurality of signal lines and power lines. Some of the signal lines and the power lines at one end of the cable CA are connected to the robot tool 31, and others of the signal lines and the power lines at the one end of the cable CA are connected to the position/posture confirmation sensor 32. Further, the signal line and the power lines at the other end of the cable CA are connected to the controller 40. In the present embodiment, the cables CA for the robot tool 31 and the position/posture confirmation sensor 32 are unified, but the cables CA may be separated, and the signal line and the power line may be disposed in separate cables CA.
The cable CA extending from the robot tool 31 and the position/posture confirmation sensor 32 enters into the arm member 26 on which the robot tool 31 is mounted and the position/posture confirmation sensor 32, or enters into the arm member 26 via holes (not shown) provided in the arm members 25, 24 in the vicinity of the arm member 26. The cable CA is sequentially inserted through the insides of the arm member 25, the arm member 24, the arm member 23, the arm member 22, and the arm member 21, enters into the base 10a from the inside of the arm member 21 and comes outside the base 10a via a hole (not shown) formed on the side surface of the base 10a.
In this manner, the other end side of the cable CA is connected to the controller (cable-connected device) 40. A space for insertion of the cable CA is formed inside each of the arm members 21, 22, 23, 24, 25, 26 and inside the base 10a. A hole or a space for insertion of the cable CA is formed among each of the arm members 21, 22, 23, 24, 25, 26 and between the arm member 21 and the base 10a.
As thus described, in the present embodiment, the force sensor 12 that detects external force applied to the articulated arm 20 is provided on the base 10a, so that even in the case of generation of bending deformation or pulling force in the cable CA in the articulated arm 20 due to the motion of the articulated arm 20, the force sensor 12 on the base 10a is little or not affected, thereby enabling reduction or prevention of erroneous detection that a person has come into contact with the articulated arm 20.
Further, the cable CA is configured so as enter into the base 10a from the base end of the articulated arm 20, while entering into the articulated arm 20 from the arm member (member subjected to insertion) 26, and comes outside the robot 10 from the base 10a toward the controller 40. With the cable CA being disposed in the articulated arm 20 in this manner, it is possible to reduce the possibility of the person or the object being caught between the cable CA and the articulated arm 20.
Further, when the cable CA disposed in the articulated arm 20 is to be changed in accordance with the type of the device that is mounted at the tip of the robot 10, work for the change can be easily performed due to no contact sensor being provided on the surface of the articulated arm 20.
In the present embodiment, the cable CA passing through the inside of each of the arm members 21, 22, 23, 24, 25, 26 has been shown. In contrast, as shown in
In this case, it may be configured such that the cable CA having once come outside the articulated arm 20 is disposed along the arm member 22, and the cable CA having come outside is disposed between the arm member 22 and the cover member 22b mounted on the arm member 22, so as to regulate the move of the cable CA.
As thus described, even when the cable CA is not inserted through the inside of some of the arm members 21, 22, 23, 24, 25, 26, the cable CA is disposed inside the articulated arm 20 on each of the tip side and the base end side of the articulated arm 20, thereby enabling reduction in the possibility that the person or the object is caught between the cable CA and the articulated arm 20.
Moreover, it may be configured such that the cable CA having come outside the articulated arm 20 from the arm member 23 is connected to the controller 40 without entering into the articulated arm 20 or the base 10a. Also in this case, with the cable CA being disposed in the articulated arm 20 from the tip side of the articulated arm 20, the possibility of the person or the object being caught between the cable CA and the articulated arm 20 can be reduced.
For example, when the controller 40 is unified with or adheres to the base 10a, the cable CA having passed through the articulated arm 20 and the cable CA having passed through the base 10a are connected to the controller 40 without coming outside as described above.
In the present embodiment, the motor of the robot tool 31 and the position/posture confirmation sensor 32 being connected to the controller 40 via the cable CA have been shown. However, the motor of the robot tool 31 and the position/posture confirmation sensor 32 may be respectively connected to dedicated controllers (cable-connected devices). Further, when there is a need to supply compressed air, pressurized hydraulic oil, or the like to the robot tool 31, a supply pipe for supplying this fluid can also be disposed as the cable CA in the same manner as above. In this case, the other end of the cable CA for supplying the compressed air, the pressurized hydraulic oil, or the like is connected to a fluid supply source.
Further, in the present embodiment, the function of stopping the operation of each servo motor 11 of the robot 10 has been shown as the safe motion function. In contrast, each servo motor 11 may be controlled as follows: when the detection result of the force sensor 12 exceeds the predetermined reference range, the control unit 41 operates in accordance with the safe motion program 43c, and when the detection result of the force sensor 12 exceeds the predetermined reference range, it is determined that the protection target such as the person or the object has come into contact with the robot 10 and the robot 10 makes a predetermined avoidance motion.
As the avoidance motion, for example, each servo motor 11 is controlled such that the control unit 41 estimates the direction of the contact based on the detection result of the force sensor 12, and the robot 10 moves in the opposite direction to the direction of the contact.
Meanwhile, each servo motor 11 may be controlled such that, when the detection result of the force sensor 12 exceeds the predetermined reference range, the motion speed of the robot 10 is decreased.
From the above-described embodiments, the following aspects of the present disclosure are derived.
A robot of an aspect of the present disclosure includes: a base; an articulated arm provided on the base; a sensor that is provided on the base and detects external force applied to the articulated arm; a controller that causes the articulated arm to make a stop motion, a deceleration motion, or an avoidance motion on a basis of a detected value of the sensor; and a cable having one end connected to a device mounted on a tip-side member of the articulated arm, and having the other end connected to a cable-connected device that controls the device and supplies a fluid or electric power to the device. The robot is configured such that the cable enters into the articulated arm from a member subjected to insertion which is a member of the articulated arm on which the device is mounted or a member near the member of the articulated arm, passes through a member of the articulated arm which is disposed closer to the base side than the member subjected to insertion is, and is connected to the cable-connected device.
In the above aspect, the sensor that detects external force applied to the articulated arm is provided on the base. Therefore, even if bending deformation or pulling force is generated in the cable in the articulated arm due to the move of the articulated arm, the sensor on the base is little or not affected, thereby enabling reduction or prevention of erroneous detection that a person has come into contact with the arm.
Further, the cable enters into the articulated arm from the member subjected to insertion which is a member of the articulated arm on which the device is mounted or a member near the member of the articulated arm, passes through a member of the articulated arm which is disposed closer to the base side than the member subjected to insertion is, and is connected to the cable-connected device. With the cable being disposed in the articulated arm from the tip side of the articulated arm in this manner, the possibility of the person or the object being caught between the cable and the articulated arm can be reduced.
In the above aspect, the cable is preferably configured to enter into the base from a base end of the articulated arm while entering into the articulated arm from the member subjected to insertion, passes through the base, and is connected to the cable-connected device. As thus described, the cable is disposed in the articulated arm on each of the tip side and the base end side of the articulated arm, so that the possibility of the person or the object being caught between the cable and the articulated arm can further be reduced.
In the above aspect, it is preferable that the cable is not exposed outside the articulated arm from the member on which the device is mounted to the base end of the articulated arm.
With such a configuration, the cable is hardly or not at all disposed to the outside of the articulated arm, so that the possibility of the person or the object being caught between the cable and the articulated arm can further be reduced.
According to the aforementioned aspect, it is possible to reduce or prevent erroneous detection that a person has come into contact with the robot, and furthermore, it is possible to reduce the possibility that a person or an object is caught between the cable and the arm.
Number | Date | Country | Kind |
---|---|---|---|
2017-227876 | Nov 2017 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
20040052630 | Nihei et al. | Mar 2004 | A1 |
20060278621 | Takahashi | Dec 2006 | A1 |
20090114052 | Haniya et al. | May 2009 | A1 |
20110010011 | Oka et al. | Jan 2011 | A1 |
20110219906 | Haniya et al. | Sep 2011 | A1 |
20120043831 | Sakakibara et al. | Feb 2012 | A1 |
20120048027 | Hashiguchi et al. | Mar 2012 | A1 |
20140121837 | Hashiguchi et al. | May 2014 | A1 |
20150027261 | Okahisa et al. | Jan 2015 | A1 |
20150027262 | Okahisa et al. | Jan 2015 | A1 |
20150108099 | Ferrero | Apr 2015 | A1 |
20150258690 | Naitou | Sep 2015 | A1 |
20160214261 | Davis et al. | Jul 2016 | A1 |
20170028553 | Tsuda et al. | Feb 2017 | A1 |
Number | Date | Country |
---|---|---|
1396314 | Mar 2004 | EP |
1930129 | Jun 2008 | EP |
2113343 | Nov 2009 | EP |
2272636 | Jan 2011 | EP |
2422935 | Feb 2012 | EP |
2572837 | Mar 2013 | EP |
2572838 | Mar 2013 | EP |
2829368 | Jan 2015 | EP |
2829369 | Jan 2015 | EP |
S63-127888 | May 1988 | JP |
H05-237789 | Sep 1993 | JP |
H10-166292 | Jun 1998 | JP |
2000-000792 | Jan 2000 | JP |
2004-098174 | Apr 2004 | JP |
2005-169489 | Jun 2005 | JP |
2006-021287 | Jan 2006 | JP |
2011-016183 | Jan 2011 | JP |
2011-110630 | Jun 2011 | JP |
2012-040626 | Mar 2012 | JP |
2012-051042 | Mar 2012 | JP |
2013-094935 | May 2013 | JP |
2015-058515 | Mar 2015 | JP |
2015-171747 | Oct 2015 | JP |
2017-030137 | Feb 2017 | JP |
2007037131 | Apr 2007 | WO |
Entry |
---|
Office Action dated Oct. 29, 2019, in corresponding Japanese Application No. 2017-227876; 9 pages. |
Number | Date | Country | |
---|---|---|---|
20190160688 A1 | May 2019 | US |