Robotic system
By installing sensors on the collaborative robot to detect and store the reference external force value, determine whether it exceeds the threshold value, the problem of accidentally stopping when load changes is solved, and continuous action without preset mode is achieved, improving operation convenience and flexibility.
Patent Information
- Application Number
- CN201911010609.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2018-11-20
- Filing Date
- 2019-10-23
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2039-10-23
Smart Images

Figure CN111098290B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to robotic systems. Background Art
[0002] Currently, there is known a collaborative robot that has a contact stop function for stopping the robot as soon as it comes into contact with a person, stores a specified reference force, and stops the robot when the detected external force is greater than the stored reference force (for example, refer to Patent Document 1).
[0003] Prior art documents
[0004] Patent Literature
[0005] Patent Document 1: Japanese Patent Application Publication No. 2018-51734 Summary of the invention
[0006] Problem that the invention aims to solve
[0007] For the collaborative robot of Patent Document 1, when the magnitude of the load being operated changes greatly, the robot is mistakenly detected as a large external force exceeding the reference force, and the collaborative robot stops due to the contact stop function. Therefore, if the load change pattern is known, it is necessary to set the load change pattern itself in advance. In this case, there is the inconvenience of having to set the load change pattern itself in advance.
[0008] The present invention is proposed in view of the above problems and aims to provide a robot system which can operate continuously without erroneously stopping due to a contact stop function without presetting a load change pattern even when the load operated by the robot body changes significantly.
[0009] Solutions to the problem
[0010] A robot system according to one embodiment of the present invention comprises: a robot body; a sensor for detecting the magnitude of an external force applied to the robot body; a control unit for controlling the robot body; a reference value storage unit for storing, when the robot body is in an operating state in which only the self-weight of the robot body and a load operated by the robot body act on the robot body, the value of the external force detected by the sensor as a reference external force value; and a determination unit for determining that an external force other than the self-weight and the load is acting on the robot body when, during the operation of the robot body, the absolute value of the difference between the value of the external force detected by the sensor and the reference external force value stored in the reference value storage unit is greater than a prescribed threshold value.
[0011] According to this scheme, the sensor detects the magnitude of the external force applied to the robot body in the action state in which only the deadweight of the robot body and the load operated by the robot body act, and the value of the detected external force is stored in the reference value storage unit as a reference external force value. In addition, during the action of the robot body, the absolute value of the difference between the value of the external force detected by the sensor and the reference external force value stored in the reference value storage unit is calculated, and when the absolute value of the difference is greater than a threshold value, the determination unit determines that an external force other than the deadweight and the load operated is acting on the robot body.
[0012] That is, as the reference external force value, the magnitude of the external force detected by the sensor at each position of the robot body's motion in the motion state where only the robot body's own weight and the load operated by the robot body act on the robot body can be used. Therefore, even when the load operated by the robot body changes greatly, there is no need to set the reference external force value in advance, and the robot can continue to operate without an erroneous stop due to the contact stop function.
[0013] In the above aspect, the reference value storage unit may update the reference external force value at a plurality of locations on the motion path of the robot body.
[0014] According to this structure, in the operation state where only the deadweight of the robot body and the load operated by the robot body act on multiple locations on the operation path of the robot body, the magnitude of the external force applied to the robot body is detected by the sensor, and the value of the detected external force is stored in the reference value storage unit as a reference external force value. Thus, even if the pattern of the external force change at each position along the operation path of the robot body is uncertain and the load operated by the robot body changes greatly, the operation can be continued without an erroneous stop due to the contact stop function based on the reference external force values actually detected at multiple locations.
[0015] In the above aspect, the reference value storage unit may store the reference external force value when the robot body is in a stopped state or a low-speed operation state.
[0016] According to this configuration, it is possible to easily achieve a stopped state or a low-speed operation state of the robot main body in which only the deadweight of the robot main body and the operation state of the robot main body act.
[0017] In addition, in the above scheme, the sensor may be any one of at least one force sensor, torque sensor or skin sensor built into or attached to the robot body.
[0018] According to this configuration, in an operating state where only the deadweight of the robot body and a load operated by the robot body act, it is possible to detect the external force acting on the robot body with high accuracy.
[0019] In the above aspect, the reference value storage unit may store the reference external force value every time the robot main body manually operated by an operator enters a stopped state or a low-speed operation state.
[0020] According to this structure, when the load size changes significantly during teaching operation or manual guidance of directly operating the robot body or when the operator manually moves the robot body, whenever the robot body is in a stopped state or a low-speed movement state, the reference external force value detected by the sensor is stored in the reference value storage unit. This allows the robot to continue operating without having to obtain the reference external force value in advance and without an erroneous stop due to the contact stop function.
[0021] Moreover, in the above scheme, during the implementation of the teaching program, the reference value storage unit can also store the reference external force value at any teaching point set in the teaching program, or by putting the robot body into a stopped state or a low-speed movement state at each specified time interval or specified moving distance.
[0022] According to this structure, at an appropriate time when the teaching program is implemented, the reference external force value that causes the robot body to be in a stopped state or a low-speed operation state is detected and stored. As a result, when the load operated by the robot body changes significantly, it is not necessary to obtain the reference external force value in advance during the teaching operation, and the operation can be continued without an erroneous stop due to the contact stop function.
[0023] Furthermore, in the above aspect, the reference value storage unit may automatically update the reference external force value when the robot body is in a stopped state or a low-speed operation state.
[0024] In the above aspect, the reference value storage unit may store the reference external force value when a person is not in contact with the robot body and in an operating state where only the deadweight of the robot body and the load operated by the robot body act.
[0025] Effects of the Invention
[0026] According to the present invention, when the load operated by the robot body changes greatly, it is possible to achieve an effect of continuing the operation without causing an erroneous stop due to the contact stop function without setting a load change pattern in advance. BRIEF DESCRIPTION OF THE DRAWINGS
[0027] Figure 11 is a diagram showing the overall configuration of a robot system according to an embodiment of the present invention.
[0028] Figure 2 It is shown Figure 1 A block diagram of a control device included in a robot system.
[0029] Figure 3 The figure shows the initial position of the operation of installing the motif body to the robot by the robot system.
[0030] Figure 4 It is shown from Figure 3 The state of falling hand grabbing the first position of the line body.
[0031] Figure 5 It is shown from Figure 4 The state of lifting the hand is shown in the figure halfway through the line body.
[0032] Figure 6 It is shown from Figure 5 The state of fully lifting the second position diagram of the line body.
[0033] Figure 7 It is shown in Figure 6 The second position starts in the figure showing the state of the robot on the outfitting line body.
[0034] Figure 8 It is shown that the hand is moved from Figure 7 The second position is slightly lower than the third position in the figure.
[0035] Fig. 9 It is shown in Figure 8 FIG. 3 is a diagram showing the state of the outfitting line body on the robot in the third position.
[0036] Fig.10 It is shown in Figures 3 to 9 action, a graph showing the update position of the external force value detected by the sensor and the reference external force value, and the change in the reference external force value + threshold.
[0037] Fig.11 It is shown in Figure 1 This is a diagram showing the state of updating the reference external force value when light workpieces are slightly lifted during multi-variety palletizing of a robot system.
[0038] Fig.12 It is shown in Fig.11 , a diagram showing the state of updating the reference external force value when a heavy workpiece is replaced.
[0039] Fig.13 It is a flow chart explaining the method of outfitting the line body.
[0040] Description of Reference Numerals
[0041] 1 Robotic system
[0042] 2 Robot body
[0043] 21 Sensors
[0044] 31 Control unit (processor)
[0045] 32 Reference value storage unit (memory)
[0046] 34. Judgment unit (processor) DETAILED DESCRIPTION
[0047] Hereinafter, a robot system 1 according to an embodiment of the present invention will be described with reference to the drawings.
[0048] A robot system 1 according to the present embodiment is a system including a collaborative robot (hereinafter referred to as a robot main body) 2 that can operate in a shared work area with a human without requiring a safety fence.
[0049] like Figure 1 As shown, the robot system 1 includes a robot body 2 and a control device 3 for controlling the robot body 2 .
[0050] Robot body 2, in Figure 1 In the illustrated example, a vertical articulated robot is shown, but any other form may be adopted.
[0051] The robot body 2 is provided with a sensor 21 for detecting the magnitude of an external force. As the sensor 21, at least one of a force sensor, a torque sensor, or a skin sensor built into or attached to the robot body 2 may be used. In this embodiment, for the sake of simplicity, the sensor 21 is disposed on the lower side of the first axis of the robot body 2.
[0052] The sensor 21 can detect external forces such as the weight of the robot body 2 itself and the load caused by the operation of the robot body 2, for example, the load added to the robot body 2 due to contact by an operator or the contact of the robot body 2 with other surrounding objects.
[0053] The control device 3 includes a processor and a memory.
[0054] The control device 3 includes a control unit (processor) 31, which controls the movement of the robot body 2 when a previously taught teaching program is implemented. The operator operates a teaching operation panel (not shown) and inputs an operation input to control the robot body 2 to perform a jog feed movement.
[0055] In addition, if Figure 2As shown, the control device 3, in a specific action state in which only the weight of the robot body 2 and the load operated by the robot body 2 act on the robot body 2, comprises: a reference value storage unit (memory) 32, which stores the value of the external force detected by the sensor 21 as a reference external force value; a difference calculation unit (processor) 33, which calculates the difference between the value of the external force detected by the sensor 21 during the action of the robot body 2 and the reference external force value; and a determination unit (processor) 34, which determines whether the absolute value of the difference calculated by the difference calculation unit 33 is greater than a specified threshold value.
[0056] The control unit 31 has a contact stop function for stopping the movement of the robot body 2 and a function for reducing the speed of the robot when the determination unit 34 determines that the absolute value of the difference is larger than a predetermined threshold value.
[0057] The specific operation state is a stop state or a low-speed operation state of the robot body 2 , and the timing of storing the reference external force value in the reference value storage unit 32 differs depending on the operation plan of the robot body 2 .
[0058] For example, in an action scenario in which the robot body 2 is manually driven by operation of the teaching operation panel, in the middle of the micro-feeding action of the robot body 2, whenever the robot body 2 is in a stopped state or a low-speed action state, the external force value detected by the sensor 21 can be stored as the reference external force value. Alternatively, according to the operator's teaching, it can be stored at any time.
[0059] In addition, for example, in an action plan in which the robot body 2 automatically runs according to a teaching program, instructions for putting the robot body 2 in a stopped state or a low-speed action state are taught at multiple appropriate teaching points in the teaching program, and specific action states are achieved in multiple locations on the action path. At this time, the external force value detected by the sensor 21 can be stored as a reference external force value.
[0060] The operation of the robot system 1 according to the present embodiment having the above-described configuration will be described below.
[0061] When the robot system 1 of this embodiment is used to perform a task that causes a large change in the size of the load operated by the robot main body 2, for example, Figures 3 to 9 As shown, there can be mentioned an operation of outfitting the long flexible fascicle 4 to other devices 5 such as other robots.
[0062] In this operation, the robot body 2 is provided with a hand 22 at its front end, and the robot body 2 is driven according to a teaching program.
[0063] The action of the robot body 2 is, first, Figure 3 As shown, from the state configured in the initial position, such as Figure 4 As shown, the hand 22 is lowered to the first position in the tray 6, and the hand 22 is used to grasp the end of the line body 4 accommodated in the tray 6. Figure 6 As shown, next, with the distal end of the umbilical body 4 grasped, the hand 22 is raised to a sufficiently high second position as a raised state, which serves as a standby state for waiting for an operation input by the operator.
[0064] like Figure 8 As shown, and when the operator performs an operation input, the hand 22 is moved to a third position lower than the second position, and at this position, it is again in a standby state for waiting for the operator's operation input. When it drops to the third position, the end of the line body 4 grasped by the hand 22 is released and returned to the initial position to end the operation.
[0065] like Fig.10 As shown, in this operation, Figure 3 From the initial position to the point where you grab line 4 Figure 4 Between the first position, only the weight of the robot body 2 and the weight of the hand 22 act on the sensor 21. At the initial position, the value of the external force detected by the sensor 21 is stored in the reference value storage unit 32 as the initial reference external force value.
[0066] Next, at the first position, the robot body 2 moves from the first position where the sensor 22 grasps the line body 4 to the second position. As the line body 4 in the tray 6 is gradually lifted, the value of the external force detected by the sensor 21 will gradually increase. The external force value is detected by the sensor 21 within a specified time interval, and the difference between the detected external force value and the reference external force value stored in the reference value storage unit 32 is calculated by the difference calculation unit 33. The determination unit 34 determines whether the absolute value of the calculated difference exceeds the specified threshold. If the absolute value of the difference exceeds the threshold, the contact stop function of the control unit 31 stops the movement of the robot body 2.
[0067] In this embodiment, in addition to the initial position where the robot body 2 stops and the teaching points set at various positions from the first position to the third position, Figure 5 As shown, a teaching point is provided at each position where the absolute value of the difference between the first position and the second position does not exceed the threshold value. The number of teaching points is arbitrary. Moreover, at each teaching point, an instruction for implementing a specific action state is taught, and at this time, an instruction for updating the value of the reference value storage unit 32 using the value of the external force detected by the sensor 21 as a new reference external force value is taught.
[0068] Next, if Figure 7As shown, in the second position, since the lower end of the suspended filament body 4 is outfitted to other devices 5, the weight of the filament body 4 supported by the hand 22 gradually decreases, and the external force value detected by the sensor 21 decreases. At this time, it is determined that the weight change of the filament body 4 caused by the outfitting operation in the second position does not exceed the threshold value.
[0069] Furthermore, when the outfitting of the line body 4 at the second position is completed, the operator performs operation input on the teaching operation panel, such as Fig.10 As shown, after the reference external force value is updated again, the robot body 2 moves from the second position to Figure 8 The third position shown in FIG. 4 is thus formed to relax the line body 4 for outfitting in the third position.
[0070] When the robot body 2 moves to the third position and stops and is in a standby state, the external force value detected by the sensor 21 will be used as a new reference external force value to update the value of the reference value storage unit 32. Fig. 9 As shown in FIG. 1 , the weight change associated with the line body 4 installed at the third position is also determined to be less than the threshold. Fig.10 As shown, after the line body 4 is released at the third position, the reference external force value is updated again, and the updated reference external force value is used to return to the initial position.
[0071] Thus, according to the robot system of this embodiment, in an operation in which the size of the load operated by the robot body 2 changes continuously, even if the size of the load changes beyond the threshold for activating the contact stop function, there is no need to pre-set a corresponding change pattern, and the system has the advantage of continuing the operation without causing an erroneous stop due to the contact stop function.
[0072] That is, when a specific action state is achieved in the action of the robot body 2, the external force value detected by the sensor 21 is updated as the reference external force value of the contact stop function, and there is no need to pre-set the load change pattern. In addition, there is an advantage that the contact stop function can be maintained while the operation is continued even if the load change pattern has not been determined.
[0073] In addition, in the present embodiment, in the operation of implementing the teaching program, although it is determined that a specific action state is achieved at the teaching point appropriately set in the teaching program, and the external force value detected by the sensor 21 is automatically updated as the reference external force value, it is also possible to replace it, in the operation where the operator operates the teaching operating panel to manually move the robot body 2, it can be determined that whenever the robot body 2 is in a stopped state or a low-speed action state, the reference external force value is updated according to the external force value detected by the sensor 21.
[0074] Moreover, if Fig.10As shown, in the present embodiment, a specific action state is realized at seven teaching points and the reference external force value is updated, but the frequency of updating may be increased instead. Thus, the threshold value can be lowered and the sensitivity of the contact stop function can be improved.
[0075] In addition, when a person does not touch the robot body 2, and in a specific action state where only the weight of the robot body 2 and the load operated by the robot body 2 act on the robot body 2, as long as the reference external force value can be stored, a more accurate reference external force value can be recorded. As a result, the threshold value can be lowered and the sensitivity of the contact stop function can be improved. For a situation where no person touches the robot body 2, a laser area sensor and a visual sensor set around the robot body 2 can be used to detect the approach of a person.
[0076] Moreover, in the present embodiment, as in the case of lifting the soft line body 4, an example is given of an operation in which the load changes continuously, but this is not limited to this. Fig.11 as well as Fig.12 As shown, the present invention can also be applied to a case where the weight of the grasped workpieces W1 and W2 changes.
[0077] For example, in a multi-variety palletizing operation, when changing and grasping two weights of workpieces W1 and W2, Fig.11 as well as Fig.12 As shown, when each workpiece W1 , W2 is grasped by the hand 22 and slightly lifted, a specific action state is achieved, and at this time, the reference external force value can be updated by the external force detected by the sensor 21 .
[0078] Moreover, the same can be applied when replacing workpieces of three or more weights. In this case, the weight difference of all workpieces can be made smaller than the threshold, and when the replacement order is specified, the weight difference of workpieces with adjacent weights can be made smaller than the threshold. In this case, by further reducing the threshold, the sensitivity of the contact stop can be improved.
[0079] In addition, in this embodiment, the following method of outfitting the fascia 4 is also shown.
[0080] In the past, the outfitting of the trolley body was performed by a long operator lifting the heavy trolley body and carrying out the work in order from the bottom of other equipment. However, when multiple trolley bodies are bundled together, or when a trolley body for large current is included, or when a trolley body with a metal plate or a switchboard installed to fix the trolley body is operated, the weight of the trolley body will increase, which may put a heavy burden on the operator.
[0081] In contrast, the outfitting method of the line body 4 is to repeat the steps of an operator performing a part of the outfitting operation of the line body 4 from the other end of the line body 4 to another device 5 while grasping and lifting one end of the line body 4 through the hand 22 installed at the front end of the robot body 2, and the step of lowering the hand 22 to the amount required for the subsequent outfitting operation through the action of the robot body 2 so that the line body 4 is in a relaxed position.
[0082] like Fig.13 Specifically, from the state configured in the initial position, as shown Figure 4 As shown, the hand 22 is lowered to the first position in the tray 6 (step S1), and the end of the line body 4 accommodated in the tray 6 is grasped by the hand 22 (step S2). Figure 6 As shown, the hand 22 is raised to a sufficiently high second position as a raised state (step S3), and this position is used as a standby state for waiting for an operation input by the operator (step S4).
[0083] And, if Figure 8 As shown, the hand 22 is moved to the third position (step S5) lower than the second position, and at this position, it is again in a standby state (step S6) for waiting for the operator's operation input. When it drops to the third position, by releasing the end of the line body 4 caught by the hand 22, it returns to the initial position (step S7) and ends the operation.
[0084] According to the outfitting method of the line body 4, the line body 4 in a suspended state can be outfitted from the bottom to other devices 5 through the robot body 2. At this time, since the weight of the line body 4 is supported by the robot body 2, the operator does not need to lift the line body 4, which can reduce the burden on the operator.
[0085] Furthermore, whenever the outfitting of the lower portion of the motif 4 is completed, the robot body 2 moves to create slack for outfitting the motif 4 at the upper portion, and the operator does not need to lift the motif 4 and can outfit the motif 4 in sequence.
[0086] And, if Fig.10 As shown, in this case, from Figure 3 The initial position to Figure 4 During the first position of grasping the line body 4, only the weight of the robot body 2 and the weight of the hand 22 act on the sensor 21. At the initial position, the value of the external force detected by the sensor 21 is stored in the reference value storage unit 32 as the initial reference external force value.
[0087] Next, at the first position, the robot body 2 moves from the first position of the line body 4 grasped by the hand 22 to the second position. As the line body 4 in the tray 6 is gradually lifted, the value of the external force detected by the sensor 21 will gradually increase. The external force value is detected by the sensor 21 within a specified time interval, and the difference between the detected external force value and the reference external force value stored in the reference value storage unit 32 is calculated by the difference calculation unit 33. The determination unit 34 determines whether the absolute value of the calculated difference exceeds the specified threshold. If the absolute value of the difference exceeds the threshold, the action of the robot body 2 is stopped according to the contact stop function of the control unit 31.
[0088] In this embodiment, in addition to the initial position where the robot body 2 stops, there are teaching points from the first position to the third position. Figure 5 As shown, a teaching point is provided at each position where the absolute value of the difference between the first position and the second position does not exceed the threshold value. The number of teaching points is arbitrary. Moreover, at each teaching point, an instruction for realizing a specific action state is taught, and at this time, an instruction for updating the value of the reference value storage unit 32 using the value of the external force detected by the sensor 21 as a new reference external force value is taught.
[0089] Next, if Figure 7 As shown, in the second position, since the lower end of the suspended filament body 4 is outfitted to other devices 5, the weight of the filament body 4 supported by the hand 22 gradually decreases, and the external force value detected by the sensor 21 decreases. At this time, it is determined that the weight change of the filament body 4 caused by the outfitting operation in the second position does not exceed the threshold value.
[0090] Furthermore, when the outfitting of the line body 4 at the second position is completed, the operator performs operation input on the teaching operation panel, such as Fig.10 As shown, after the reference external force value is updated again, the robot body 2 moves from the second position to Figure 8 The third position shown. Thus, the slack of the line body 4 for outfitting at the third position is formed. In addition, the teaching operation panel is not limited to the teaching operation panel set in the robot body 2 itself, and a wired or wireless remote controller set separately can also be used.
[0091] When the robot body 2 moves to the third position and stops and is in a standby state, the external force value detected by the sensor 21 is used as a new reference external force value to update the value of the reference value storage unit 32. Fig. 9 As shown in FIG. 1 , the weight change of the line body 4 of the outfitting at the third position is also determined to be not more than the threshold value. Fig.10 As shown, after releasing the line body 4 in the third position, the reference external force value is updated again, and the updated reference external force value is used to return to the initial position.
Claims
1. A robot system, characterized in that: have: Robot body; a sensor that detects the magnitude of external forces applied to the robot body, the external forces including the weight of the robot body, a load operated by the robot body, and a force received from a person or object in contact with the robot body; A control unit that controls the robot body; a reference value storage unit for storing, when the robot body in operation is in a specific action state, the value of the external force detected by the sensor as a reference external force value, wherein the specific action state is a state in which only the deadweight and the load act on the robot body; as well as a determination unit that determines that an external force other than the deadweight and the load is acting on the robot body when an absolute value of a difference between the value of the external force detected by the sensor and the reference external force value stored in the reference value storage unit is greater than a predetermined threshold value during the operation of the robot body; During the operation of the robot body, the reference value storage unit updates the reference external force value stored in the reference value storage unit by storing the value of the external force newly detected by the sensor when the specific action state is implemented as a new reference external force value, The reference external force value stored in the reference value storage unit changes according to a change in the magnitude of the load.
2. The robot system according to claim 1, characterized in that: The reference value storage unit updates the reference external force value at a plurality of locations on the motion path of the robot.
3. The robot system according to claim 1 or 2, characterized in that: The specific action state is that the robot body is in a stopped state or a low-speed action state.
4. The robot system according to claim 1 or 2, characterized in that: The sensor is any one of at least one force sensor, torque sensor or skin sensor built into the robot body or attached to the robot body.
5. The robot system according to claim 1 or 2, characterized in that: The reference value storage unit updates the reference external force value every time the robot main body manually operated by an operator enters the specific operating state.
6. The robot system according to claim 1 or 2, characterized in that: During the implementation of the teaching program, the reference value storage unit places the robot body in the specific action state at any teaching point set in the teaching program, or at each specified time interval or specified movement distance, and updates the reference external force value.
7. The robot system according to claim 1 or 2, characterized in that: The reference value storage unit automatically updates the reference external force value when the robot body is in the specific operation state.
8. The robot system according to claim 1 or 2, characterized in that: The reference value storage unit stores the reference external force value when a person is not in contact with the robot main body and the robot main body is in the specific operation state.
