State determination device and state determination method
The state determination device addresses misalignment and deformation issues in the workpiece-chuck system by using force control and temperature sensors to detect abnormalities and correct positioning, thereby maintaining machining precision.
Patent Information
- Application Number
- PCT/JP2023/016994
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-01
- Publication Date
- 2024-11-07
AI Technical Summary
The accurate centering of a workpiece with a machine tool's chuck is compromised by foreign matter or deformation, leading to reduced machining precision due to misalignment.
A state determination device and method that utilize a robot system with force control and temperature sensors to detect abnormalities in the workpiece, chuck, and gripping mechanism, comparing normal and actual states to determine misalignment or deformation, and trigger cleaning or alert mechanisms as needed.
Prevents misalignment and maintains machining accuracy by detecting and correcting foreign matter or deformation issues between the workpiece and chuck, ensuring precise positioning and orientation.
Smart Images

Figure JP2023016994_07112024_PF_FP_ABST
Abstract
Description
State determination device and state determination method
[0001] The present disclosure relates to a state determination device and a state determination method.
[0002] When a robot supplies a workpiece held by the robot to a chuck provided on the spindle of a machine tool, the robot is controlled in accordance with the force that the workpiece receives from the chuck, a so-called force control (see, for example, Patent Document 1).By using force control, the robot corrects the position and posture of the workpiece to match the chuck, thereby accurately aligning the central axis of the workpiece with the central axis of the chuck.
[0003] JP 2018-24049 A
[0004] When foreign matter such as chips generated by machining using a machine tool adheres to the chuck, the foreign matter may become caught between the supplied workpiece and the chuck, preventing accurate centering of the workpiece. Deformation of the workpiece, chuck, etc. also prevents accurate centering of the workpiece. Therefore, it is desirable to determine abnormalities in the supply of the workpiece to a fixing mechanism such as a chuck.
[0005] One aspect of the present disclosure is a state determination device that determines a state when a first member held by a robot is supplied to a second member by force control, the state determination device comprising at least one processor and at least one memory capable of storing first information related to the position and posture of the first member when the first member and the second member are in a normal state, and a first temperature of the robot or the robot's surroundings, wherein the at least one processor acquires second information related to the position and posture of the first member and a second temperature of the robot or the robot's surroundings when the first member is supplied to the second member by force control of the robot, and determines the state of at least one of the first member and the second member based on the information stored in the at least one memory, the second information, and the second temperature.
[0006] 1 is an overall configuration diagram showing a robot system according to an embodiment of the present disclosure. FIG. 1 is a schematic perspective view showing a chuck of a machine tool of the robot system of FIG. 1 and a workpiece supplied in an inclined state. FIG. 2 is a schematic front view showing a state in which a foreign object is interposed between the chuck of the machine tool of the robot system of FIG. 1 and the workpiece. FIG. 3 is a schematic view showing a state in which the workpiece supplied in an inclined state of FIG. 2 is pressed against the side of the chuck. FIG. 4 is a schematic perspective view showing a state in which the attitude of the workpiece is corrected by force control of the robot from the state of FIG. 5. FIG. 6 is a schematic perspective view showing a state in which the position of the workpiece is corrected by force control of the robot when closing the chuck from the state of FIG. 7. FIG. 8 is a diagram showing the relationship between two sets of first temperatures and first information stored in association with a memory and a threshold value in the robot system of FIG. 1. FIG. 9 is a flowchart describing an operation of storing N sets of first temperatures and first information in a normal state in a state determination method according to an embodiment of the present disclosure. FIG. 10 is a flowchart describing a state determination method when a workpiece is supplied to the chuck using the information stored in FIG. 1. FIG. 11 is an overall configuration diagram showing a modified example of the robot system of FIG. 1. FIG. 12 is a flowchart describing a modified example of the state determination method of FIG.
[0007] A robot system 1, a control device 3, and a state determination method according to an embodiment of the present disclosure will be described below with reference to the drawings. As shown in Fig. 1, the robot system 1 according to this embodiment includes a robot 2, a control device (state determination device) 3, a machine tool 4, a temperature sensor (temperature input device) 5, and a force sensor 6. In the example shown in Fig. 1, the robot 2 is, for example, a vertical six-axis articulated robot, but is not limited to this and may be a robot of any other configuration.
[0008] The robot 2 includes a base 21 placed on an installation surface X such as a floor, and a rotating body 22 supported rotatably relative to the base 21 about a vertical first axis J1. The robot 2 also includes a first arm 23 supported rotatably relative to the rotating body 22 about a horizontal second axis J2, and a second arm 24 supported rotatably relative to the first arm 23 about a third axis J3 parallel to the second axis J2. The robot 2 also includes a three-axis wrist unit 25 attached to the tip of the second arm 24.
[0009] The robot 2 also includes a hand S that is fixed to the tip of the wrist unit 25 and that grips a workpiece (first member) W. The hand S has a gripping mechanism that grips the workpiece W, and in the illustrated example, has multiple fingers that can grip a cylindrical workpiece W. The structure of the hand S and the shape of the workpiece W may be arbitrary.
[0010] The force sensor 6 is disposed between the tip of the wrist unit 25 and the hand S. The force sensor 6 detects external forces such as forces and moments acting on the gripping mechanism or the workpiece W gripped by the gripping mechanism.
[0011] The force sensor 6 may be, for example, a three-axis or six-axis force sensor that detects at least one of an external force and a moment acting on the workpiece W. The force sensor 6 is not limited to this, and may be, for example, a torque sensor (not shown) provided on each axis J1, J2, J3 of the robot 2, or a means (not shown) that estimates torque based on the current value of a motor provided on each axis J1, J2, J3 of the robot 2.
[0012] 2, the machine tool 4 is equipped with a chuck (second member, fixing mechanism) 7 having three jaws 7a that are opened and closed in response to command signals from the control device 3 of the robot 2. The machine tool 4 performs predetermined processing, such as cutting, on a workpiece W fixed between the jaws 7a of the chuck 7. The machine tool 4 may also be equipped with a cleaning device, such as a nozzle that sprays compressed air or a fluid, such as a coolant, toward the chuck 7. The chuck 7 or the workpiece W fixed to the chuck 7 can be cleaned by operating the cleaning device.
[0013] A cleaning device such as a nozzle having the same function as the nozzle may be provided on the robot 2 or on another robot or peripheral device (not shown). In either case, the cleaning device can spray fluid to clean the chuck 7 based on a cleaning command signal output by the control device 3 of the robot 2 in the process described below.
[0014] In the robot system 1, when a workpiece W is supplied to the chuck 7 of the machine tool 4, foreign matter such as chips may adhere to the chuck 7, as shown in Fig. 3. If the workpiece W is fixed to the chuck 7 in such a state, the foreign matter may become caught between the workpiece W and the chuck 7, causing the workpiece W to become misaligned with respect to the chuck 7, resulting in a decrease in machining accuracy.
[0015] Furthermore, even if no foreign matter is attached to the chuck 7, foreign matter such as fragments of the workpiece W resulting from previous processing may be attached to the workpiece W held by the robot 2, and in such cases, a similar problem may occur. Furthermore, this is not limited to cases where foreign matter is attached, and a similar problem may occur if the workpiece W, the hand S, or the chuck 7 is deformed. The robot system 1, the control device 3, and the state determination method according to this embodiment detect abnormalities in the supply of the workpiece W due to the presence of such foreign matter or deformation of the workpiece W, etc.
[0016] In this embodiment, the term "foreign matter" refers to an object that can become caught between the workpiece W and the chuck 7, thereby reducing the positioning accuracy of the workpiece W relative to the chuck 7 and ultimately reducing the machining accuracy. Examples of foreign matter include chips and debris generated during machining of the workpiece W, the worker's hair, and dust depending on the work environment. Examples of chips include those that were generated during machining of the previous workpiece W and are attached to the chuck 7, and examples of debris include those that remain attached to the workpiece W during previous machining.
[0017] The temperature sensor 5 is disposed at at least one measurement point on the robot 2, the machine tool 4, or in the vicinity thereof. The temperature sensor 5 disposed on the robot 2 is disposed on the surface of or inside the robot 2, and is preferably disposed at each joint. The temperature sensor 5 disposed inside the robot 2 may be disposed at a position where it can detect the temperature of the rotation mechanism, such as the motor or reducer, of each joint.
[0018] The temperature sensor 5 disposed on the machine tool 4 is disposed on the surface of or inside the machine tool 4, and is preferably disposed on the chuck 7. The temperature sensor 5 disposed near the robot 2 and the machine tool 4 is installed in the space where the robot 2 and the machine tool 4 are disposed, and detects the temperature of the surrounding environment. The temperature sensor 5 is connected to the control device 3.
[0019] If the robot 2 is equipped with multiple temperature sensors 5, it is possible to use the temperature detected by any one selected temperature sensor 5, or to use the average value of the temperatures detected by the multiple temperature sensors 5. It is also possible to use the average value of the selected robot 2 temperature or its average value and the ambient temperature, or the average value of the machine tool 4 temperature.
[0020] The control device 3 drives a motor provided in the robot 2 and controls the hand S attached to the tip of the wrist unit 25 to move to a desired position and posture. The control device 3 is also connected to the machine tool 4, and outputs to the machine tool 4 a command signal to open or close the chuck 7, a command signal to clean the cleaning device, and a processing permission signal.
[0021] Furthermore, the control device 3 performs force control based on the external force detected by the force sensor 6 so that the position and posture of the workpiece W held by the hand S are appropriate relative to the chuck 7 of the machine tool 4. In force control, for example, as shown in Figures 4 and 5, the posture of the workpiece W is first corrected by pressing the workpiece W against the spindle of the machine tool 4 or the jaws 7a of the chuck 7. Next, as shown in Figure 6, the position of the workpiece W is corrected in accordance with the chuck 7 when the chuck 7 is closed. Alternatively, the force control may simultaneously correct the position and posture of the workpiece W in accordance with the chuck 7 when the chuck 7 is closed.
[0022] 4 is a diagram illustrating the operation of correcting the posture of the workpiece W by pressing the workpiece W against one of the jaws 7a of the chuck 7. When the robot 2 presses the workpiece W against the jaw 7a, a moment M is generated in the workpiece W due to a reaction force F that the workpiece W receives from the jaw 7a at a contact point P between the workpiece W and the jaw 7a. When the moment M is detected by the force sensor 6, the control device 3 performs force control on the robot 2 in a direction that makes the moment M zero.
[0023] That is, when the moment M is detected by the force sensor 6, the control device 3 causes the robot 2 to rotate the workpiece W in a direction that reduces the moment M, thereby correcting the posture of the workpiece W. Then, as shown in Figure 5, when the side surface of the workpiece W comes into contact with a wide area of the surface of the jaws 7a of the chuck 7, the moment M detected by the force sensor 6 becomes zero, and the posture of the workpiece W is corrected.
[0024] 6 is a diagram illustrating the operation of correcting the position of the workpiece W by closing the chuck 7. When the chuck 7 is closed, the workpiece W is pushed in the direction of movement of the chuck 7, and therefore the workpiece W is subjected to an external force from the jaws 7a. When the external force is detected by the force sensor 6, the control device 3 performs force control on the robot 2 in a direction that reduces the external force to zero.
[0025] That is, when an external force is detected by the force sensor 6, the control device 3 causes the robot 2 to translate the workpiece W in a direction that reduces the external force, thereby correcting the position of the workpiece W. Then, when the workpiece W comes into contact with all three jaws 7a, the external forces detected by the force sensor 6 are balanced and become zero, and the position of the workpiece W is corrected.
[0026] The control device 3 includes at least one memory 8 and at least one processor 9. The memory 8 stores in advance the first information and the first temperature associated with each other when the workpiece W, the hand S, and the chuck 7 are in a normal state and the workpiece W is supplied to the chuck 7 by the force control of the robot 2.
[0027] Here, the normal state of the workpiece W, hand S, and chuck 7 means a state in which it has been confirmed that no foreign matter is present between the workpiece W, hand S, and chuck 7. The normal state of the workpiece W, hand S, and chuck 7 also includes a state in which there are no abnormalities, such as deformation, in the workpiece W, hand S, and chuck 7. Hereinafter, the normal state of the workpiece W, hand S, and chuck 7 will also be referred to as the normal state.
[0028] The first information is information related to the position and posture of the workpiece W after correction by force control under normal conditions. The position of the workpiece W is, for example, the coordinates (x, y, z) of the tool tip point set at the gripping point of the workpiece W by the gripping mechanism of the hand S. Furthermore, the posture of the workpiece W is, for example, the angle (p, q, r) of the tip axis of the wrist unit 25 with respect to three mutually orthogonal coordinate axes fixed to the center of the bottom surface of the base 21.
[0029] The first information related to the corrected position and posture of the workpiece W is at least one of the position and posture of the workpiece W. Furthermore, the first information may be the position information and posture information of the workpiece W itself, as well as angle information of each joint of the robot 2.
[0030] The first temperature is the temperature detected by the temperature sensor 5 when the position and posture of the workpiece W are corrected by force control under normal conditions. The control device 3 stores in the memory 8 a plurality of first temperatures detected at the measurement points and the first information in association with each other.
[0031] During actual machining, the control device 3 supplies the workpiece W having the same shape as that in normal operation to the chuck 7 in a state in which the presence of foreign matter or deformation of the workpiece W, hand S, and chuck 7 is unknown. At this time, the control device 3 corrects the position and posture of the workpiece W when it was supplied to the chuck 7 by force-controlling the robot 2 in the same manner as described above.
[0032] As a result, the control device 3 acquires second information related to the corrected position and posture of the workpiece W. The second information also includes, for example, the coordinates of the tool tip point and the angles (p, q, r) of the tip axis of the wrist unit 25 with respect to three mutually orthogonal coordinate axes fixed to the center of the bottom surface of the base 21.
[0033] Furthermore, when the control device 3 acquires the second information, it acquires the second temperature at the measurement point from the temperature sensor 5. Then, the control device 3 searches the information stored in the memory 8 using the acquired second temperature as a key, and acquires the first information corresponding to the second temperature.
[0034] Specifically, the control device 3 reads the first information stored in association with the first temperature that is closest to the second temperature from the memory 8. In this way, the control device 3 directly acquires the first information corresponding to the second temperature from the information stored in the memory 8.
[0035] Two adjacent first temperatures T 1 , T 2 As shown in FIG. 7, the interval ΔT is 1 , T 2 The difference d between the two pieces of first information associated with each other is a threshold value D T Therefore, if there is no foreign matter trapped, the first temperature T 1 , T 2 The first temperature T is closest to the second temperature T 1 The difference A between the first information and the second information stored in association with the first information is equal to or greater than the threshold value D. T It will never exceed.
[0036] The control device 3 then determines whether the first information and second information thus acquired differ by more than a predetermined threshold value. For example, the control device 3 determines whether at least one of the difference in position (i.e., the difference in coordinate values) and the difference in attitude (i.e., the difference in angle) included in the first information and the second information exceeds the respective threshold value.
[0037] The first information and the second information will be approximately the same if there is no foreign matter between the workpiece W and the chuck 7 or between the hand S and the workpiece W, and if there is no deformation or the like in the workpiece W, the hand S, or the chuck 7. Therefore, if the first information and the second information differ by more than a predetermined threshold, the control device 3 determines that an abnormality has occurred in the supply of the workpiece W.
[0038] Threshold D T can be set for each component as the difference in position and the difference in posture of the workpiece W, and can be determined as the maximum value within a range that does not affect the machining accuracy of the workpiece W. For example, it can be determined empirically based on past performance, etc. In other words, when the difference A between the first information and the second information is equal to or greater than the threshold value D T If it is below this value, it is believed that even if a foreign object is caught or the workpiece W or the like is deformed, it will not affect the machining accuracy.
[0039] When the control device 3 determines that an abnormality has occurred in the supply of the workpiece W, it sends a cleaning command signal to the machine tool 4 to activate the above-mentioned cleaning device. Alternatively or in addition to this, the control device 3 may output an alarm. By outputting the alarm, an operator or the like can manually clean the chuck 7. After the cleaning of the workpiece W and the chuck 7 is completed, the control device 3 again supplies the workpiece W to the chuck 7 by force control of the robot 2.
[0040] The control device 3 then determines whether the difference between the first information and the second information is equal to or exceeds a threshold value D T If the difference is less than or equal to the threshold value D, a machining permission signal is output to the machine tool 4 to start machining the workpiece W. T If it exceeds this limit, the control device 3 stops the robot 2 and the machine tool 4, and outputs an alarm to notify the operator of this.
[0041] This makes it possible to prevent the workpiece W from being machined in a misaligned state when the foreign matter cannot be removed or when the workpiece W, hand S or chuck 7 is deformed.
[0042] Next, a state determination method according to an embodiment of the present disclosure will be described with reference to the drawings. The state determination method according to the present embodiment is based on the premise that the first temperature and the first information are associated with each other and stored in the memory 8 in advance.
[0043] The first temperature and the first information are associated with each other and stored in the memory 8 as follows: As shown in Fig. 8, in a normal state where the workpiece W and the chuck 7 are free of any foreign matter or deformation, the control device 3 first causes the hand S to grip the workpiece W (step S1). Next, the control device 3 commands the machine tool 4 to open the chuck 7 (step S2).
[0044] The control device 3 operates the robot 2 to supply the workpiece W to the chuck 7 (step S3) and commands the robot 2 to close the chuck 7 (step S4). At this time, the control device 3 corrects the position and posture of the workpiece W with respect to the chuck 7 by force control of the robot 2 based on the external force acting on the workpiece W. As a result, the control device 3 obtains first information (step S5).
[0045] Furthermore, at the time when the first information is obtained, the control device 3 acquires the first temperature at the measurement point from the temperature sensor 5 (step S6).The control device 3 then stores the acquired first information and the first temperature in association with each other in the memory 8 (step S7).
[0046] The control device 3 determines whether N sets of first information and first temperatures have been stored, and if not, repeats the process from step S2 (step S8), where N is an integer equal to or greater than 1. The N pieces of first information are acquired by repeating steps S2 to S8 for N different first temperatures.
[0047] For example, when the power is cut off and the robot 2 is at room temperature, the operating program is started immediately after the power is turned on, and the first information and the first temperature are acquired N times while the first temperature increases as the operating time of the robot 2 increases.
[0048] 9, in the state determination method according to this embodiment, the hand S is caused to grip the workpiece W to be actually machined (step S11). Next, the control device 3 commands the machine tool 4 to open the chuck 7 (step S12).
[0049] The control device 3 operates the robot 2 to supply the workpiece W to the chuck 7 (step S13), and commands the machine tool 4 to close the chuck 7 (step S14). At this time, the control device 3 corrects the position and orientation of the workpiece W relative to the chuck 7 by force control of the robot 2 based on the external force acting on the workpiece W. This allows the control device 3 to obtain second information related to the position and orientation of the workpiece W during actual operation (step S15).
[0050] Next, when the control device 3 obtains the second information, it receives the second temperature at the measurement point from the temperature sensor 5 (step S16).Then, the control device 3 obtains from the memory 8 the first information stored in association with the first temperature that is closest to the second temperature received from the temperature sensor 5 (step S17).
[0051] The control device 3 then calculates the difference between the coordinate values and the angle included in the first information and the second information (difference A between the first information and the second information) (step S18). The control device 3 then compares the difference between the coordinate values and the angle with threshold values set for each (step S19). The threshold values are stored in the memory 8.
[0052] If at least one of the difference in coordinate values and the difference in angle exceeds a threshold value, the control device 3 determines that there is an abnormality in the supply of the workpiece W (step S20). Then, the control device 3 commands the machine tool 4 to open the chuck 7 (step S21), and outputs a cleaning command signal to clean the workpiece W and the chuck 7 (step S22).
[0053] If cleaning has not been performed a specified number of times (e.g., n times), the control device 3 repeats the process from step S13 (step S23), where n may be an integer equal to or greater than 1. If cleaning has been performed n times, the control device 3 outputs an alarm and ends the process (step S24).
[0054] If the coordinate value difference and angle difference are all equal to or less than the threshold value in step S20, the control device 3 determines that the supply of the workpiece W is normal and outputs a machining permission command to the machine tool 4 (step S25).
[0055] As described above, the robot system 1, control device 3, and state determination method of this embodiment can determine whether the supply of the workpiece W is normal or not by comparing the first information stored for the workpiece W when it is normal. In other words, it is possible to easily detect the presence of a foreign object between the workpiece W and the chuck 7 or misalignment between the workpiece W and the chuck 7 due to deformation of the workpiece W, the hand S, or the chuck 7. This has the advantage of preventing a decrease in the machining accuracy of the workpiece W due to the intrusion of a foreign object or deformation of the workpiece W.
[0056] Furthermore, in this embodiment, the first information associated with the first temperature closest to the second temperature at the measurement point during actual work, among the first information in normal times, is read from the memory 8 and compared with the second information during actual work. This has the advantage that even if the temperature during actual work fluctuates and the dimensions of the mechanical parts of the robot 2 fluctuate, it is possible to correctly detect the entrapment of a foreign object or deformation of the workpiece W, etc.
[0057] In this embodiment, the first information stored in association with the first temperature closest to the second temperature is read from the memory 8 and compared with the second information. In this case, as described above, it is sufficient that the first information is stored in the memory 8 in association with a plurality of first temperatures at sufficiently small temperature intervals.
[0058] Alternatively, when a plurality of first temperatures and pieces of first information are stored in the memory 8 at relatively coarse temperature intervals, the processor 9 of the control device 3 may read two pieces of first temperatures and pieces of first information that sandwich the second temperature from the memory 8. Then, the processor 9 may interpolate the two read pieces of first information using a function of temperature.
[0059] Any function of temperature can be used, for example, a linear function of temperature. In this case, the processor 9 can acquire the first information corresponding to the second temperature by substituting the second temperature into the linear function.
[0060] Furthermore, in this embodiment, the case where the workpiece W gripped by the robot 2 is supplied to the chuck 7 of the machine tool 4 has been described. However, the present invention may be applied to a case where the workpiece W is supplied to a chuck of any machine other than the machine tool 4 or to a fixing mechanism other than the chuck 7.
[0061] Furthermore, in this embodiment, the robot system 1 has been described as being capable of detecting foreign matter getting caught or deformation of the workpiece W even if the dimensions of the mechanical parts of the robot 2 fluctuate due to temperature fluctuations during actual work. In addition, third information relating to the position and posture of the chuck 7 of the machine tool 4 may be stored in association with the first temperature during normal operation, and the third information corresponding to the second temperature may be read out during actual work.
[0062] Then, the first information and third information in normal times corresponding to the second temperature and the second information during actual work may be used to determine abnormalities in the supply of the workpiece W. This allows for more accurate detection of foreign matter getting caught and deformation of the workpiece W, taking into account not only dimensional variations in the mechanical parts of the robot 2 due to temperature but also variations in the position of the chuck 7 of the machine tool 4, etc.
[0063] In this embodiment, in order to determine whether the difference between the first information and the second information exceeds a predetermined threshold, the difference A between the first information and the second information is set to a threshold D. T Alternatively, it is determined whether the ratio of the first information to the second information exceeds a threshold D T It may be determined whether the difference exceeds
[0064] In this embodiment, the temperature input device is exemplified as the temperature sensor 5 that is connected to the control device 3 and detects the temperature at the measurement point when the first information and the second information are acquired. However, instead of this, a temperature input device that allows the operator to input the temperature at the measurement point when the first information and the second information are acquired may be used. In this case, the temperature input device may be a keyboard, a mouse, a tablet terminal, or the like.
[0065] In addition, in this embodiment, the control device 3 detects abnormalities in the supply of the workpieces W. Alternatively, as shown in Fig. 10, a state determination device 10 separate from the control device 3 may be employed. That is, the state determination device 10 is connected to the control device 3 and the temperature sensor 5, and includes at least one memory 11 and at least one processor 12.
[0066] In this case, the memory 11 previously stores the first information and the first temperature in association with each other under normal conditions. During actual work, the processor 12 acquires the second information from the control device 3 and the second temperature from the temperature sensor 5. Then, the processor 12 reads from the memory 11 the first information stored in association with the first temperature corresponding to the second temperature, and compares the first information with the second information.
[0067] The processor 12 determines whether the difference A between the first information and the second information is equal to or greater than a threshold D. T If the difference A between the first information and the second information is equal to or less than the threshold value D, the processor 12 instructs the control device 3 to output a machining permission signal to the machine tool 4. T If it is greater than , it is determined that there is an abnormality in the supply of the workpiece W, and the control device 3 is instructed to output a cleaning command signal or the like to the machine tool 4.
[0068] In this embodiment, the presence or absence of a supply abnormality of the workpiece W is determined based on the difference A between the first information and the second information when the workpiece W is supplied to the chuck 7 by force control. Alternatively, a state determination method according to a modified example shown in FIG. 11 may be employed.
[0069] First, with the first information and the first temperature in a normal state associated with each other and stored in the memory 8, the workpiece W is grasped by the hand S (step S11), and the chuck 7 is opened (step S12). The second temperature is acquired from the temperature sensor 5 (step S16), and the first information corresponding to the second temperature is acquired from the memory 8 (step S17).
[0070] Then, the robot 2 is controlled so that the workpiece W is in the position and posture indicated in the first information (step S26), whereby the workpiece W is placed in the normal position and posture corresponding to the second temperature.
[0071] Then, in this state, the chuck 7 is closed (step S14). This fixes the workpiece W with the chuck 7, and the magnitude of the external force B detected by the force sensor 6 at this time is acquired (step S27). The acquired external force B is then compared with a predetermined threshold value (step S28). If there is no abnormality such as a foreign object being caught, the external force B detected by the force sensor 6 should be below the threshold value even when the chuck 7 is closed for the workpiece W placed in a normal position and orientation corresponding to the second temperature.
[0072] Therefore, when the external force B is greater than the threshold value, the workpiece W, which is normally positioned and oriented corresponding to the second temperature, is corrected to a different position or orientation by the chuck 7. As a result, it can be determined that an abnormality such as a foreign object being caught or deformation of the workpiece W has occurred (step S20).
[0073] Although each embodiment of the present disclosure has been described in detail above, the present disclosure is not limited to the individual embodiments described above. Various additions, substitutions, modifications, partial deletions, etc. are possible to these embodiments without departing from the gist of the invention or the concept and spirit of the present invention derived from the content described in the claims and their equivalents. For example, in the above-described embodiments, the order of each operation and the order of each process are shown as examples and are not limited to these.
[0074] The following supplementary notes are further disclosed regarding the above-described embodiment and modified examples: (Supplementary Note 1) A state determination device that determines a state when a first member held by a robot is supplied to a second member by force control, comprising: at least one processor; and at least one memory that can store first information related to the position and posture of the first member and a first temperature of the robot or the robot's surroundings when the first member and the second member are in a normal state, wherein the at least one processor acquires second information related to the position and posture of the first member and a second temperature of the robot or the robot's surroundings when the first member is supplied to the second member by force control of the robot, and determines a state of at least one of the first member and the second member based on the information stored in the at least one memory, the second information, and the second temperature.
[0075] (Supplementary Note 2) A state determination device as described in Supplementary Note 1, which is connected to a control device capable of correcting the position and posture of the first member relative to the second member by force control of the robot, and a temperature input device that inputs the temperature of the robot or the area around the robot, wherein the first information relates to the corrected position and posture of the first member received from the control device when the first member is supplied to the second member by force control of the robot, and the first temperature is the temperature input from the temperature input device at that time.
[0076] (Supplementary Note 3) The state determination device according to Supplementary Note 2, wherein the processor receives the second temperature from the temperature input device and acquires the first information corresponding to the second temperature from the information stored in the memory.
[0077] (Supplementary Note 4) The state determination device according to Supplementary Note 3, which determines that an abnormality exists when the first information and the second information differ by more than a predetermined threshold value.
[0078] (Supplementary Note 5) The state determination device according to Supplementary Note 4 determines whether at least one of a difference between the corrected position of the first member in the first information and the corrected position of the first member in the second information and a difference between the corrected orientation of the first member in the first information and the corrected orientation of the first member in the second information exceeds the threshold value.
[0079] (Supplementary Note 6) The state determination device according to any one of Supplementary Note 1 to Supplementary Note 5, wherein the memory stores a plurality of the first temperatures and the first information respectively associated with each of the first temperatures.
[0080] (Supplementary Note 7) The state determination device according to Supplementary Note 6, wherein the processor acquires from the memory the first information stored in association with the first temperature closest to the second temperature as the first information corresponding to the second temperature.
[0081] (Supplementary Note 8) The state determination device according to Supplementary Note 6, wherein the processor interpolates the two pieces of first information stored in the memory in association with two first temperatures sandwiching the second temperature using a temperature function, and acquires the first information corresponding to the second temperature using the function.
[0082] (Supplementary Note 9) A state determination method for determining a state when a first member held by a robot is supplied to a second member, the state determination method comprising: storing first information related to the position and posture of the first member when the first member and the second member are in a normal state, in association with a first temperature of the robot or the robot's surroundings at that time; obtaining second information related to the position and posture of the first member when the first member is supplied to the second member by force control of the robot; acquiring a second temperature of the robot or the robot's surroundings at that time; and determining the state of at least one of the first member and the second member based on the stored information, the second information, and the second temperature.
[0083] (Appendix 10) A state determination method according to Appendix 9, wherein the first information is obtained by correcting the position and posture of the first member relative to the second member by force control of the robot based on an external force acting on the first member when the first member held by the robot is supplied to the second member, and the first temperature is the temperature obtained at that time.
[0084] (Supplementary Note 11) The state determination method according to Supplementary Note 10, further comprising: acquiring the first information corresponding to the acquired second temperature from the stored information.
[0085] (Supplementary Note 12) A state determination method for determining a state when a first member held by a robot is supplied to a second member, the state determination method comprising: storing first information related to the position and posture of the first member when the first member and the second member are in a normal state, in association with a first temperature of the robot or the robot's surroundings at that time; acquiring the second temperature of the robot or the robot's surroundings when the robot supplies the first member held by the robot to the second member; acquiring the first information corresponding to the acquired second temperature from the stored information; controlling the robot so that the position and posture of the first member become the position and posture included in the acquired first information; and determining that an abnormality has occurred when an external force applied to the first member from the second member is equal to or greater than a predetermined threshold.
[0086] (Supplementary Note 13) The state determination method according to Supplementary Note 12, wherein the first information is obtained by correcting the position and posture of the first member relative to the second member by force control of the robot based on an external force acting on the first member when the first member held by the robot is supplied to the second member, and the first temperature is the temperature obtained at that time.
[0087] REFERENCE SIGNS LIST 1 Robot system 2 Robot 3 Control device (state determination device) 5 Temperature sensor (temperature input device) 6 Force sensor 7 Chuck (second member, fixing mechanism) 10 State determination device 8, 11 Memory 9, 12 Processor W Work (first member)
Claims
1. A state determination device that determines a state when a first member held by a robot is supplied to a second member by force control, the state determination device comprising: at least one processor; and at least one memory capable of storing first information related to the position and posture of the first member and a first temperature of the robot or the surroundings of the robot when the first member and the second member are in a normal state, wherein the at least one processor acquires second information related to the position and posture of the first member and a second temperature of the robot or the surroundings of the robot when the first member is supplied to the second member by force control of the robot, and determines the state of at least one of the first member and the second member based on the information stored in the at least one memory, the second information, and the second temperature.
2. A state determination device as described in claim 1, which is connected to a control device capable of correcting the position and posture of the first member relative to the second member by force control of the robot, and to a temperature input device that inputs the temperature of the robot or the surroundings of the robot, wherein the first information relates to the corrected position and posture of the first member received from the control device when the first member is supplied to the second member by force control of the robot, and the first temperature is the temperature input from the temperature input device at that time.
3. The state determination device according to claim 2, wherein the processor receives the second temperature from the temperature input device and obtains the first information corresponding to the second temperature from the information stored in the memory.
4. A state determination device as claimed in claim 3, which determines that an abnormality exists when the first information and the second information differ by more than a predetermined threshold value.
5. A state determination device as described in claim 4, which determines whether or not at least one of the difference between the corrected position of the first member in the first information and the corrected position of the first member in the second information and the difference between the corrected orientation of the first member in the first information and the corrected orientation of the first member in the second information exceeds the threshold value.
6. The state determination device according to any one of claims 1 to 5, wherein the memory stores a plurality of the first temperatures and the first information respectively associated with each of the first temperatures.
7. A state determination device as described in claim 6, wherein the processor obtains from the memory the first information stored in association with the first temperature closest to the second temperature as the first information corresponding to the second temperature.
8. The state determination device according to claim 6, wherein the processor interpolates two pieces of first information stored in the memory in association with two first temperatures on either side of the second temperature using a temperature function, and obtains the first information corresponding to the second temperature using the function.
9. A state determination method for determining a state when a first member held by a robot is supplied to a second member, the state determination method including: storing first information related to the position and posture of the first member when the first member and the second member are in a normal state, in correspondence with a first temperature of the robot or the vicinity of the robot at that time; obtaining second information related to the position and posture of the first member when the first member is supplied to the second member by force control of the robot; acquiring a second temperature of the robot or the vicinity of the robot at that time; and determining a state of at least one of the first member and the second member based on the stored information, the second information, and the second temperature.
10. A state determination method as described in claim 9, wherein the first information is obtained by correcting the position and posture of the first member relative to the second member by force control of the robot based on an external force acting on the first member when the first member held by the robot is supplied to the second member, and the first temperature is the temperature obtained at that time.
11. The state determination method according to claim 10, further comprising obtaining the first information corresponding to the obtained second temperature from the stored information.
12. A condition determination method for determining a condition when a first member held by a robot is supplied to a second member, the condition determination method comprising: storing first information related to the position and posture of the first member when the first member and the second member are in a normal state, in correspondence with a first temperature of the robot or the vicinity of the robot at that time; acquiring the second temperature of the robot or the vicinity of the robot when the first member held by the robot supplies the second member to the second member; acquiring the first information corresponding to the acquired second temperature from the stored information; controlling the robot so that the position and posture of the first member become the position and posture included in the acquired first information; and determining that an abnormality has occurred when an external force applied to the first member from the second member is equal to or greater than a predetermined threshold value.
13. A state determination method as described in claim 12, wherein the first information is obtained by correcting the position and posture of the first member relative to the second member by force control of the robot based on an external force acting on the first member when the first member held by the robot is supplied to the second member, and the first temperature is the temperature obtained at that time.
Citation Information
Patent Citations
Workpiece attachment system
JP2022110731A
Robot system and workpiece supply method
WO2022172873A1
