USPatent applicationPatented

Robot control apparatus capable of transferring workpiece having parameter exceeding rated workpiece parameter

Granted 1 Oct 2019 · 4 office actions

Assignee: FANUC

Law firm: Law firm · Log in to unlock

Attorney: Attorney · Log in to unlock

Inventors: Tsuyoshi Hannya, Hiromitsu Takahashi · Examiner: Kenneth M Lo · AU 2116 · TC 2100

Life of the application

18 dated events
⤢ drag to zoom20162018202020222024202620282030203220342036ProsecutionOwnershipTerm & fees
ProsecutionOwnershipTerm & feeshover for detail · click to open

Abstract

A robot control apparatus includes a setting unit which sets a workpiece parameter, which is a parameter of a workpiece itself and affects transferability of the workpiece transferred by the industrial robot, a storage unit which stores a rated workpiece parameter, which is a maximum parameter of the workpiece itself which can be transferred by the robot at a rated velocity, and a velocity limiting unit which reduces the maximum velocity of the industrial robot to a value lower than the rated velocity when the workpiece parameter set by the setting unit exceeds the rated workpiece parameter stored in the storage unit.

Description

8 parts
›RELATED APPLICATIONS

The present application claims priority to Japanese Application Number 2014-144365, filed Jul. 14, 2014, the disclosure of which is hereby incorporated by reference herein in its entirety.

›BACKGROUND OF THE INVENTION

1. Field of the Invention

The present invention relates to a robot control apparatus capable of transferring a workpiece whose parameter exceeds a rated workpiece parameter.

2. Description of the Related Art

Upsizing of an industrial robot for transferring heavyweight workpieces results in a considerable increase in cost for producing the robot. Some conventional apparatuses addressing this problem are known that achieve transfer of heavy objects by reducing the load acting on an industrial robot (for example, refer to Japanese Laid-open Patent Publication No. 61-214983, Japanese Laid-open Patent Publication No. 11-58287, or Japanese Examined Patent Application Publication No. 63-7917). The apparatuses described in these patent documents each include a balancer which is disposed on a ceiling above the industrial robot and is connected to a workpiece gripping unit of the robot so as to absorb the load acting on the robot in the direction of gravitational force.

However, the apparatuses described in the above patent documents result in cost increase due to the need for disposing a balancer on a ceiling.

›SUMMARY OF THE INVENTION

A robot control apparatus according to an aspect of the present invention includes a setting unit which sets a workpiece parameter, which is a parameter of a workpiece itself and affects transferability of the workpiece transferred by the industrial robot, a storage unit which stores a rated workpiece parameter, which is a maximum parameter of the workpiece itself which can be transferred by the industrial robot at a rated velocity, and a velocity limiting unit which reduces the maximum velocity of the industrial robot to a value lower than the rated velocity when the workpiece parameter set by the setting unit exceeds the rated workpiece parameter stored in the storage unit.

›BRIEF DESCRIPTION OF THE DRAWINGS

Objects, features, and advantages of the present invention will become more apparent from the following descriptions of an embodiment related to the accompanying drawings in which

FIG. 1 is a block diagram illustrating major components of a robot control apparatus according to an embodiment of the present invention,

FIG. 2 is a flowchart illustrating example of operations performed by a robot control apparatus according to an embodiment of the present invention, and

FIG. 3 is a diagram illustrating example of operating characteristics of a robot control apparatus according to an embodiment of the present invention.

›DETAILED DESCRIPTION · 1 of 4

An embodiment of the present invention will now be described with reference to FIGS. 1 to 3 . FIG. 1 is a block diagram illustrating major components of a robot control apparatus 100 according to the embodiment of the present invention. The robot control apparatus 100 is configured to control operations of a robot 1 , which is an industrial robot. The robot 1 may be, for example, a multi-articular robot. The robot 1 has a gripping unit on the tip of the arm so that the gripping unit grips a workpiece and transfers it to a predetermined position.

For this kind of robot like the robot 1 , the weight of a workpiece which can be transferred at a maximum velocity (hereinafter called a rated velocity Vmax) (the weight is hereinafter called a workpiece maximum weight Wmax) is predetermined as a specification for the robot. In other words, any workpiece heavier than the workpiece maximum weight Wmax makes it difficult for the robot to transfer the workpiece at a rated velocity. To handle this situation, a larger robot having greater transfer capability can be used to transfer a much heavier workpiece. However, using a larger robot involves a considerable increase in cost for producing the robot. Alternatively, a configuration may include a balancer or the like disposed on a ceiling above the robot to reduce the load acting on the robot. However, this configuration also involves cost rise due to the need for adding a balancer. In addition, this configuration imposes a limit on where to install the robot. Hence, the present embodiment is configured as follows in order to be able to transfer a workpiece heavier than a workpiece maximum weight Wmax while suppressing an increase in cost.

To begin with, the basic concept of the robot control apparatus 100 according to the embodiment of the present invention is described below. When a workpiece which has a mass of M and is gripped by the robot 1 moves at a velocity of V, the kinetic energy E of a workpeace is expressed as the following formula (I).

E= ½ MV 2   (I)

According to the formula (I) above, the kinetic energy E increases when the mass M of a workpiece is increased. An increase in the kinetic energy E caused by an increase in the mass M of a workpiece can be suppressed by reducing the velocity V of the workpiece. In other words, putting a limit on the maximum velocity of a workpiece enables the robot 1 to transfer a workpiece heavier than the workpiece maximum weight Wmax.

The robot control apparatus 100 in FIG. 1 is configured to include an arithmetic processing unit which has a CPU (a central processing unit), ROM (read only memory), RAM (random access memory), other peripheral circuits, and the like. The robot control apparatus 100 includes, as functional components, a setting unit 11 , a storage unit 12 , a velocity limiting unit 13 , an acceleration and deceleration limiting unit 14 , and a robot control unit 15 .

The setting unit 11 sets a parameter determined by the workpiece itself to be transferred by the robot 1 , i.e., a workpiece parameter WP. The workpiece parameter WP is a parameter related to a workpiece. The workpiece parameter WP includes physical quantities affecting transferability of a workpiece, such as the mass m, the inertia I, the position of the center of gravity, the moment of the workpiece, and the like. The workpiece parameter WP is inputted by a user through, for example, an input unit (not illustrated) connected to the robot control apparatus 100 . Alternatively, a workpiece parameter WP calculated by the setting unit 11 with data, such as materials and shape of the workpiece, may be set.

The storage unit 12 stores in advance a rated workpiece parameter WP 1 , an upper-limit workpiece parameter WP 2 , a rated velocity Vmax, an upper-limit acceleration Amax, and an upper-limit deceleration Dmax. The rated workpiece parameter WP 1 , the upper-limit workpiece parameter WP 2 , and the rated velocity Vmax as stored in advance are values which are specific to the robot 1 and determined according to the configuration of the robot 1 . The upper-limit acceleration Amax and the upper-limit deceleration Dmax are values assuring that the actuator torque is not saturated and that the tip of the hand does not vibrate when a workpiece with the upper-limit workpiece parameter WP 2 is being transferred. The upper-limit acceleration Amax and the upper-limit deceleration Dmax can be determined by causing the robot 1 to transfer a workpiece having the upper-limit workpiece parameter WP 2 in advance and by adjusting parameters. In addition, the upper-limit acceleration Amax and the upper-limit deceleration Dmax are stored in the storage unit 12 in advance. The rated workpiece parameter WP 1 , which is a maximum value of the workpiece parameter WP for a workpiece which can be transferred at a rated velocity Vmax, is given as a specification for the robot 1 . In other words, in so far as the workpiece parameter WP is equal to or less than the rated workpiece parameter WP 1 , a workpiece can be transferred at a rated velocity Vmax.

The upper-limit workpiece parameter WP 2 , which is an upper limit of the workpiece parameter WP for a workpiece which can be transferred by the robot 1 , is greater than the rated workpiece parameter WP 1 . The upper-limit workpiece parameter WP 2 is determined by taking into consideration structural limits, such as strengths of the individual mechanisms in the robot 1 and torque performance limits of the actuator (servomotor or the like). Even when the workpiece parameter WP exceeds the rated workpiece parameter WP 1 , the robot 1 is still operable by reducing the velocity V to a value less than the rated velocity Vmax in so far as the workpiece parameter WP is less than the upper-limit workpiece parameter WP 2 .

The storage unit 12 stores respective physical quantities which constitute the rated workpiece parameter WP 1 and the upper-limit workpiece parameter WP 2 . In other words, the mass m 1 , the inertia I 1 , and the like for the rated workpiece parameter WP 1 , as well as the mass m 2 , the inertia I 2 , and the like for the upper-limit workpiece parameter WP 2 are stored respectively. When stored, a relationship of m 2 >m 1 exists between the mass m 1 and the mass m 2 of a workpiece, and I 2 >I 1 between the inertia I 1 and the inertia I 2 .

›DETAILED DESCRIPTION · 2 of 4

The velocity limiting unit 13 sets a maximum velocity Vx for the robot 1 transferring a workpiece, depending on whether the workpiece parameter WP set by the setting unit 11 is greater or smaller than the rated workpiece parameter WP 1 and the upper-limit workpiece parameter WP 2 stored in the storage unit 12 . For example, when the workpiece parameter WP is equal to or less than the rated workpiece parameter WP 1 (hereinafter called a first range), the velocity limiting unit 13 sets the maximum velocity Vx to a value equal to the rated velocity Vmax. When the workpiece parameter WP is greater than the rated workpiece parameter WP 1 and is equal to or less than the upper-limit workpiece parameter WP 2 (hereinafter called a second range), the velocity limiting unit 13 sets the maximum velocity Vx to a value smaller than the rated velocity Vmax. When the workpiece parameter WP is greater than the upper-limit workpiece parameter WP 2 (hereinafter called a third range), the velocity limiting unit 13 sets the maximum velocity Vx to 0.

The acceleration and deceleration limiting unit 14 sets an acceleration A and a deceleration D for the robot 1 transferring a workpiece, depending on whether the workpiece parameter WP set by the setting unit 11 is greater or smaller than the rated workpiece parameter WP 1 and the upper-limit workpiece parameter WP 2 stored in the storage unit 12 . For example, when the workpiece parameter WP falls within the first range, the acceleration and deceleration limiting unit 14 imposes no limit. When the workpiece parameter WP falls within the second range, the acceleration and deceleration limiting unit 14 sets the acceleration A and the deceleration D to values smaller than the acceleration and deceleration which would occur in the first range. When the workpiece parameter WP falls within the third range, the acceleration and deceleration limiting unit 14 sets the acceleration A and the deceleration D to values equal to the upper-limit acceleration Amax and the upper-limit deceleration Dmax stored in the storage unit 12 .

If the workpiece parameter WP is defined with the mass m of a workpiece, a range satisfying m≤m 1 is the first range, a range satisfying m 1 <m≤m 2 is the second range, and a range satisfying m>m 2 is the third range. In this case, m 1 corresponds to the maximum weight of a workpiece Wmax. If the workpiece parameter WP is defined with the inertia I of a workpiece, a range satisfying I≤I 1 is the first range, a range satisfying I 1 <I≤I 2 is the second range, and a range satisfying I>I 2 is the third range.

If the workpiece parameter WP is defined with the mass m of a workpiece and falls within the second range, the velocity limiting unit 13 calculates a maximum velocity Vx in accordance with the following formula (II) using the mass m set by the setting unit 11 .

Vx =( m 1/ m ) 1/2 ×V max  (II)

If the workpiece parameter WP is defined with the inertia I of a workpiece and falls within the second range, the velocity limiting unit 13 calculates a maximum velocity Vx in accordance with the following formula (III) using the inertia I set by the setting unit 11 .

Vx =( I 1/ I ) 1/2 ×V max  (III)

If the workpiece parameter WP is defined with the mass m and inertia I and falls within the second range, the velocity limiting unit 13 calculates a maximum velocity according to the formula (II) above (hereinafter called a first maximum velocity Vx 1 ) as well as calculates a maximum velocity according to the formula (III) above (hereinafter called a second maximum velocity Vx 2 ). Furthermore, the velocity limiting unit 13 sets the maximum velocity Vx to a value equal to the first or second maximum velocity Vx 1 or Vx 2 , whichever is smaller. The maximum velocity Vx as set above is smaller than the rated velocity Vmax.

The robot control unit 15 outputs control signals to the actuator (servomotor) for driving the robot in accordance with a predetermined operation program to control operations of the robot 1 . For this purpose, the servomotor is controlled so that the moving velocity of the gripping unit does not exceed the maximum velocity Vx as set by the velocity limiting unit 13 . For example, if the workpiece parameter WP falls within the second range and the instructed velocity predetermined in the operation program is the rated velocity Vmax, the robot control unit 15 changes the operation velocity so that the instructed velocity changes to a maximum velocity Vx, which is smaller than the rated velocity Vmax (refer to FIG. 3 ).

FIG. 2 is a flowchart illustrating example of processing performed by the robot control apparatus 100 . The processing illustrated in the flowchart is triggered by, for example, a command to start a transfer operation performed by the robot 1 . In Step S 1 , the setting unit 11 performs processing to set a parameter of the workpiece to be gripped by the gripping unit of the robot 1 , i.e., the workpiece parameter WP which includes the mass m, inertial I, and the like of the workpiece.

In Step S 2 , the velocity limiting unit 13 performs processing to determine whether the workpiece parameter WP which has been set in Step S 1 is greater than the rated workpiece parameter WP 1 which is already stored in the storage unit 12 . If Yes in Step S 2 , the control proceeds to Step S 3 , if No in Step S 2 , the control proceed to Step S 6 . In Step S 6 , because the workpiece parameter WP falls within the first range, the velocity limiting unit 13 performs processing to set the maximum velocity Vx to a value equal to the rated velocity Vmax. Furthermore, the acceleration and deceleration limiting unit 14 imposes no limit on the acceleration A and the deceleration D.

In Step S 3 , the velocity limiting unit 13 performs processing to determine whether the workpiece parameter WP which has been set in Step S 1 is greater than the upper-limit workpiece parameter WP 2 which is already stored in the storage unit 12 . If Yes in Step S 3 , the control proceeds to Step S 4 , if No in Step S 3 , the control proceed to Step S 7 . In Step S 7 , because the workpiece parameter WP falls within the second range, the velocity limiting unit 13 performs processing to make the setting of a maximum velocity Vx using the formulas (II) and (III) above. The acceleration and deceleration limiting unit 14 sets the acceleration A and the deceleration D to values smaller than the acceleration and deceleration which would occur in the first range. On the other hand, in Step S 4 , because the workpiece parameter WP falls within the third range, the velocity limiting unit 13 performs processing to set the maximum velocity Vx to 0. The acceleration and deceleration limiting unit 14 sets the acceleration A and the deceleration D to values equal to the upper-limit acceleration Amax and the upper-limit deceleration Dmax, respectively, as stored in the storage unit 12 .

›DETAILED DESCRIPTION · 3 of 4

In Step S 5 , the robot control unit 15 outputs control signals to the servomotor to control operations of the robot 1 so that the velocity does not exceed the specified maximum velocity Vx. In other words, when the workpiece parameter WP is greater than the upper-limit workpiece parameter WP 2 , which means Vx=0, the robot control unit 15 outputs a stop signal to the servomotor to stop operations of the robot 1 . When the workpiece parameter WP is equal to or less than the rated workpiece parameter WP 1 , the robot control unit 15 outputs a control signal to the servomotor so that the maximum velocity Vx of the robot 1 (the gripping unit) is equal to the rated velocity Vmax. When the workpiece parameter WP is greater than the rated workpiece parameter WP 1 and is equal to or less than the upper-limit workpiece parameter WP 2 , the robot control unit 15 outputs a control signal to the servomotor so that the maximum velocity Vx is reduced to a value lower than the rated velocity Vmax.

The following describes general operations of the robot control apparatus 100 according to the present embodiment. The description below assumes, for convenience, that the workpiece parameter WP is defined with the mass m of a workpiece and that the operation program already contains an instruction to move the gripping unit of the robot at the rated velocity Vmax. FIG. 3 is a diagram illustrating example of operating characteristics of the robot control apparatus 100 according to the present embodiment.

When the mass m of a workpiece is equal to or less than m 1 , i.e., when the workpiece parameter WP is equal to or less than the rated workpiece parameter WP 1 (the first range), the maximum velocity Vx is equal to the rated velocity Vmax as illustrated in FIG. 3 (Step S 6 ).

When the mass m of a workpiece is greater than m 1 and is equal to or less than m 2 , i.e., when the workpiece parameter WP is greater than the rated workpiece parameter WP 1 and is equal to or less than the upper-limit workpiece parameter WP 2 (the second range), the maximum velocity Vx is reduced to a value lower than the rated velocity Vmax (Step S 7 ). Reducing the maximum velocity Vx as above prevents an increase in the kinetic energy E of a workpiece (the formula (I) above) due to an increased mass of the workpiece, thereby enabling a workpiece heavier than the workpiece maximum weight Wmax to be transferred without the need for using a larger robot. As illustrated in FIG. 3 , the maximum velocity Vx is more reduced as the workpiece parameter WP becomes higher, and thus the maximum velocity Vx is set to an optimum value depending on the mass m of a workpiece, allowing for efficient transfer of workpieces.

When the mass m of a workpiece is greater than m 2 , i.e., when the workpiece parameter WP is greater than the upper-limit workpiece parameter WP 2 (the third range), the maximum velocity Vx is 0 (Step S 4 ). This prohibits the robot 1 from transferring a workpiece exceeding the transfer capability of the robot 1 , thereby preventing damage to the robot 1 , falling of a workpiece being transferred, and the like.

The present embodiment provides the following functional effects.

(1) The robot control apparatus 100 includes the setting unit 11 which sets a workpiece parameter WP, which is a parameter of a workpiece itself and affects transferability of the workpiece, the storage unit 12 which stores a rated workpiece parameter, which is a maximum parameter of the workpiece itself which can be transferred by the robot 1 at a rated velocity Vmax, and the velocity limiting unit 13 which reduces the maximum velocity Vx of the industrial robot 1 (the gripping unit) to a value lower than the rated velocity Vmax when the workpiece parameter WP set by the setting unit 11 exceeds the rated workpiece parameter WP 1 stored in the storage unit 12 . This allows the robot 1 with a simple configuration to transfer a workpiece heavier than the workpiece maximum weight Wmax which can be transferred at a rated velocity Vmax, and thus the robot control apparatus 100 can be structured at low cost.

(2) The maximum velocity is reduced by a larger amount as the workpiece parameter WP set by the setting unit 11 exceeds the rated workpiece parameter WP 1 stored in the storage unit 12 by a larger amount. This allows the maximum velocity Vx of the robot 1 to be set to an optimum value depending on the mass m of a workpiece, and thus workpieces can be transferred efficiently.

(3) The storage unit 12 further stores an upper-limit workpiece parameter WP 2 , which is an upper-limit parameter of the workpiece itself which can be transferred by the robot 1 and is greater than the rated workpiece parameter WP 1 , and the velocity limiting unit 13 will stop operations of the robot 1 when the workpiece parameter WP which has been set by the setting unit 11 is greater than the upper-limit workpiece parameter WP 2 . This prohibits the robot 1 from transferring a workpiece exceeding the transfer capability of the robot 1 , thereby preventing damage to the robot 1 , falling of a workpiece being transferred, and the like.

(4) When the workpiece parameter WP is defined by the mass m and inertia I of a workpiece, the velocity limiting unit 13 calculates a first maximum velocity Vx 1 with respect to the mass m and a second maximum velocity Vx 2 with respect to the inertia I respectively (the formulas (II) and (III) above) and sets the maximum velocity Vx to a value smaller of the two. In this way, taking into consideration a plurality of physical quantities, i.e., the mass m and inertia I, as constituents of a workpiece parameter WP makes it possible to comprehensively evaluate transferability of a workpiece at a rated velocity Vmax and appropriately define a maximum velocity Vx of the workpiece gripping unit of the robot 1 .

It should be noted that, although the above embodiment assumes that the setting unit 11 sets the mass m, inertia I, and the like of a workpiece as a workpiece parameter PR, any other physical quantity may be set as a workpiece parameter PR in so far as it represents a parameter affecting transferability of a workpiece itself to be transferred by the robot 1 . Although the above embodiment assumes that the maximum velocity Vx is reduced by a larger amount as the workpiece parameter WP set by the setting unit 11 exceeds the rated workpiece parameter WP 1 stored in the storage unit 12 by a larger amount (refer to FIG. 3 ), the velocity limiting unit 13 may be configured in any manner in so far as the maximum velocity Vx is reduced to a value lower than the rated velocity Vmax when the specified workpiece parameter WP is greater than the rated workpiece parameter WP 1 . It should be noted that the present invention may be applied to a robot for transferring various workpieces and that workpieces include not only various parts for assembly or machining but also tools and the like.

›DETAILED DESCRIPTION · 4 of 4

According to the present invention, the maximum velocity of an industrial robot is reduced to a value lower than the rated velocity when the workpiece parameter is greater than the rated workpiece parameter, thereby enabling the industrial robot to transfer a heavy object with a simple configuration without the need for adding a balancer or the like.

The above descriptions are provided by way of example only, and the present invention is not limited to the above-described embodiment and its example variations as far as features of the present invention are not compromised. Constituents of the above embodiment and example variations include those that are possibly or obviously replaced while maintaining the unity of the invention. In other words, any other possible embodiment within the scope of technical ideas of the present invention also falls within the scope of the present invention. In addition, the above embodiment may be arbitrarily combined with one or more of example variations.

Claims as granted

7 claims

Log in to read the claims of this application.

Log in to unlock

Classifications

1 codes
IPC · International Patent Classification
Section B — Performing operations; transporting
  • B25J9/16

Claim changes

Soon
Coming soonHow the claims changed between publication and grant

See which claims were amended, added or cancelled during examination, with every added and removed word marked.

AmendedAddedCancelledUnchanged

The published claims of this application are not paired with the granted ones in what we hold.

File wrapper

⤢ drag to zoomJul 2015Jan 2016Jul 2016Jan 2017Jul 2017Jan 2018Jul 2018Jan 2019Jul 2019Jan 2020USPTOApplicantNon-final rejectionResponse after non-finalApplicant-initiated interviewResponse after non-finalRequest for continued examination
USPTOApplicanthover for detail · click to open
Pendency
4.2 y
1,541 days filing → grant
Office actions
4
non-final + final
Responses
4
2 RCE
Interviews
1
examiner interview summaries
Examiner
Kenneth M Lo
art unit 2116 · TC 2100
Citations: 43 back · 0 forward

See the full prosecution history — every USPTO and applicant action on this file, in order.

Log in to unlock

Documents

Log in to open the documents of this file: the application as filed, every office action and response, the notice of allowance.

Log in to unlock

Chain of title

⤢ drag to zoom20162018202020222024202620282030203220342036Owner 1
Titlehover for detail · click to open

See the full assignment history — every owner this patent has passed through, with recordation dates and reel/frame numbers.

Log in to unlock