JP6044171B2 - Robot system - Google Patents

Description

  The present invention relates to a robot system for controlling an articulated robot that drives each arm using a gear mechanism.

  An articulated robot having a plurality of arms is provided with a plurality of driving units corresponding to the respective axes. Each drive unit has a motor for driving each shaft, and a gear mechanism for transmitting the output of the motor to an arm connected to the output shaft side. This gear mechanism employs, for example, a well-known wave gear device, and the structure itself is generally designed in common, although there is a difference that the number of teeth is different for each axis. Since such a gear mechanism may cause damage to the gear when the lubricant decreases, for example, Patent Document 1 proposes a countermeasure for sufficiently lubricating the gear in operation. ing.

JP 2009-79627 A

Now, industrial devices such as robots are generally assumed to have a useful life in advance, and are designed to withstand the useful life. Specifically, in the case of an articulated robot having a plurality of drive units as described above, the lifespan of each drive unit is designed to be substantially the same.
However, when the robot is actually installed and a predetermined work cycle is repeatedly executed, among the drive units whose service lives should generally match as described above, a specific drive unit is in a shorter period than expected. A failure may result in a decrease in the useful life of the entire robot.

  The present invention has been made in view of the above circumstances, and an object thereof is to suppress a failure in a specific drive unit in an articulated robot including a plurality of drive units, and may cause a decrease in the useful life of the robot. An object of the present invention is to provide a robot system capable of reducing the above.

  As a result of investigating the failed robot, the inventor found that the drive units that failed in a shorter period than expected were concentrated on the drive units that were not operating during the work cycle. In the case of an articulated robot, there is a possibility of performing various operations, so that a plurality of drive units are provided in consideration of versatility, but there are also drive units that do not operate at all depending on the work contents. However, since the gear mechanism does not operate unless the drive unit operates, the gear mechanism teeth are less likely to be worn or damaged. Generally speaking, the failure concentrates on the drive unit that is not operating. The situation is hard to think. Therefore, as a result of further detailed analysis of the process in which a failure occurs in the drive unit, the inventor concentrates the failure in the drive unit that is not operating because the configuration of the movable shaft is redundant with respect to the work content. We found that this is a phenomenon unique to articulated robots.

  In an articulated robot, vibration due to the operation of another driving unit or movement of an arm is transmitted to a non-operating driving unit. Since the robot repeatedly executes a predetermined work cycle, vibrations are repeatedly transmitted to a non-operating drive unit. The vibration is also transmitted to the gear mechanism of the drive unit that is not operating. As a lubricant for the gear mechanism, a lubricant having a relatively high viscosity is generally used, and the lubricant has a property close to a solid when the gear mechanism is not operating. For this reason, when vibration is transmitted to the gear mechanism, the lubricating oil is partially lost by the vibration, and a missing region where no lubricating oil is present between the teeth of the gear mechanism is first generated in a relatively small range. This missing area gradually expands as the work cycle is repeatedly executed, that is, when vibration is repeatedly transmitted. At that time, the engaged teeth are in direct contact with each other, and further vibrations are repeatedly transmitted in this state. As a result, the directly contacted teeth are damaged, resulting in a failure of the drive unit.

  Therefore, in the invention according to claim 1, the robot system includes a motor for driving each axis of the articulated robot and a drive unit having a gear mechanism for transmitting the output of the motor. An auxiliary drive command for driving the motor of the drive unit is output to each drive unit that has been determined that the elapsed time from the output of the command has exceeded a predetermined reference time. That is, the drive unit in which the non-operating state continues beyond the reference time is driven.

  As a result, when the drive unit, that is, the gear mechanism is operated, the lubricant is diffused each time, and the generated missing region is filled with the lubricant from other parts, so that the missing region is repaired and the missing region is expanded. It is possible to prevent the occurrence of the missing region and prevent the missing region from being compensated. As a result, the teeth of the gear mechanism do not directly contact each other, and even if vibration is transmitted along with the operation of the robot, it is possible to reduce the possibility of the gear being damaged or broken. Therefore, in an articulated robot having a plurality of drive units, a failure in a specific drive unit is suppressed, and the possibility of causing a decrease in the useful life of the robot can be reduced.

  In this case, the reference time may be appropriately set according to the characteristics of the lubricating oil W and the work cycle. For example, it can be set to be shorter than the expected time until the lubricating oil W is hardened, or to be shorter than the expected time until the missing region occurs. In addition, as described above, since the drive unit does not operate and the work cycle is repeatedly executed is a cause of the occurrence of the missing area, the number of work cycles × 1 cycle based on the number of executions of the work cycle. The reference time may be set based on the time during which the vibration is transmitted, for example, the time is the reference time.

In addition, during the movement operation, among the movement operation that places importance on the movement trajectory of the arm and the movement operation that places importance on the movement speed of the arm when moving the arm between preset teaching points, An auxiliary drive command for moving at least one tooth engagement position of the gear mechanism is output. Note that the work movement is when the arm is moved smoothly between teaching points when performing a control that moves the arm smoothly with a relative emphasis on the movement trajectory to perform work such as gripping or assembling the work. This operation is generally called a CP (Continuous Path) operation. In addition, the moving operation is an operation when performing a control to move quickly between teaching points with a relative emphasis on the moving speed when moving the arm between teaching points, in other words, an operation that places little importance on the trajectory. In general, this is called a PTP (Point To Point) operation. Hereinafter, for convenience, the work operation is referred to as a CP operation, and the movement operation is referred to as a PTP operation.

  Although it is possible to suppress the failure of the drive unit by operating the drive unit whose non-operating state has continued beyond the reference time as described above, in the case of a robot, consider when to drive the drive unit There is a need to. In other words, since the robot repeatedly executes a predetermined work cycle, if the robot is operated immediately after the reference time is exceeded, the trajectory of the arm may be affected. However, if it is operated at the end of the work cycle after the reference time elapses, it takes unnecessary time for the original work to execute the next work cycle, and the time required for performing the work ( Hereinafter, this will be referred to as a tact time). And if the tact time becomes longer, it takes more time to handle a predetermined amount of work. On the other hand, if the work time is determined in advance, the number of work cycles that can be executed decreases, and the production efficiency Decreases. For this reason, the robot is required to operate the target drive unit so as not to affect the tact time.

  Now, it is generally known that the CP operation and the PTP operation described above are included in the work cycle of the robot. Therefore, in order to operate the drive unit without affecting the tact time and without affecting the original work of the robot (without greatly affecting the trajectory of the arm), the operation is performed during the PTP operation. First of all, it can be considered. However, in order to spread the lubricant evenly, for example, if the operation of rotating the meshing position of the teeth of the gear mechanism is performed, the arm moves greatly, and no matter how much the trajectory is in the PTP operation However, there is a possibility that an arm, a hand, or a work held by the hand may collide with peripheral equipment. In other words, it is not a simple problem that when the drive unit should be operated during the PTP operation.

  Here, the analysis result by the inventor is effectively used. That is, the inventor has found that the missing region of the lubricant first occurs in a relatively small range as described above, and further, the missing region at the beginning of the occurrence has a size of less than one tooth. For this reason, in order to diffuse the lubricant into the missing region at the beginning of generation, it is only necessary to mesh with a portion where the lubricant is not missing, that is, if the meshing position of the gear mechanism teeth is moved by one or more teeth. It turned out to be good. In other words, it has become clear that it is not necessary to move the arm greatly in order to deal with the missing area at the beginning of the occurrence. Furthermore, since it is only necessary to move the meshing position by one or more teeth, it is considered that it can be sufficiently performed during the PTP operation.

  On the basis of such analysis results, in the robot system according to claim 2, the target drive unit is operated so as to move one or more teeth of the gear mechanism during the PTP operation. . As a result, it is possible to diffuse the lubricant in the missing area at the beginning of the occurrence, it is possible to suppress the enlargement of the missing area, and the lubricant is diffused if the drive unit operates, so the occurrence of the missing area It can be suppressed. Since the operation for diffusing the lubricant is an operation that can be performed during the PTP operation, the operation of the drive unit is completed during the PTP operation. Therefore, there is no influence such as an increase in tact time, and the possibility that the production efficiency is lowered can be suppressed.

In the second aspect of the present invention, when there are a plurality of PTP operations in the work cycle, the determination unit determines the PTP operation with the longest operation time, and the auxiliary command output unit performs the PTP operation with the longest operation time. Auxiliary drive command is output to. If the operation time is long, the drive unit operated by the auxiliary drive command can be surely returned to the original position, and the amount of movement of the meshing position during the PTP operation is increased. Therefore, the generation and expansion of the missing area can be further suppressed.

In the third and fourth aspects of the invention, the auxiliary drive command is output during a period in which it is determined that the workpiece is not transferred. Since the robot operates based on the given command, it cannot normally grasp what kind of workpiece is the target. Therefore, by outputting an auxiliary drive command at a time when it is determined that the workpiece is not transferred, even if a drive unit that is not assumed in the original work cycle is operated, the workpiece is a facility device. It does not cause problems such as collision.

The figure which shows schematically the structure of the robot system by 1st Embodiment of this invention. Schematic diagram showing the electrical configuration of the robot system Diagram showing gear mechanism The figure which shows an example of CP operation | movement and PTP operation | movement typically FIG. 4 is an enlarged view of a region V in FIG. 3, schematically showing a transition in a region where a lubricant is missing. Diagram showing control flow of robot system The figure which shows schematically the structure of the robot system by 2nd Embodiment of this invention.

(First embodiment)
Hereinafter, a first embodiment of the present invention will be described with reference to FIGS.
As shown in FIG. 1, a general industrial robot system 1 includes an articulated robot 2, a controller 3 for controlling the robot 2, and a teaching pendant 4 connected to the controller 3.

  The robot 2 has a well-known configuration as a so-called 6-axis vertical articulated robot, and the shoulder 6 rotates on the base 5 in the horizontal direction via a first axis (J1) having an axis in the Z direction. Connected as possible. A lower end portion of a lower arm 7 extending upward is connected to the shoulder 6 via a second shaft (J2) having an axis in the Y direction so as to be rotatable in the vertical direction. A first upper arm 8 is connected to the tip of the lower arm 7 via a third axis (J3) having an axis in the Y direction so as to be rotatable in the vertical direction. The second upper arm 9 is connected to the tip of the first upper arm 8 via a fourth axis (J4) having an X-axis axis so as to be able to rotate. A wrist 10 is connected to the tip of the second upper arm 9 via a fifth axis (J5) having an axis in the Y direction so as to be rotatable in the vertical direction. A flange 11 is connected to the wrist 10 via a sixth shaft (J6) having an X-direction axis so as to be able to rotate.

  The base 5, the shoulder 6, the lower arm 7, the first upper arm 8, the second upper arm 9, the wrist 10 and the flange 11 function as the arm of the robot 2, and the illustration of the flange 11 which is the tip of the arm is omitted. However, a hand (also called an end effector) is attached. For example, the hand holds and transfers a workpiece (not shown) or a tool for processing the workpiece is attached. Each axis (J1 to J6) provided in the robot 2 is provided with a drive unit 23 (see FIG. 2) corresponding to each axis.

  As shown in FIG. 2, the controller 3 includes a CPU 12, a ROM 13 and a RAM 14, a drive circuit 15, a position detection circuit 16, and the like. The CPU 12 controls the entire controller 3 based on a program stored in the ROM 13 or the RAM 14 and outputs various commands for causing the robot 2 to repeatedly execute a predetermined work cycle as is well known. To do. The CPU 12 includes a command unit 17, a determination unit 18, and an auxiliary command unit 19. The command unit 17, the determination unit 18, and the auxiliary command unit 19 are configured in software by a program executed by the CPU 12 in this embodiment. Note that the command unit 17, the determination unit 18, and the auxiliary command unit 19 may be configured in hardware.

The command unit 17 individually outputs a drive command for operating the drive unit 23 of the robot 2, that is, an execution command for driving the motor 20 (see FIG. 2), to each drive unit 23. The command unit 17 constitutes command means described in the claims.
The determination unit 18 individually determines whether or not the elapsed time from the output of the drive command exceeds a preset reference time, and the movement of the arm is a work operation (CP operation described above) or a movement operation. It is further determined whether it is any of the above-described PTP operations or whether a workpiece is held during the PTP operation. The determination part 18 comprises the determination means described in the claims. Hereinafter, the work operation is referred to as a CP operation, and the movement operation is referred to as a PTP operation.

The auxiliary command unit 19 outputs an auxiliary drive command for driving the motor to the drive unit 23 that has been determined that the elapsed time since the previous drive command was output has passed a predetermined reference time. . In the present embodiment, as an auxiliary drive command, an auxiliary drive command that can move one or more teeth in a gear mechanism of a gear mechanism of the speed reducer 22 described later is output. In this case, for example, in the robot 2 having a general configuration, when the gear ratio of the fourth axis (J4) = 100 and the distance from the center of the fifth axis (J5) to the tip of the hand = 200 mm, the motor rotates once (motor The output shaft of the hand rotates once, not the gear mechanism, but the tip of the hand moves only a maximum of about 13 mm (2π ÷ 100 × 200 = 4π). The auxiliary command unit 19 constitutes auxiliary command output means described in the claims.

  The drive circuit 15 is constituted by, for example, an inverter circuit that converts an instruction output from the CPU 12 into an electric signal for giving to the robot 2. The robot 2 includes a plurality of motors 20 for driving the first axis J1 to the sixth axis J6 and encoders 21 provided corresponding to the motors 20, respectively. The position detection circuit 16 receives a signal from the encoder 21 that detects the rotational position of the motor 20 and detects the rotational position of the motor 20. The CPU 12 feedback-controls the motor 20 based on the rotational position of the motor 20 detected by the position detection circuit 16.

  In the robot 2, the output of the motor 20 is transmitted to the arm via the speed reducer 22. The motor 20 and the speed reducer 22 constitute a drive unit 23. In FIG. 2, the shoulder 6, the lower arm 7, the first upper arm 8, the second upper arm 9, the wrist 10, and the flange 11 that are driven by the driving units 23 are indicated as arms for convenience. In the present embodiment, a so-called wave gear device is employed as the speed reducer 22.

  As shown in FIG. 3, the speed reducer 22 is provided with an annular rigid internal gear 31 having internal teeth 30 formed on the inner peripheral surface thereof, and is provided concentrically inside the rigid internal gear 31. A flexible external gear 33 having 32 is provided. Although not shown, the flexible external gear 33 is formed in a cup shape as a general shape as is well known, and an output shaft is attached to the cup-shaped bottom portion. Further, between the internal teeth 30 of the rigid internal gear 31 and the external teeth 32 of the flexible external gear 33, a lubricating oil W (see FIG. 5) as a lubricant is filled. This lubricating oil W generally has a relatively high viscosity. If the rigid internal gear 31 and the flexible external gear 33 are operating, the lubricating oil W diffuses between the gears and functions as a lubricant. If not, it will be almost solid. Note that the lubricant is not limited to oil, but may be other.

  A wave bearing 34 is disposed on the inner peripheral side of the outer teeth 32. The wave bearing 34 includes a flexible outer ring 35, a flexible inner ring 36, and a plurality of balls 37 arranged between the flexible outer ring 35 and the flexible inner ring 36. An elliptical rigid cam 38 is fixed on the inner side of the wave bearing 34, that is, on the inner periphery of the flexible inner ring 36. The rigid cam 38 is formed with a fitting hole 40 with a key groove 39 for connecting the output shaft of the motor 20.

  In the speed reducer 22 having such a configuration, the flexible inner ring 36 and the flexible outer ring 35 of the wave bearing 34 are bent in an elliptical shape, and the flexible outer ring 35 is bent in an elliptical shape, whereby the external teeth 32. The forming part is bent into an oval shape. As a result, the external teeth 32 partially mesh with the internal teeth 30 of the rigid internal gear 31 at two locations on both ends in the major axis direction of the elliptically bent portion. When the rigid cam 38 is rotationally driven by the motor 20, the long diameter portion of the flexible external gear 33 bent in an elliptical shape moves in the circumferential direction, and the meshing position of the external teeth 32 with respect to the internal teeth 30. Moves in the circumferential direction. At this time, since the external teeth 32 are set to be, for example, two fewer than the internal teeth 30, the relative movement between the rigid internal gear 31 and the flexible external gear 33 is increased with the movement of the meshing position. Rotation occurs. Then, the speed reduction rotation of the motor 20 is taken out using the flexible external gear 33 as an output shaft.

  As shown in FIG. 1, the teaching pendant 4 is formed in, for example, a thin, substantially rectangular box shape, and is generally large enough to be carried or carried by the user. The teaching pendant 4 is provided with various key switches and a touch panel, and the user performs various input operations using the key switches and the touch panel. The teaching pendant 4 is connected to the controller 3 via a cable, and performs high-speed data transfer with the controller 3 via a communication interface. The teaching pendant 4 is input by operating a key switch or the like. Information such as operation signals is transmitted from the teaching pendant 4 to the controller 3.

Here, a work cycle executed by the robot 2 will be described.
The work cycle is a work in which, for example, transfer of a workpiece is repeatedly performed via a predetermined teaching point. For example, in FIG. 4, after the teaching point P1 is moved to the teaching point P2 with the teaching point P1 as the initial position, the workpiece is picked up at the teaching point P3, and the teaching point P4 is passed through the teaching points P2 and P1 while holding the workpiece. A work cycle for placing a work is schematically shown. More specifically, the arm moves greatly in the horizontal direction between the teaching points P1 and P2, and the arm moves vertically between the teaching points P2 and P3 and between P1 and P4.

  In this case, for example, when the arm moves horizontally, the first axis (J1) is driven, and when the arm moves vertically, for example, the second axis (J2), the third axis (J3), and the fifth axis (J5). ) Shall be driven. Further, between the teaching points P1 and P2 where the arm moves greatly in the horizontal direction, a PTP operation is performed with an emphasis on the moving speed, and between the teaching points P2 and P3 where the workpiece is picked up from a predetermined position and the workpiece is placed at a predetermined position. It is assumed that a CP operation is performed between teaching points P1 and P4 with an emphasis on the movement trajectory in order to increase positioning accuracy.

  In the work cycle shown in FIG. 4, since the operation of twisting the arm (the operation of driving the fourth axis (J4)) is not required, the fourth axis (J4) is not operating. In other words, no drive command is output to the drive unit 23 provided corresponding to the fourth axis (j4) during the work cycle. Hereinafter, in the present embodiment, the drive unit 23 that does not operate during the work cycle, such as the drive unit 23 provided corresponding to the fourth axis (J4), is referred to as a non-operation drive unit for convenience, and does not operate. Is referred to as a non-operating state.

  In the non-operation drive unit, when the work cycle is repeatedly executed, the internal teeth 30 of the rigid internal gear 31 and the external external gear 33 are externally connected as shown in FIGS. There is a possibility of direct contact with the teeth 32. Specifically, when the lubricating oil W filled between the inner teeth 30 and the outer teeth 32 is normally diffused as shown in FIG. 5A, the non-operating state continues. The lubricating oil W gradually becomes close to solid. When the work cycle is repeatedly executed in this state, that is, when vibrations from the other drive unit 23 and the robot 2 itself are transmitted to the non-operation drive unit, as shown in FIG. The lubricating oil W is partially missing with a size of less than that, and the missing region R is formed. FIG. 5B shows the state of the missing region R at the beginning of occurrence.

  When the work cycle is repeatedly executed in this state, the missing region R gradually expands as shown in FIG. When the missing region R becomes larger in this way, the inner teeth 30 and the outer teeth 32 come into direct contact. When the work cycle is repeatedly executed and vibration is transmitted, the inner teeth 30 and the outer teeth 32 repeat contact, and as a result, as shown in FIG. Damaged sites K such as chipping are formed. In this state, since there is a damaged portion K, for example, when the work cycle is changed and the non-operation drive unit is driven, it does not operate normally and a failure occurs.

As described above, in the articulated robot 2, the work cycle may be repeatedly executed in a state where the specific drive unit 23 does not operate at all, and since it is not operated, the useful life is not affected. In the driving unit 23 which is considered to be, a phenomenon that the service life is warped and decreases may occur. This phenomenon is a problem peculiar to the articulated robot 2 in which the drive shaft has a redundancy with respect to the work content.
Therefore, the robot system 1 addresses this problem as follows. As described above, in the present embodiment, the fourth axis (J4) is assumed as the non-operation drive unit, and therefore the fourth axis (described as “fourth axis” in FIG. 6) will be described.

  The controller 3 of the robot system 1 repeatedly executes the process shown in FIG. 6, and when an operation command is started (when a drive command is output), it is determined whether or not the fourth axis is operated ( S1) When the fourth axis operates (S1: YES), the timer is cleared (S5). This timer is a timer that measures an elapsed time since the fourth axis operated last time. Thus, every time the fourth axis operates, the controller 3 repeats the measurement of the elapsed time since the previous operation. In this embodiment, the reference time is set to 1 minute. This is because the non-operation drive unit is operated every work cycle because a general work cycle is completed within approximately one minute.

  On the other hand, if the controller 3 determines that the fourth axis does not operate (S1: NO), it determines whether or not the current start supplement method (that is, the arm movement mode) is a PTP operation (S2). ), If the PTP operation is not performed (S2: NO), the process is terminated as it is, whereas if the PTP operation is performed (S3: YES), whether or not the reference time has elapsed, that is, the elapsed time since the previous operation is the reference It is determined whether or not the time has been exceeded (S3). If the reference time has elapsed (S3: YES), an auxiliary drive command is output to operate the fourth axis during the PTP operation (S4). In this case, as described above, the operation of the drive unit 23 according to the auxiliary drive command is sufficient because the meshing position of the rigid internal gear 31 and the flexible external gear 33 is moved by one tooth. The operation on the fourth axis in step S4 ends during the PTP operation. If the reference time has not elapsed (S3: NO), the process is terminated as it is.

  Thus, in the robot system 1, vibration is transmitted in a non-operating state by operating the driving unit 23 corresponding to the fourth axis (J4), which is a non-operating driving unit that does not operate in the original work cycle. In the initial stage of occurrence, the lubricating oil W can be replenished with respect to the missing region R generated by the above, and the non-operating drive unit is driven to promote the diffusion of the lubricating oil W, thereby The occurrence itself is suppressed.

According to this embodiment described above, the following effects can be obtained.
The elapsed time from the output of the previous drive command is measured, and the non-operating drive unit, which is the drive unit 23 that has been determined to have exceeded the reference time, drives the motor 20 of the drive unit 23. Output auxiliary drive command. In this way, by operating the drive unit 23 that does not operate during the original work cycle, that is, the speed reducer 22, the diffusion of the lubricating oil W in the speed reducer 22 is promoted along with the operation, and the missing region R is generated. And expansion is suppressed. That is, the teeth of the rigid internal gear 31 and the flexible external gear 33 are not in direct contact. Therefore, even if vibration is transmitted to the non-operation drive unit, the possibility of tooth damage or breakage is reduced, and the occurrence of a failure in the non-operation drive unit, that is, the specific drive unit 23 can be suppressed. In addition, it is possible to reduce the risk of a decrease in the service life of the robot.

  When operating the non-operation drive unit, the meshing position of the rigid internal gear 31 and the flexible external gear 33 of the drive unit 23 is moved so as to move one or more teeth, as shown in FIG. Thus, the lubricating oil W can be diffused into the missing region R at the beginning of occurrence, and the expansion of the missing region R can be suppressed. Moreover, since the diffusion of the lubricating oil W is promoted when the driving unit 23 operates, the occurrence of the missing region R itself can be suppressed.

At this time, since the non-operation drive unit is operated during the PTP operation, there is no influence such as an increase in the tact time, and in order to diffuse the lubricating oil W, as described above, the meshing position Therefore, the operation of the drive unit 23 can be reliably completed during the PTP operation, and a reduction in production efficiency can be suppressed. Further, since the movement is performed during the PTP operation, the original trajectory of the robot 2 is not affected.
In this embodiment, since the reference time is set to 1 minute, the drive unit 23 operates approximately every work cycle. Thereby, since it is assumed that the non-operation drive unit operates before the missing region R occurs, the occurrence of the missing region R can be prevented more reliably.

(Second Embodiment)
In the first embodiment, a 6-axis vertical articulated robot is illustrated, but the present invention may be applied to a 4-axis horizontal articulated robot as shown in FIG. In addition, the same code | symbol is attached | subjected to the site | part substantially common with 1st Embodiment, and detailed description is abbreviate | omitted.

As shown in FIG. 7, the robot 62 constituting the robot system 61 can rotate around a base 63 fixed to the installation surface and a first axis (J61) having an axis in the Z direction on the base 63. A first arm 64 coupled to the first arm 64, a second arm 65 coupled to the tip of the first arm 64 so as to be rotatable about a second axis (J62) having an axis in the Z direction, and a second arm A shaft 66 is provided at the tip end portion of the shaft 65 so as to be movable up and down (arrow A direction) and rotatable about a third axis (J63) having an axis center in the Z direction. A flange 67 for attaching a tool or the like is positioned and attached to the front end (lower end) of the shaft 66 so as to be detachable.
Even in such a configuration, by performing the same processing as in FIG. 6 of the first embodiment, the lubricating oil W is diffused along with the operation of the non-operation drive unit, and the expansion and occurrence of the missing region R are suppressed. For example, the same effects as those of the first embodiment can be obtained.

(Other embodiments)
The present invention is not limited to the above-described embodiments, and the following modifications or expansions are possible.
In each embodiment, the wave gear device is exemplified as the speed reducer 22, but the present invention can be applied to other configurations as long as the gear is used.
In each embodiment, the non-operation drive unit is operated by the PTP operation at the time when the reference time elapses. However, when there are a plurality of PTP operations in the work cycle, the PTP operation having the longest operation time is determined in advance. In addition, the auxiliary drive command may be output during the PTP operation with the longest operation time. If the operation time is long, the drive unit 23 operated by the auxiliary drive command can be surely returned to the original position, so that the original work is not affected. Also, if the operation time is long, the amount of movement of the meshing position during the PTP operation can be increased, so that the generation and expansion of the missing region R can be further suppressed.

  In that case, the operation amount of the non-operation drive unit may be adjusted according to the operation time of the PTP operation. For example, if the operation time of the PTP operation is long, the operation amount may be increased. This is because if the operation time is long, it can be returned to the original meshing position by the end of the PTP operation. In this way, the diffusion of the lubricating oil W can be further promoted and can be reliably prevented from the occurrence of the missing region R.

  In each embodiment, only whether or not the operation is a PTP operation is determined. However, a process for determining whether or not a workpiece is held is further added to the processing of FIG. ) An auxiliary drive command for driving the non-operation drive unit during the PTP operation may be output. In this way, even if the drive unit 23 operates at a timing that is not assumed in the original work cycle, there is no problem that the work collides with the equipment device due to the operation.

In the first embodiment, the fourth axis (J4) is targeted. However, the same processing as in FIG. 6 is performed for other axes, so that all of the plurality of drive units 23 provided in the robot 2 are treated. On the other hand, when it is determined as a non-operation drive unit, it can be operated, and the same effect as in the first embodiment can be obtained.
Of course, the same processing as in FIG. 6 is executed simultaneously for all axes, and auxiliary drive commands are individually output during the same work cycle to all the drive units 23 determined to be non-operation drive units. It may be. In that case, when a plurality of non-operation drive units are specified, an auxiliary drive command may be output during the same PTP operation, or an auxiliary drive command may be output in different PTP operations. .

In each embodiment, the lubricating oil W is exemplified as having a property close to an individual in a non-operating state. However, the lubricating oil W may always have a liquid property. In this case, since it may be considered that the part where the amount of the lubricating oil W is reduced, that is, the part where the lubricating oil W is cut out corresponds to the missing region R, the same processing as in FIG. The effect of can be obtained.
In the first embodiment, a 6-axis robot is illustrated, and in the second embodiment, a 4-axis robot is exemplified. However, the present invention can also be applied to a robot having a different number of axes such as a 7-axis robot.
In each embodiment, it is determined whether or not a drive command is output to the drive unit 23. However, whether or not the motor 20 is driven indirectly from the rotational position of the motor 20 detected by the encoder 21 is determined. It is good also as a structure to determine.

  In the drawings, 1 is a robot system, 2 is a robot, 6 is a shoulder (arm), 7 is a lower arm (arm), 8 is a first upper arm (arm), 9 is a second upper arm (arm), and 10 is a wrist (Arm), 17 is a command section (command output means), 18 is a determination section (determination means), 19 is an auxiliary command section (auxiliary command output means), 20 is a motor, 22 is a speed reducer (gear mechanism), and 23 is A drive unit, 61 is a robot system, 62 is a robot, 64 is a first arm (arm), 65 is a second arm (arm), 66 is a shaft (arm), and J1 to J6 and J61 to J64 are axes.

Claims (4)

A robot system for controlling an articulated robot capable of repeatedly executing a predetermined work cycle by driving a plurality of arms rotatably connected to each other,
A plurality of driving units provided on each axis of the robot, each having a motor for driving each axis, and a gear mechanism for transmitting the output of the motor to the arm connected to the output shaft side;
Command output means for individually outputting a drive command for driving the motor of the drive unit to the plurality of drive units;
Determination means for individually determining whether or not an elapsed time after the drive command is output exceeds a preset reference time for the plurality of drive units,
To said drive unit for the elapsed time is determined to have exceeded the reference time among the plurality of the driving portion, and the assist command output means for outputting an auxiliary driving command for driving the motor of the drive unit, the Prepared,
In the work cycle, when the arm is moved between preset teaching points, a work operation that places importance on the movement trajectory of the arm, and a movement operation that places importance on the movement speed of the arm, Contains
The determination means further determines whether the movement of the arm is the work operation or the movement operation;
The robot system characterized in that the auxiliary command output means outputs an auxiliary drive command for moving at least one tooth engagement position of the gear mechanism during the moving operation in the work cycle . The determination means further determines which is the moving operation with the longest operation time when a plurality of the moving operations are included in the work cycle,
The robot system according to claim 1, wherein the auxiliary command output unit outputs the auxiliary driving command during the moving operation determined to be the longest by the determination unit. The determination means further determines whether or not the work to be worked is transferred,
3. The robot system according to claim 1, wherein the auxiliary command output unit outputs the auxiliary driving command during a period in which the determination unit determines that the workpiece is not transferred. A robot system for controlling an articulated robot capable of repeatedly executing a predetermined work cycle by driving a plurality of arms rotatably connected to each other,
A plurality of driving units provided on each axis of the robot, each having a motor for driving each axis, and a gear mechanism for transmitting the output of the motor to the arm connected to the output shaft side;
Command output means for individually outputting a drive command for driving the motor of the drive unit to the plurality of drive units;
Determination means for individually determining whether or not an elapsed time after the drive command is output exceeds a preset reference time for the plurality of drive units,
Auxiliary command output means for outputting an auxiliary drive command for driving the motor of the drive unit to the drive unit determined that the elapsed time has exceeded the reference time among the plurality of drive units; Prepared,
  The determination means further determines whether or not the work to be worked is transferred,
The robot system characterized in that the auxiliary command output means outputs the auxiliary drive command during a period when the determination means determines that the workpiece is not transferred.

Images