Inspection system, control device of end effector, and control method of end effector
The inspection system uses a servo motor and encoder-based detection to accurately determine contact between an end effector and an object, addressing the challenge of elastic tips in conventional systems.
Patent Information
- Application Number
- JP2023078017
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-10
- Publication Date
- 2024-11-21
AI Technical Summary
Conventional systems struggle to accurately detect contact between an end effector and an object when the tip of the end effector is made of a material with elasticity, as methods like torque-based detection are inadequate for such configurations.
An inspection system and control method that utilizes a servo motor to move an end effector with a deformable tip, incorporating a detection unit to determine contact based on the difference between an instruction value and encoder position information, allowing precise contact detection.
Enables accurate detection of contact between an end effector and an object even when the tip is elastic, ensuring proper force application and minimizing damage.
Smart Images

Figure 2024162478000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to an inspection system, an end effector control device, and an end effector control method. [Background technology]
[0002] Conventionally, systems in which working robots (hereinafter simply referred to as "robots") perform various tasks in place of humans have become widespread. When performing a desired task on an object, it is necessary to properly detect contact between the robot and the object and whether a desired load is being applied to the object. For example, Patent Document 1 shows an automatic door device that determines that a door has come into contact with an object when the load torque of a motor that drives the door to open and close exceeds a predetermined threshold value. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2006-83526 A Summary of the Invention [Problem to be solved by the invention]
[0004] The present disclosure has been devised in consideration of the above-described conventional situation, and aims to provide a technology for accurately detecting contact between an end effector and an object, even when the tip of the end effector is made of a material having a certain degree of elasticity. [Means for solving the problem]
[0005] The present disclosure provides an inspection system comprising an end effector and a control device that controls the end effector, wherein the end effector includes a tip portion made of a member that deforms upon contact with an object, and a servo motor that moves the position of the tip portion in a predetermined direction, and the control device has a motor control unit that controls the servo motor using an instruction value, an acquisition unit that acquires position information from the servo motor when it operates based on the instruction value, and a detection unit that detects contact between the end effector and the object based on the difference between the instruction value and the position information.
[0006] The present disclosure also provides a control device for an end effector including a tip portion made of a member that deforms upon contact with an object, and a servo motor that moves the position of the tip portion in a predetermined direction, the control device having a motor control unit that controls the servo motor using an instruction value, an acquisition unit that acquires position information from the servo motor when it operates based on the instruction value, and a detection unit that detects contact between the end effector and the object based on the difference between the instruction value and the position information.
[0007] The present disclosure also provides a control method for an end effector including a tip portion made of a member that deforms upon contact with an object, and a servo motor that moves the position of the tip portion in a predetermined direction, the control method controlling the servo motor using an instruction value, obtaining position information from the servo motor when it operates based on the instruction value, and detecting contact between the end effector and the object based on the difference between the instruction value and the position information.
[0008] Any combination of the above components, and conversion of the present disclosure into a method, device, system, storage medium, computer program, etc. are also valid aspects of the present disclosure. Effect of the Invention
[0009] According to the present disclosure, contact between the end effector and an object can be detected with high accuracy even when the tip of the end effector is made of a material having a certain degree of elasticity. [Brief description of the drawings]
[0010] [Figure 1] FIG. 1 is a block diagram showing a configuration example of an inspection system according to a first embodiment. [Diagram 2] FIG. 1 is a schematic diagram (XY plan view) illustrating a configuration example of an end effector according to an embodiment of the present disclosure; [Diagram 3] FIG. 1 is a schematic diagram (XY plan view) for explaining a state when an end effector according to an embodiment of the present disclosure comes into contact with an object; [Figure 4] FIG. 1 is a schematic diagram (XY plan view) for explaining a method for determining contact between an end effector and an object according to an embodiment of the present disclosure; [Diagram 5] FIG. 1 is a graph illustrating a relationship between parameters according to an embodiment of the present disclosure. [Figure 6] FIG. 1 is a table illustrating the range of application of a method of using an encoder value for contact determination according to an embodiment of the present disclosure. [Figure 7] FIG. 1 is a graph illustrating a relationship between parameters according to an embodiment of the present disclosure. [Figure 8] FIG. 1 is a graph illustrating a relationship between parameters according to an embodiment of the present disclosure. [Figure 9] 1 is a flowchart for explaining an example of the operation of the inspection system according to the first embodiment. [Figure 10] FIG. 11 is a block diagram showing a configuration example of an inspection system according to a second embodiment. [Figure 11] FIG. 13 is a schematic diagram for explaining an example of the operation of the robot according to the second embodiment; [Figure 12] FIG. 13 is a schematic diagram showing an example of the inclination of a touch panel display according to a second embodiment; [Figure 13] FIG. 11 is a table for explaining a change in an indication value due to calibration according to the second embodiment. [Figure 14]11 is a flowchart for explaining an example of an operation of calibration of an inspection system according to a second embodiment. [Figure 15] 11 is a flowchart for explaining an example of the operation of the inspection system according to the second embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0011] (Background to this disclosure) Conventionally, systems that use robots to perform various tasks instead of humans have become widespread. For example, end effectors with various functions are attached to the tip of a robot, and the robot performs various tasks such as picking up objects and turning screws. A servo motor and an encoder that detects the position information of the servo motor are used for the operation of the robot and the end effector. However, when the end effector is made to operate an object (e.g., a touch panel display), it is required to detect whether the end effector and the object are in contact with each other and to control the end effector so that a desired pressure is appropriately applied to the object.
[0012] The automatic door system in Patent Document 1 is configured to determine that the door has come into contact with an object when the load torque of the motor that drives the door to open and close exceeds a predetermined threshold. The load torque value of the servo motor of the end effector is used to determine whether or not the end effector has come into contact with the object.
[0013] When an object is manipulated using an end effector, the end effector or the object may be damaged depending on the hardness of the tip of the end effector that contacts the object and the hardness of the object. In order to prevent damage to the end effector or the object, for example, the tip of the end effector may be made of a soft material having a certain degree of elasticity. However, in the case of such a configuration, the force applied when the end effector contacts the object is absorbed, and therefore, a contact determination method using torque as in Patent Document 1 may not be able to determine the contact state appropriately.
[0014] Therefore, in the following embodiment, a technique for determining contact between an end effector and an object will be described even when the tip of the end effector is made of a material having a certain degree of elasticity.
[0015] Hereinafter, the embodiments of the present disclosure will be described in detail with reference to the drawings as appropriate. However, more detailed explanations than necessary may be omitted. For example, detailed explanations of already well-known matters or duplicate explanations of substantially identical configurations may be omitted. This is to avoid the following explanation becoming unnecessarily redundant and to facilitate understanding by those skilled in the art. Note that the attached drawings and the following explanation are provided to enable those skilled in the art to fully understand the present disclosure, and are not intended to limit the subject matter described in the claims.
[0016] (Embodiment 1) FIG. 1 is a block diagram showing a configuration example of an inspection system 1 according to a first embodiment. The inspection system 1 includes a control device 2 and an end effector 20. The control device 2 includes a motor control unit 10, an acquisition unit 11, a detection unit 12, an output unit 13, and a memory 14. Note that the configuration shown in FIG. 1 is an example, and one part may be divided into multiple parts, or multiple parts may be integrated into one. Here, only parts related to the functions of this embodiment are shown, and the system may further include parts other than those shown in FIG. 1.
[0017] The end effector 20 includes a servo motor 21 and an encoder 22. A detailed configuration example of the end effector 20 will be described later.
[0018] The motor control unit 10 outputs an instruction value to the servo motor 21 to drive the servo motor 21. In the present embodiment, the instruction value includes position information of the servo motor 21. An example of the position information is the amount of displacement of the rotation angle of the servo motor 21. The instruction value may be set by a user or the like, or may be adjustable by the motor control unit 10.
[0019] The acquiring unit 11 acquires an encoder value from the encoder 22 after the servo motor 21 operates based on the instruction value. In this embodiment, the encoder value includes position information of the servo motor 21 detected by the encoder 22 after the servo motor 21 operates based on the instruction value. The encoder value is output to the acquiring unit 11 after being detected by the encoder 22. The acquiring unit 11 is also configured to be able to acquire an instruction value from the motor control unit 10. The acquiring unit 11 outputs the instruction value and the encoder value acquired from the motor control unit 10 to the detecting unit 12.
[0020] The detection unit 12 determines whether or not the end effector 20 has come into contact with an object based on the instruction value and the encoder value. When the detection unit 12 determines that the end effector 20 has come into contact with an object, it outputs the determination result to the output unit 13. A specific determination method will be described later. The detection unit 12 also outputs the determination result to the acquisition unit 11. The acquisition unit 11 outputs the determination result acquired from the detection unit 12 to the motor control unit 10.
[0021] The output unit 13 outputs the judgment result. The output unit 13 may be configured to be able to communicate with a display device (not shown) such as a monitor, and may cause the display device to display the judgment result. The output unit 13 may also output the judgment result to a terminal (not shown) owned by a user, for example. Although not shown in FIG. 1, for example, the control device 2 may be configured to include a display device. The output destination is not limited to the display device, and may be, for example, a memory 14 that stores the judgment result.
[0022] The memory 14 is configured using volatile / non-volatile storage devices such as Random Access Memory (hereinafter referred to as "RAM") and Read Only Memory (hereinafter referred to as "ROM"), and temporarily stores programs and data required to execute the operation of the control device 2, as well as data or information generated during operation. The RAM is, for example, a work memory used when the control device 2 is operating. The ROM stores and holds, for example, programs and data for controlling the control device 2 in advance.
[0023] A control unit (not shown) may read out and execute various programs and data stored in memory 14 to realize various functions of motor control unit 10, acquisition unit 11, detection unit 12, and output unit 13 shown in Fig. 1. The control unit may be configured using, for example, a Central Processing Unit (hereinafter referred to as "CPU"), a Micro Processing Unit (hereinafter referred to as "MPU"), a Digital Signal Processor (hereinafter referred to as "DSP"), a Graphical Processing Unit (hereinafter referred to as "GPU"), or a Field Programmable Gate Array (hereinafter referred to as "FPGA") or the like.
[0024] FIG. 2 is a schematic diagram (XY plan view) showing a configuration example of the end effector 20 according to an embodiment of the present disclosure. The end effector 20 includes a pressing portion 23, a gear 25, a rack 26, a stopper 27A, and a stopper 27B. Although not shown in FIG. 2, the end effector 20 further includes an encoder 22. The configuration shown in FIG. 2 is an example. Therefore, the end effector 20 may further include a portion other than the configuration shown in FIG. 2. In this specification, a three-dimensional coordinate system consisting of an X-axis, a Y-axis, and a Z-axis is used for explanation, and the directions of the three-dimensional coordinate system in each figure correspond to each other. In each figure, the direction of the arrow of the coordinate system shown in the figure is positive, and the opposite direction of the arrow is negative. The configuration of each axis and the setting of the origin are examples, and are not limited to these.
[0025] When the servo motor 21 receives an instruction value from the control device 2, it operates based on the instruction value. The servo motor 21 may be configured to receive the instruction value from the control device 2 directly, or may be configured to receive the instruction value via a device such as a controller (not shown). The servo motor 21 and the gear 25 are connected and configured to move together. The servo motor 21 rotates the gear 25 clockwise or counterclockwise in the drawing based on the instruction value.
[0026] After the servo motor 21 operates based on the instruction value, the encoder 22 outputs the encoder value to the control device 2. Note that the position information of the servo motor 21 detected as the encoder value by the encoder 22 may differ depending on the types and configurations of the servo motor 21 and the encoder 22. The instruction value and the encoder value may be configured to have the same unit system, or may be configured to be convertible so as to be comparable.
[0027] The pressing unit 23 is fixed to the rack 26 and configured to move integrally with the rack 26. The gear 25 and the rack 26 constitute a rack and pinion mechanism. The rack 26 has teeth with a pitch corresponding to that of the gear 25, and is meshed to engage with the gear 25. The gear 25 rotates clockwise or counterclockwise in the drawing by the operation of the servo motor 21. When the gear 25 rotates clockwise in the drawing, the rack 26 moves in the positive direction of the X-axis. This causes the pressing unit 23 to move in the positive direction of the X-axis. On the other hand, when the gear 25 rotates counterclockwise in the drawing, the rack 26 moves in the negative direction of the X-axis. This causes the pressing unit 23 to move in the negative direction of the X-axis. Therefore, in this embodiment, the position information detected by the encoder 22 corresponds to the amount of movement of the pressing unit 23 in the X-axis direction.
[0028] The pressing portion 23 includes a tip portion 24 configured to be deformed by contact. FIG. 3 is a schematic diagram (XY plan view) for explaining a state when the end effector 20 according to an embodiment of the present disclosure contacts an object. FIG. 3(a) is a schematic diagram (XY plan view) showing a state in which the pressing portion 23 and the object 3A are not in contact. In the state of FIG. 3(a), the length of the tip portion 24 in the X-axis direction is L1. FIG. 3(b) is a schematic diagram (XY plan view) showing a state in which the pressing portion 23 moves in the positive direction of the X-axis from the state of FIG. 3(a) and contacts the object 3A. In FIG. 3(b), the pressing portion 23 contacts the object 3A and then moves so as to press the object 3A further. As a result, the tip portion 24 is deformed and compressed in the X-axis direction, and the length in the X-axis direction becomes L2. Here, L2 is a value smaller than L1.
[0029] The tip 24 is configured to deform according to the magnitude and direction of the force when a force is applied, and to return to its original shape when the applied force is removed. Therefore, when the pressing portion 23 and the object 3A are separated from each other from the state shown in FIG. 3(b), the shape of the tip 24 returns to the state shown in FIG. 3(a). The tip 24 may be configured, for example, in a mesh shape. The tip 24 may be configured, for example, of a nonmetallic material or a metallic material. Examples of nonmetallic materials include resin, conductive thread, and rubber. Rubber may be mixed with a conductive material to provide conductivity. The pressing portion 23 may be configured to deform upon contact instead of the tip 24. In this case, the pressing portion 23 may be configured, for example, of a spring member so as to be expandable and contractible in a predetermined direction. Hereinafter, the movement of the pressing portion 23 so as to press the object may be expressed as pressing or pressing down the object. Hereinafter, the deformation in which the length of the tip 24 in the X-axis direction becomes shorter may be expressed as compression.
[0030] In this embodiment, as shown in Fig. 3, a case will be described as an example in which the tip 24 of the end effector 20 contacts the contact surface of the object perpendicularly. However, depending on the application environment of the end effector 20, the tip 24 may contact the contact surface at a certain angle from the perpendicular. Even in this case, the tip 24 may deform in response to the contact.
[0031] The stoppers 27A and 27B limit the movement range of the pressing portion 23 to a predetermined range. The stoppers 27A and 27B are arranged on the same straight line parallel to the X-axis. When the pressing portion 23 moving in the positive direction of the X-axis comes into contact with the stopper 27A, the movement of the pressing portion 23 in the positive direction of the X-axis is limited by the stopper 27A. When the pressing portion 23 moving in the negative direction of the X-axis comes into contact with the stopper 27B, the movement of the pressing portion 23 in the negative direction of the X-axis is limited by the stopper 27B. Note that the distance between the stoppers 27A and 27B shown in FIG. 2 is an example.
[0032] 4 is a schematic diagram (XY plan view) for explaining a method for determining contact between the end effector 20 and an object according to an embodiment of the present disclosure. Numerical values shown in the diagram indicate position information of the servo motor 21.
[0033] 4(a), 4(b) and 4(c) show a state in which the servo motor 21, whose initial position is 0, is given a command value of 1000 and moves the pressing unit 23 in the positive direction of the X-axis based on the command value. FIG. 4(a) illustrates a case in which the pressing unit 23, including the tip 24 having a length L1 in the X-axis direction, moves without coming into contact with any object. At this time, the encoder value is 1000. The detection unit 12 determines that the end effector 20 is not in contact with the object because the command value and the encoder value match.
[0034] 4(b) and 4(c) will be used to explain a case where the pressing unit 23 comes into contact with the target object 3B during movement. In the examples shown in FIG. 4(b) and FIG. 4(c), the positional relationship between the target object 3B and the main body of the end effector 20 is the same. In addition, although the configuration of the end effector 20 according to the embodiment of the present disclosure is different, the pressing unit 23 in FIG. 4(b) will be explained as having a configuration that does not include a tip portion 24 configured to be deformed by contact. In FIG. 4(b), the movement of the pressing unit 23 in the positive direction of the X-axis is limited by the target object 3B. At this time, the encoder value is 950.
[0035] On the other hand, the pressing portion 23 in FIG. 4(c) includes a tip portion 24 having a length L1 in the X-axis direction, similar to FIG. 4(a). Also, in FIG. 4(c), the position in the X-axis direction where the pressing portion 23 and the object 3B come into contact is similar to FIG. 4(b). In FIG. 4(c), the movement of the pressing portion 23 in the positive direction of the X-axis is restricted by the object 3B. At this time, an encoder value different from that in FIG. 4(b) is obtained due to the deformation of the tip portion 24. In this example, the encoder value is 970. In the case of FIG. 4(b), the movement of the pressing portion 23 is restricted at the time of contact with the object 3B. On the other hand, in the case of FIG. 4(c), the pressing portion 23 can move by the amount of deformation of the tip portion 24 even after contact with the object 3B. In the case of FIG. 4(c), the servo motor 21 moves the pressing portion 23 in the positive direction of the X-axis by 20 more than in the case of FIG. 4(b). At this time, the length of the tip 24 in the X-axis direction is changed from L1 to L2 due to the deformation. Note that L2 is a smaller value than L1. If the difference between the instruction value and the encoder value is equal to or greater than a predetermined threshold value, the detection unit 12 determines that the end effector 20 has come into contact with the object. The threshold value will be described later. Note that the numerical values, the end effector 20, and the object 3B shown in FIG. 4 are merely examples and are not intended to limit the embodiments of the present disclosure.
[0036] 5 is a graph showing the relationship between the difference between the command value and the encoder value and the amount of compression of the tip 24 when an object is pressed by the end effector 20. In FIG. 5, the vertical axis shows the difference between the command value and the encoder value, and the horizontal axis shows the amount of compression of the tip 24. Here, the amount of compression of the tip 24 refers to the difference in length in the X-axis direction before and after deformation of the tip 24. For example, this is the difference between L1 and L2 in FIG. 3 or FIG. 4. Also, in FIG. 5, the magnitude relationship between T1 and T2 is T1. <T2とする。
[0037] In graph 101, a state in which the difference between the instruction value and the encoder value and the amount of compression are both 0 indicates a state in which tip 24 is not deformed and is in contact with the object. Even after contact with the object, pressing portion 23 can move by deformation of tip 24. As shown in graph 101, as the amount of compression of tip 24 increases, the difference between the instruction value and the encoder value also increases. In other words, as the degree of deformation of tip 24 increases, the difference between the instruction value and the encoder value increases. Note that there is an upper limit to the degree of deformation of tip 24, and in the example of FIG. 5, T2 indicates the most deformed state.
[0038] It is preferable that the end effector 20 (pressing unit 23) can accurately apply a desired pressing force to the object. Here, the pressing force refers to the force that the pressing unit 23 applies to the object. Therefore, it is preferable that the contact can be determined for the first time when the pressing unit 23 accurately applies the desired pressing force to the object. For example, as the pressing unit 23 moves to press the object, the compression amount of the tip 24 increases, so that the pressing force is greater in the state of point A2 than in the state of point A1 in the graph 101. For example, when the desired pressing force is the pressing force in the state of point A1, it is preferable that the contact can be determined for the first time at the point A1. On the other hand, when the desired pressing force is the pressing force in the state of point A2, it is preferable that the contact can be determined for the first time at the point A2, not at the point A1. A method of setting a threshold value for such adjustment will be described later. Note that the numerical values and the shape of the graph 101 shown in FIG. 5 are merely examples, and are not intended to limit the tip 24, the object, the indication value, the encoder value, and the like.
[0039] FIG. 6 is a table diagram for explaining the scope of application of the method according to the present embodiment according to the presence or absence of deformation due to contact at the contact surface between the tip of the end effector 20 and the tip of the object. In FIG. 6, applicability is represented by a circle. Also, in FIG. 6, a configuration in which deformation occurs due to contact is represented as deforming. On the other hand, a configuration in which deformation does not occur due to contact is represented as not deforming. When the tip deforms, the tip refers to the tip 24 according to one embodiment of the present disclosure. When the contact surface of the object deforms, for example, when a key on a keyboard is pressed, the pressed key sinks to a predetermined depth, or when a button is pressed, the pressed key sinks to a predetermined depth.
[0040] In the description of this embodiment, attention is focused on the case where the tip portion is deformed and the contact surface of the object is not deformed. However, in this embodiment, the method of using the encoder value for contact determination can be applied even when both the tip portion and the contact surface of the object are deformed, or when the tip portion is not deformed and only the contact surface of the object is deformed. Moreover, the method can be applied even when neither the tip portion nor the contact surface of the object is deformed.
[0041] In this embodiment, the detection unit 12 determines that the end effector 20 has come into contact with the object when the difference between the instruction value and the encoder value is equal to or greater than a predetermined threshold value. The predetermined threshold value may vary depending on the type and configuration of the object or the tip portion 24, and may be set by a user or the like. By setting the threshold value for the difference between the instruction value and the encoder value, the instruction value output to the servo motor 21 is determined by the motor control unit 10 or a user or the like based on the instruction value.
[0042] An example of a method for setting a threshold value of the difference between the indicated value and the encoder value will be described with reference to FIGS. 7 and 8. FIG. 7 is a graph showing the relationship between the difference between the indicated value and the encoder value and the amount of compression of the tip portion 24 when the end effector 20 presses an object. In FIG. 7, the vertical axis represents the difference between the indicated value and the encoder value, and the horizontal axis represents the amount of compression of the tip portion 24. Also, in FIG. 7, the magnitude relationship among T1, T2, and T3 is assumed to be T1 < T2 < T3. It is assumed that T1 and T2 are equal to T1 and T2 shown in FIG. 5. The relationship between the difference between the indicated value and the encoder value and the amount of compression of the tip portion 24 may vary depending on the configuration of the tip portion 24 and the object. For example, in the graph 101 shown in FIG. 5, a difference between the indicated value and the encoder value occurs when the amount of compression of the tip portion 24 is around T1 (compression amount ≧ T1). On the other hand, in the graph 201 shown in FIG. 7, a difference between the indicated value and the encoder value occurs immediately after the tip portion 24 starts to be compressed (compression amount > 0).
[0043] A parameter indicating the relationship between the difference between the instruction value and the encoder value and the compression amount of the tip 24 may be created in advance by a user or the like in order to set a threshold value. Here, a graph 201 is taken as an example. For example, it is assumed that an object needs to be pressed down until the compression amount of the tip 24 reaches at least T2. At this time, a threshold value is obtained such that it is determined that the end effector 20 and the object have come into contact when the compression amount of the tip 24 is equal to or greater than T2. In the graph 201, when the compression amount of the tip 24 is T2, the difference between the instruction value and the encoder value is B. Therefore, when the object is pressed down, the threshold value of the difference between the instruction value and the encoder value for contact determination is set to B. At this time, the motor control unit 10 determines an instruction value such that the difference between the instruction value and the encoder value is equal to or greater than B, and outputs the instruction value to the servo motor 21. In addition, the difference between the instruction value and the encoder value, the compression amount of the tip 24, and the instruction value may be tabulated and used by a user or the like. The threshold value may be set within a predetermined range. For example, the threshold value may be set so that contact determination is performed when the amount of compression of tip portion 24 is within a range of T1 or more and T2 or less. When the amount of compression of tip portion 24 is T1, the difference between the instruction value and the encoder value is C. In this case, the threshold value may be set to C or more and B or less. Note that the numerical values and the shape of graph 201 shown in FIG. 7 are merely examples and are not intended to limit tip portion 24, the object, the pressing amount of the object, the instruction value, the encoder value, etc.
[0044] FIG. 8 is a graph showing the relationship between the pressing force applied to the object when the object is pressed by the end effector 20, and the difference between the indicated value and the encoder value. In FIG. 8, the vertical axis represents the pressing force applied to the object, and the horizontal axis represents the difference between the indicated value and the encoder value. Also, in FIG. 8, the magnitude relationship of P1 to P5 is P1 < P2 < P3 < P4 < P5. The parameter indicating the relationship between the pressing force applied to the object and the difference between the indicated value and the encoder value may be created in advance by the user or the like for setting the threshold value. Here, the graph 301 will be described as an example. For example, assume that the desired pressing force is P3. At this time, the difference between the indicated value and the encoder value is D. Therefore, when pressing the object, the threshold value of the difference between the indicated value and the encoder value for contact determination is set to D. At this time, the motor control unit 10 determines the indicated value so that the difference between the indicated value and the encoder value is D or more, and outputs it to the servo motor 21. Also, the difference between the indicated value and the encoder value, the pressing force applied to the object, and the indicated value may be tabulated and used by the user or the like. The threshold value may be set within a predetermined range. For example, the threshold value may be set so that contact determination is performed within the range where the pressing force is P2 or more and P3 or less. When the pressing force is P2, the difference between the indicated value and the encoder value is E. In this case, the threshold value may be set to be E or more and D or less. Note that the numerical values shown in FIG. 8 and the shape of the graph 301 are examples, and are not intended to limit the tip 24, the object, the pressing force applied to the object, the indicated value, the encoder value, and the like.
[0045] Note that the described method for setting the threshold value is merely an example, and the method for setting the threshold value is not limited to these. Therefore, the method for determining the indicated value is also not limited to these. For example, the indicated value may be determined based on a calculation formula set in advance by the user or the like.
[0046] (Operation example of the inspection system according to Embodiment 1) An operation example of the inspection system 1 according to the first embodiment will be described with reference to Fig. 9. Fig. 9 is a flowchart illustrating an operation example of the inspection system 1 according to the first embodiment. At the start of Fig. 9, the object is described as being present on the forward side in the movement direction (X-axis direction) of the pressing part 23 of the end effector 20 as shown in Fig. 3. Also, in Fig. 9, the servo motor 21 operates the pressing part 23 so as to protrude toward the object along the X-axis direction.
[0047] The motor control unit 10 of the control device 2 acquires an instruction value to be output to the servo motor 21 of the end effector 20 (step S401). The instruction value may be, for example, a value stored in advance in the memory 14 according to the configuration of the target object or the tip portion 24, or may be set by a user or the like.
[0048] The motor control unit 10 outputs the acquired instruction value to the servo motor 21 (step S402). The servo motor 21 operates based on the instruction value. This causes the gear 25 to rotate and the rack 26 to move, so that the pressing unit 23 moves in the direction of the target object.
[0049] After the movement of the pressing unit 23 is completed (step S403), the encoder 22 detects position information of the servo motor 21 and outputs it as an encoder value to the acquiring unit 11. The acquiring unit 11 acquires the encoder value from the encoder 22 (step S404).
[0050] The acquiring unit 11 outputs the encoder value and the instruction value acquired from the motor control unit 10 to the detecting unit 12. Here, the instruction value and the encoder value may be in the same unit system. For example, the instruction value and the encoder value may both be values indicating the rotation angle of the servo motor 21. When the instruction value and the encoder value are in different unit systems, the acquiring unit 11 may be configured to convert them into the same unit system so that they can be compared.
[0051] The detection unit 12 calculates the difference between the instruction value and the encoder value acquired from the acquisition unit 11. The detection unit 12 determines whether the calculated difference is equal to or greater than a threshold value (step S405). The threshold value is set, for example, by the method described with reference to Figs. 7 and 8.
[0052] If the difference between the instruction value and the encoder value is equal to or greater than a predetermined threshold value (step S405; YES), the detection unit 12 determines that the end effector 20 has come into contact with the object (step S406). The detection unit 12 outputs the determination result to the output unit 13.
[0053] The output unit 13 notifies the user of the determination result (step S407). For example, the output unit 13 may display the determination result on a display device (not shown) prepared by the user. Alternatively, the output unit 13 may notify the user of the determination result by communicating with a device owned by the user.
[0054] If the difference between the instruction value and the encoder value is not equal to or greater than the predetermined threshold value (step S405; NO), the detection unit 12 determines that the end effector 20 is not in contact with the object (step S408). The detection unit 12 outputs the determination result to the acquisition unit 11. The acquisition unit 11 outputs the determination result acquired from the detection unit 12 to the motor control unit 10. When the motor control unit 10 acquires the determination result, it corrects the instruction value (step S409). For example, the motor control unit 10 may correct the instruction value based on the difference between the instruction value before correction and the encoder value. The motor control unit 10 may output an instruction value to the servo motor 21 that is larger than the instruction value before correction, or may output an instruction value to the servo motor 21 that is smaller than the instruction value before correction. The motor control unit 10 may also move the pressing unit 23 by the same distance as the immediately preceding movement distance without correcting the instruction value. After the instruction value is corrected, the process of the inspection system 1 returns to step S402, and the process is repeated.
[0055] As described above, in this embodiment, an inspection system (e.g., inspection system 1) includes an end effector (e.g., end effector 20) and a control device (e.g., control device 2) that controls the end effector. The end effector includes a tip portion (e.g., tip portion 24) made of a member that deforms upon contact with an object, and a servo motor (e.g., servo motor 21) that moves the position of the tip portion in a predetermined direction. The control device includes a motor control unit (e.g., motor control unit 10) that controls the servo motor using an instruction value, an acquisition unit (e.g., acquisition unit 11) that acquires position information from the servo motor when it operates based on the instruction value, and a detection unit (e.g., detection unit 12) that detects contact between the end effector and an object based on the difference between the instruction value and the position information.
[0056] This makes it possible to accurately detect contact between the end effector and an object, even if the tip of the end effector is made of a material having a certain degree of elasticity.
[0057] The motor control unit also determines an instruction value based on the difference between an instruction value defined corresponding to the amount of compression of the tip portion and the position information.
[0058] This allows the indication value to be determined according to the configuration of the tip portion.
[0059] The motor control unit also determines an instruction value based on the difference between an instruction value defined corresponding to the pressure applied to the object and the position information.
[0060] This allows the object to be pressed down with a desired pressure.
[0061] The tip portion is configured to have a mesh shape.
[0062] This allows the tip to be configured like a mesh that can absorb forces during contact.
[0063] The tip portion is made of a non-metallic material.
[0064] As a result, the tip portion is made of, for example, a resin material, rubber, or the like.
[0065] The tip portion is made of a metal material.
[0066] As a result, the tip portion is made of a highly conductive metal material.
[0067] (Embodiment 2) In the second embodiment, an inspection system 1 in which an end effector 20 is attached to the tip of a robot will be described. In the first embodiment described above, the control device 2 is configured to control the end effector 20. Meanwhile, in the second embodiment, a configuration in which the control device 2 controls the robot and the end effector 20 via the robot will be described.
[0068] In the description of the inspection system 1 according to the second embodiment, the description of the same contents as those of the inspection system 1 according to the first embodiment will be simplified or omitted, and the description will focus on the differences. The inspection system 1 according to the second embodiment is configured to control the robot and the end effector 20 to manipulate an object, and to notify a user or the like of the inspection result as to whether or not the object has operated as expected. In the second embodiment, manipulating an object means causing the end effector 20 to press the object once or multiple times to cause the object to perform a predetermined operation.
[0069] FIG. 10 is a block diagram showing a configuration example of an inspection system 1 according to a second embodiment. The inspection system 1 includes a control device 2, an end effector 20, and a robot 40. In the second embodiment, a touch panel display 30 is taken as an example of an object to be inspected. The configuration of the inspection system 1 shown in FIG. 10 is an example. Therefore, the inspection system 1 may further include a portion other than the configuration shown in FIG. 10. For example, a plurality of robots different from the robot 40 may be controlled by the control device 2, and a plurality of objects different from the touch panel display 30 may be operated and inspected by the inspection system 1.
[0070] The robot 40 is, for example, a six-axis articulated robot, and the end effector 20 is attached to the tip of the robot. The robot 40 is not limited to a six-axis articulated robot, and may be, for example, a portable small robot. An example of a portable small robot is an orthogonal robot with three or less axes. In this embodiment, the robot 40 is configured to be controllable by the control device 2. For example, the robot 40 is configured to include a servo motor (not shown) and an encoder (not shown). The servo motor acquires an instruction value output from the motor control unit 10, and the encoder outputs an encoder value to the acquisition unit 11. The control device 2 causes the robot 40 to perform an operation based on the instruction value and the encoder value.
[0071] The motor control unit 10 outputs an instruction value to the servo motor 21 via the robot 40. The robot 40 may be configured to acquire the instruction value output by the motor control unit 10 and output the instruction value to the servo motor 21. Although not shown in FIG. 10, the motor control unit 10 may be configured to output an instruction value directly to the servo motor 21.
[0072] The acquiring unit 11 acquires the encoder value from the encoder 22 via the robot 40. The robot 40 may be configured to acquire the encoder value output by the encoder 22, and output the encoder value to the acquiring unit 11. Although not shown in FIG. 10, the acquiring unit 11 may be configured to acquire the encoder value directly from the encoder 22. In addition, the acquiring unit 11 is configured to be able to exchange signals with the touch panel display 30.
[0073] Fig. 11 is a schematic diagram for explaining an example of the operation of the robot 40 according to the second embodiment. As shown in Fig. 11, the robot 40 may be, for example, a multi-joint (multi-axis) robot arm composed of a plurality of joints. The robot 40 may be configured to be capable of moving the end effector 20 to any position in a three-dimensional space.
[0074] In this embodiment, the robot 40, for example, brings the end effector 20 close to the touch panel display 30. Thereafter, the pressing portion 23 of the end effector 20 moves in the positive direction of the X-axis to press the touch panel display 30. As described in the explanation of the first embodiment, contact between the end effector 20 and the touch panel display 30 is determined. The above operation is repeated once or a plurality of times to cause the touch panel display 30 to execute a predetermined operation.
[0075] The force, i.e., the pressing force, applied when the end effector 20 presses down on the touch panel display 30 may be set in advance. The inspection system 1 is configured to be able to perform calibration of the instruction value based on the setting. That is, the inspection system 1 is configured to be able to adjust the instruction value so that the difference between the instruction value obtained when the end effector 20 presses down on the touch panel display 30 and the encoder value becomes a predetermined value.
[0076] In FIG. 11, the calibration will be described by taking as an example a case where the end effector 20 is parallel to the X-axis and the operation surface of the touch panel display 30 is not parallel to the YZ plane. In addition, in the description of the calibration, the end effector 20 is assumed to be moved on the same YZ plane by the robot 40. For convenience of explanation, the positive direction of the X-axis may be referred to as "back", the negative direction of the X-axis as "front", the positive direction of the Y-axis as "up", the negative direction of the Y-axis as "down", the positive direction of the Z-axis as "left", and the negative direction of the Z-axis as "right". In addition, when the touch panel display 30 is not perpendicular to the X-axis, it may be referred to as the touch panel display 30 being tilted. Note that these expressions related to directions are used for convenience of explanation and are not intended to limit the arrangement or posture of the inspection system 1 during operation.
[0077] Fig. 12 is a schematic diagram showing an example of the inclination of the touch panel display 30 according to the second embodiment. Fig. 12 shows a YZ plane view of the touch panel display 30 seen from the front and an XZ plane view of the touch panel display 30 seen from above. The three-dimensional coordinate system in Fig. 12 and the three-dimensional coordinates in Fig. 11 correspond in orientation. Therefore, the direction toward the back of the YZ plane view in Fig. 12 is the positive direction of the X axis, and the direction toward the front of the XZ plane view in Fig. 12 is the positive direction of the Y axis. In Fig. 12, the robot 40 is present in the negative direction of the X axis from the touch panel display 30 as in Fig. 11.
[0078] In FIG. 12, the touch panel display 30 is inclined so that the left side is in front and the right side is in the back as shown in the XZ plane view. That is, the left side of the touch panel display 30 is closer to the robot 40, and the right side is farther from the robot 40. Here, the robot 40 moves the end effector 20 on the same YZ plane and presses the center, left side, and right side of the touch panel display 30. When the instruction value is always a constant value, the force pressing the right side is weaker and the force pressing the left side is stronger than the force pressing the center. Therefore, when the touch panel display 30 is inclined, depending on the position where the touch panel display 30 is pressed, there is a possibility that the pressing force is stronger or weaker than the desired pressing force. In addition, in this case, the difference between the instruction value and the encoder value is larger when the left side is pressed and smaller when the right side is pressed than the value when the center is pressed.
[0079] The inspection system 1 is configured to be able to adjust the indication value by calibration so that the difference between the indication value and the encoder value exceeds a predetermined threshold value even when the touch panel display 30 is tilted.
[0080] Fig. 13 is a table diagram for explaining a change in indication value due to calibration according to the second embodiment. Pressed positions 31A to 31E correspond to the center, upper left, lower left, lower right, and upper right of touch panel display 30, respectively, as shown in Fig. 12. Calibration is performed by pressing 31A to 31E of touch panel display 30. Note that pressed positions 31A to 31E are merely examples, and are not intended to limit the number or positions at which end effector 20 presses touch panel display 30.
[0081] 13, the instruction value before calibration is 500 regardless of the pressed position. Note that the value 500 is an example for the purpose of explanation, and is not intended to limit the actual position information of the servo motor 21. The same applies to the encoder value and the difference between the instruction value and the encoder value.
[0082] When the instruction value is 500, the differences between the instruction value and the encoder value when pressing the press positions 31A to 31E are 10, 14, 15, 5, and 4, respectively. This shows that the left side of the touch panel display 30 is tilted forward, the right side is tilted backward, the lower side is tilted forward, and the upper side is tilted backward. The inspection system 1 performs calibration so that the differences between the instruction value and the encoder value when pressing the press positions 31A to 31E are all 10. Through the calibration, the instruction values at the press positions 31A to 31E are adjusted to 500, 400, 300, 600, and 700, respectively.
[0083] The indication value adjusted by calibration does not have to be limited to the indication value at the press positions 31A-31E. For example, the indication value at any position on the touch panel display 30 may be adjusted based on the result of the calibration performed by pressing the press positions 31A-31E. The control device 2 may be configured to be able to calculate the inclination of the touch panel display 30 based on, for example, the result of the calibration. Furthermore, the control device 2 may be configured to be able to adjust the indication value when pressing any position based on, for example, the calculation.
[0084] As described above, by performing the calibration, it becomes possible to operate the touch panel display 30 with a desired pressing force. For convenience of explanation, the robot 40 has been described as moving the end effector 20 on the same YZ plane, but the end effector 20 may be movable to any position in three-dimensional space. When adjusting the instruction value by calibration, the inspection system 1 may take into consideration the position of the end effector 20 in the X-axis direction and the moving range of the pressing unit 23 limited by the stoppers 27A and 27B.
[0085] Next, an example of the calibration operation will be described with reference to Fig. 14. Fig. 14 is a flowchart illustrating an example of the calibration operation of the inspection system 1 according to the second embodiment.
[0086] When the inspection system 1 starts calibration, the detection unit 12 of the control device 2 obtains a target value of the difference between the instruction value and the encoder value (step S501). The target value may be, for example, a value stored in advance in the memory 14 according to the configuration of the object or the tip portion 24, or may be set by the method described with reference to FIG. 7, FIG. 8, etc., as in the first embodiment. When the touch panel display 30 is pressed after calibration, the difference between the instruction value and the encoder value becomes the target value. In the description of this flowchart, the numerical values and pressed positions shown in FIG. 13 are used. For example, the target value in the description of this flowchart is set to 10, which is the difference between the instruction value and the encoder value after calibration in FIG. 13.
[0087] The motor control unit 10 acquires an instruction value to be output to the servo motor 21 (step S502). The instruction value may be determined, for example, in correspondence with the target value 10 acquired in step S501. In the example of FIG. 13, the instruction value acquired by the motor control unit 10 is 500.
[0088] The motor control unit 10 focuses on one of the pressed positions on the touch panel display 30 for which adjustment of the instruction value has not been completed (step S503). The pressed position may be set in advance by the control device 2 according to the configuration of the target object, or may be set by the user or the like. In this embodiment, it is assumed that the coordinates and number of the pressed position are predefined in advance, as shown in FIG. 13. In the following explanation of each step, a case where the motor control unit 10 focuses on the pressed position 31A and a case where the motor control unit 10 focuses on the pressed position 31B are respectively given as examples.
[0089] The control device 2 operates the robot 40 to adjust the position of the end effector 20 (step S504). Specifically, the control device 2 causes the robot 40 to move the end effector 20 to a position in front of the focused pressing position on the touch panel display 30. Here, the control device 2 may operate the robot 40 by exchanging signals with, for example, a servo motor (not shown) and an encoder (not shown) of the robot 40, so that the tip 24 of the end effector 20 is positioned at a desired position.
[0090] When the pressing position 31A is being focused on, the end effector 20 is disposed in front of the pressing position 31A, and when the pressing position 31B is being focused on, the end effector 20 is disposed in front of the pressing position 31B.
[0091] The motor control unit 10 outputs the instruction value acquired in step S502 to the servo motor 21, thereby causing the pressing unit 23 of the end effector 20 to press the focused pressing position (step S505). The acquisition unit 11 acquires an encoder value from the encoder 22 (step S506). The detection unit 12 determines whether or not the difference between the instruction value and the encoder value is different from the target value acquired in step S501 (step S507).
[0092] 13, when press position 31A is pressed with a designated value of 500, the difference between the designated value and the encoder value is 10, which matches the target value of 10. When press position 31B is pressed with a designated value of 500, the difference between the designated value and the encoder value is 14, which is different from the target value of 10.
[0093] If the difference between the instruction value output to the servo motor 21 in step S505 and the encoder value acquired by the acquisition unit 11 in step S506 is different from the target value acquired in step S501 (step S507; YES), the detection unit 12 judges whether or not the robot 40 needs to be operated (step S508). An example of a case where the robot 40 needs to be operated is when the pressing unit 23 needs to move beyond its own moving range in order for the difference between the instruction value and the encoder value to match the target value. Here, whether or not the robot 40 needs to be operated may be judged based on the difference between the current instruction value and the encoder value. If the difference between the instruction value and the encoder value matches the target value (step S507; NO), the processing of the inspection system 1 proceeds to step S510.
[0094] For example, when pressed position 31B is being focused on, the process of the inspection system 1 proceeds from step S507 to step S508. On the other hand, when pressed position 31A is being focused on, the process of the inspection system 1 proceeds from step S507 to step S510.
[0095] If the robot 40 needs to be operated (step S508; YES), the process of the inspection system 1 returns to step S504 and repeats the process. If the robot does not need to be operated (step S508; NO), the motor control unit 10 corrects the current instruction value based on the difference between the current instruction value and the encoder value so that the difference between the instruction value and the encoder value becomes equal to the target value (step S509). After that, the process of the inspection system 1 returns to step S505 and repeats the process.
[0096] When the pressed position 31B is focused on, the process is repeated in this manner to correct the indicated value and make the difference between the indicated value and the encoder value coincide with the target value. The indicated value at the pressed position 31B is corrected from 500 to 400, and the difference between the indicated value and the encoder value in this case becomes 10. Next, a case where the process of the inspection system 1 proceeds from step S507 to step S510 will be described.
[0097] The inspection system 1 completes the adjustment of the indication value at the focused pressing position (step S510). Specifically, for example, the detection unit 12 may store the indication value in the memory 14 so that it can be called when the pressing position is pressed. After step S510, the process of the inspection system 1 proceeds to step S511.
[0098] When attention is focused on pressed position 31A, adjustment of the indicated value at pressed position 31A is completed in step S510. When attention is focused on pressed position 31B, the indicated value is corrected so that the difference between the indicated value and the encoder value coincides with the target value, and then adjustment of the indicated value at pressed position 31B is completed in step S510.
[0099] The detection unit 12 determines whether or not there is a pressed position for which adjustment of the instruction value has not been completed (step S511). If there is a pressed position for which adjustment of the instruction value has not been completed (step S511; YES), the process of the inspection system 1 returns to step S503 and repeats the process.
[0100] If there is no pressed position for which adjustment of the instruction value has not been completed (step S511; NO), the calibration is completed.
[0101] When pressed position 31A is focused on first, each process in Fig. 14 is performed for pressed positions 31B to 31E. When pressed position 31B is focused on first, each process in Fig. 14 is performed for pressed positions 31A, 31C to 31E. Note that in the explanation of this flowchart, the numerical values and pressed positions shown in Fig. 13 are used, but this is not intended to limit the designated value, the encoder value, the difference between the designated value and the encoder value, and the pressed position.
[0102] (Example of Operation of Inspection System According to Second Embodiment) An operation example of the inspection system 1 according to the embodiment 2 will be described with reference to Fig. 15. Fig. 15 is a flowchart illustrating an operation example of the inspection system 1 according to the embodiment 2. In the description of the operation example of the inspection system 1 according to the embodiment 2, the description of the same contents as those of the operation example of the inspection system 1 according to the embodiment 1 may be simplified or omitted.
[0103] When the inspection system 1 starts an operation in response to an instruction from a user or the like, it executes calibration (step S601). In this step, the calibration process described with reference to FIG. 14 is performed.
[0104] After the calibration is completed, the control device 2 operates the robot 40 to adjust the position of the end effector 20 based on the operation procedure of the touch panel display 30 (step S602). The operation procedure of the touch panel display 30 may be set in advance by a user or the like. For example, when the first operation procedure is to press the center of the touch panel display 30, the end effector 20 is moved to the front of the center of the touch panel display 30.
[0105] When the position adjustment of the end effector 20 is completed, the inspection system 1 operates the touch panel display 30 by the end effector 20 and determines contact between the end effector 20 and the touch panel display 30 (step S603). The instruction value output to the servo motor 21 may be adjusted based on the result of the calibration. The instruction value may be corrected during the operation and contact determination process. The predetermined threshold value of the difference between the instruction value and the encoder value used for the contact determination may be a target value set when the calibration is performed. In step S603, the contact determination process described with reference to FIG. 9 is performed.
[0106] The acquisition unit 11 acquires a feedback signal output from the touch panel display 30 when the end effector 20 operates the touch panel display 30 (step S604). The acquisition unit 11 outputs the feedback signal to the detection unit 12.
[0107] Based on the feedback signal output from touch panel display 30, detection unit 12 determines whether touch panel display 30 is outputting a feedback signal that is defined in advance in response to an operation (step S605).
[0108] When the touch panel display 30 is outputting a predetermined feedback signal corresponding to the operation (step S605; YES), the control device 2 determines whether or not the operation of the touch panel display 30 is completed (step S608). The determination of whether or not the operation of the touch panel display 30 is completed is made based on the feedback signal output from the touch panel display 30, for example, as in the determination in step S605.
[0109] If the operation of the touch panel display 30 is not completed (step S608; NO), the process of the inspection system 1 returns to step S602 and repeats the process. If the operation of the touch panel display 30 is completed (step S608; YES), the detection unit 12 outputs the determination result of step S608 to the output unit 13, and the process of the inspection system 1 proceeds to step S609.
[0110] If the touch panel display 30 does not output a predefined feedback signal corresponding to the operation (step S605; NO), the detection unit 12 judges whether or not to retry the operation (step S606). The case where the touch panel display 30 does not output a predefined feedback signal corresponding to the operation includes, for example, a case where the feedback signal is not output at all, or a case where the output feedback signal is different from the defined feedback signal. In such a case, whether or not to retry the operation may be set by the user, etc. Also, for example, the number of times the same operation can be retried may be set by the user, etc.
[0111] If the operation of the touch panel display 30 is not to be retried (step S606; NO), the detection unit 12 outputs the determination result in step S605 to the output unit 13, and the processing of the inspection system 1 proceeds to step S609.
[0112] If the operation of the touch panel display 30 is to be retried (step S606; YES), the detection unit 12 determines whether or not to retry from the operation of the robot 40 (step S607). If the operation of the robot 40 is to be retried (step S607; YES), the processing of the inspection system 1 returns to step S602 and the processing is repeated. In this case, the operation is retried from the position adjustment of the end effector 20 by the robot 40.
[0113] If the operation of the robot 40 is not to be retried (step S607; NO), the processing of the inspection system 1 returns to step S603 and the processing is repeated. In this case, the positions of the robot 40 and the end effector 20 in the three-dimensional space do not change, and the operation of the touch panel display 30 by the pressing unit 23 is retried.
[0114] The output unit 13 outputs the inspection result (step S609). When the process proceeds from step S608 to step S609, the output unit 13 outputs that the touch panel display 30 has completed a predetermined operation. The predetermined operation is, for example, an operation of the touch panel display 30 that is predefined by the user or the like when the touch panel display 30 is operated based on an operation procedure predefined by the user or the like. When the process proceeds from step S606 to step S609, the output unit 13 outputs that the touch panel display 30 has not completed the predetermined operation. The output unit 13 may output, for example, in which of the operation procedures predefined by the user or the like, the touch panel display 30 did not output a predefined feedback signal.
[0115] The inspection results are stored (step S610), completing the operation of the inspection system 1. The inspection results may be stored in the memory 14, or in a terminal or the like set by the user or the like.
[0116] As described above, in this embodiment, the control device calibrates the instruction value so that the difference between the instruction value and the position information when at least one point on an object (e.g., touch panel display 30) is pressed with the end effector becomes a specified difference.
[0117] This makes it possible to press the object with a constant pressure, regardless of the position on the object where it is pressed, even if the object is tilted, for example.
[0118] In addition, the acquisition unit acquires a signal output when an object comes into contact with the end effector, and the detection unit detects contact between the end effector and the object based on the signal.
[0119] This can improve the reliability of the collision determination.
[0120] (Other embodiments) In the above-mentioned second embodiment, an example has been shown in which the instruction value is adjusted by calibration when the target object is tilted. However, this is not limited to this, and for example, information on the shape, tilt, etc. of the target object may be input in advance by a user or the like to the control device 2, and the control device 2 may be able to adjust the instruction value based on the information.
[0121] Information on the shape, inclination, etc. of the object may be acquired by, for example, a camera (not shown). In this case, the control device 2 may be configured to be able to acquire image information acquired by the camera. The shape of the object may be, for example, a spherical shape, a planar shape with irregularities, etc., in addition to a planar shape like the touch panel display 30 described in the second embodiment above.
[0122] Information on the shape, inclination, etc. of the target object may be recorded in, for example, the memory 14. The control device 2 may control the robot 40 and the end effector 20 based on, for example, the information recorded in the memory 14. Specifically, the control device 2 may calculate, for example, the coordinates of one or more pressed positions of the target object in a three-dimensional coordinate system based on the information. Furthermore, the control device 2 may adjust the instruction value corresponding to the pressed positions based on, for example, the coordinate calculation result and the current coordinates of the robot 40 and the end effector 20 in the three-dimensional coordinate system.
[0123] Also, the shape of the object may be changed by pressing the object as shown in FIG. 6. The case where the shape of the object is changed may include, for example, a case where a button switch is pressed and sinks, the position is locked when the button switch sinks to a predetermined depth, and the lock is released by pressing the button switch again. In this way, when the shape of the object is changed before and after pressing, the shapes of the object before and after pressing may be input in advance to the control device 2 by a user or the like. In the case of the button switch given as an example above, the control device 2 may control the position of the robot 40 or the end effector 20 or adjust the instruction value before and after pressing the button switch.
[0124] This makes it possible to press the object with a predetermined pressing force according to various shapes of the object, for example, even if the object is tilted, regardless of the pressing position on the object.
[0125] Even if the shape of the target object is not flat like the touch panel display 30 described in the second embodiment, the indication value may be adjusted by calibration.
[0126] In the above-mentioned second embodiment, an example was shown in which the target value of the difference between the instruction value and the encoder value after calibration is made constant at each pressing position. However, this is not limited to this, and the required target value may be different depending on the pressing position of the object, for example. This allows the object to be pressed with a desired pressing force depending on the pressing position.
[0127] 15 may be based on image information. For example, the detection unit 12 may determine whether or not a display image of the touch panel display 30 when a predetermined operation is performed matches a display image of the touch panel display 30 captured after an operation by the end effector 20. The display image of the touch panel display 30 may be captured by, for example, a camera. This makes it possible to determine whether or not the target object has performed a desired operation based on image information captured by a camera or the like.
[0128] In the above embodiment, the encoder 22 is configured to acquire the encoder value after the servo motor 21 completes its operation. However, the present invention is not limited to this, and the encoder value may be acquired and output to the acquisition unit 11 even while the servo motor 21 is in operation. This allows the contact determination to be performed more quickly than when the contact determination is performed after the servo motor 21 completes its operation.
[0129] In the above embodiment, a method of using an encoder value for contact determination has been described. In addition to the method of using an encoder value, for example, a feedback signal output from an object at the time of contact may be used for contact determination. For example, in step S604 of FIG. 15, the acquisition unit 11 acquires a feedback signal output from the touch panel display 30 and outputs the feedback signal to the detection unit 12. The detection unit 12 may perform contact determination based on the feedback signal. Here, the feedback signal from the object such as the touch panel display 30 may be a signal indicating that the end effector has come into contact with the object. This can improve the reliability of contact determination.
[0130] In addition, programs and applications for realizing the functions of one or more of the above-mentioned embodiments can be supplied to a system or device via a network or storage medium, and the programs can be read and executed by one or more processors in a computer of the system or device.
[0131] Moreover, it may be realized by a circuit that realizes one or more functions (for example, an Application Specific Integrated Circuit (hereinafter, referred to as "ASIC") or an FPGA).
[0132] Summary of the Disclosure The above description of the embodiments discloses the following techniques.
[0133] <Technology 1> The inspection system includes an end effector and a control device that controls the end effector. The end effector includes a tip portion made of a member that deforms upon contact with an object, and a servo motor that moves the position of the tip portion in a predetermined direction. The control device includes a motor control unit that controls the servo motor using an instruction value, an acquisition unit that acquires position information from the servo motor when it operates based on the instruction value, and a detection unit that detects contact between the end effector and an object based on the difference between the instruction value and the position information. This makes it possible to accurately detect contact between the end effector and an object, even if the tip of the end effector is made of a material having a certain degree of elasticity.
[0134] <Technology 2> In the inspection system described in the above technique, the motor control unit may determine the instruction value based on the difference between the instruction value defined corresponding to the compression amount of the tip portion and the position information. This allows the indication value to be determined according to the configuration of the tip portion.
[0135] <Technology 3> In the inspection system according to at least one of the above techniques, the motor control unit may determine the instruction value based on a difference between an instruction value defined corresponding to a pressing force applied to the object and the position information. This allows the object to be pressed down with a desired pressure.
[0136] <Technology 4> In the inspection system according to at least one of the above techniques, the motor control unit may determine the instruction value based on information including at least one of the shape of the object and its inclination with respect to a plane perpendicular to an axis parallel to a predetermined direction. This makes it possible to press the object with a predetermined pressing force according to various shapes of the object, for example, even if the object is tilted, regardless of the pressing position on the object.
[0137] <Technology 5> In an inspection system described in at least one of the above techniques, the control device may calibrate the instruction value so that the difference between the instruction value and the position information when at least one point on an object is pressed with the end effector is a specified difference. This makes it possible to press the object with a constant pressure, regardless of the position on the object where it is pressed, even if the object is tilted, for example.
[0138] <Technology 6> In an inspection system described in at least one of the above technologies, the acquisition unit may acquire a signal output when an object comes into contact with the end effector, and the detection unit may detect contact between the end effector and the object based on the difference between the instruction value and the position information and the signal. This can improve the reliability of the collision determination.
[0139] <Technology 7> In the inspection system according to at least one of the above techniques, the signal from the object may be a signal indicating that the end effector has contacted the object. This can improve the reliability of the collision determination.
[0140] <Technology 8> In the inspection system according to at least one of the above techniques, the tip portion may be configured in a mesh shape. This allows the tip to be configured like a mesh that can absorb forces during contact.
[0141] <Technology 9> In the inspection system according to at least one of the above techniques, the tip portion may be made of a non-metallic material. As a result, the tip portion is made of, for example, a resin material, rubber, or the like.
[0142] <Technology 10> In the inspection system according to at least one of the above techniques, the tip portion may be made of a metallic material. As a result, the tip portion is made of a highly conductive metal material.
[0143] <Technology 11> The control device for an end effector includes a tip made of a member that deforms upon contact with an object, and a servo motor that moves the position of the tip in a predetermined direction.The control device has a motor control unit that controls the servo motor using an instruction value, an acquisition unit that acquires position information from the servo motor when it operates based on the instruction value, and a detection unit that detects contact between the end effector and an object based on the difference between the instruction value and the position information. This makes it possible to accurately detect contact between the end effector and an object, even if the tip of the end effector is made of a material having a certain degree of elasticity.
[0144] <Technology 12> A control method for an end effector including a tip portion made of a member that deforms upon contact with an object, and a servo motor that moves the position of the tip portion in a predetermined direction, controls the servo motor using an instruction value, obtains position information from the servo motor when it operates based on the instruction value, and detects contact between the end effector and the object based on the difference between the instruction value and the position information. This makes it possible to accurately detect contact between the end effector and an object, even if the tip of the end effector is made of a material having a certain degree of elasticity.
[0145] Although various embodiments have been described above with reference to the drawings, it goes without saying that the present disclosure is not limited to such examples. It is clear that a person skilled in the art can conceive of various modifications, corrections, substitutions, additions, deletions, and equivalents within the scope of the claims, and it is understood that these also naturally belong to the technical scope of the present disclosure. In addition, the components in the various embodiments described above may be arbitrarily combined within the scope of the invention. [Industrial Applicability]
[0146] The present disclosure is useful as an inspection system, an end effector control device, and an end effector control method. [Explanation of symbols]
[0147] 1 Inspection system 2. Control device 3A, 3B Object 10 Motor control unit 11 Acquisition Department 12 Detection unit 13 Output section 14. Memory 20 End Effector 21 Servo motor 22 Encoder 23 Pressing section 24 Tip 25 Gears 26 Rack 27A, 27B Stopper 30 Touch Panel Display 31A, 31B, 31C, 31D, 31E Pressing position 40 Robot
Claims
1. An end effector; A control device for controlling the end effector; An inspection system comprising: The end effector includes: A tip portion made of a member that deforms upon contact with an object; A servo motor that moves the position of the tip in a predetermined direction; The present invention relates to a method for manufacturing a computer-implemented ... The control device includes: A motor control unit that controls the servo motor using an instruction value; an acquisition unit that acquires, from the servo motor, position information when the servo motor operates based on the instruction value; a detection unit that detects contact between the end effector and the object based on a difference between the instruction value and the position information; An inspection system comprising:
2. The motor control unit determines the instruction value based on a difference between the instruction value and the position information, the difference being defined corresponding to a compression amount of the tip portion. The inspection system of claim 1 .
3. The motor control unit determines the instruction value based on a difference between the instruction value and the position information, the difference being defined in correspondence with a pressing force applied to the object. The inspection system of claim 1 .
4. the motor control unit determines the instruction value based on information including at least one of a shape of the object and an inclination of the object with respect to a plane perpendicular to an axis parallel to the predetermined direction; The inspection system of claim 1 .
5. the control device calibrates the instruction value so that a difference between the instruction value and the position information when at least one point of the object is pressed by the end effector becomes a specified difference. The inspection system of claim 1 .
6. The acquisition unit further acquires a signal from the object, The detection unit detects contact between the end effector and the object based on a difference between the instruction value and the position information and the signal. The inspection system of claim 1 .
7. the signal from the object is a signal indicating that the end effector has come into contact with the object; The inspection system of claim 6.
8. The tip portion is configured in a mesh shape, The inspection system of claim 1 .
9. The tip portion is made of a non-metallic material. The inspection system of claim 1 .
10. The tip portion is made of a metal material. The inspection system of claim 1 .
11. A tip portion made of a member that deforms upon contact with an object; A servo motor that moves the position of the tip in a predetermined direction; A control device for an end effector comprising: A motor control unit that controls the servo motor using an instruction value; an acquisition unit that acquires, from the servo motor, position information when the servo motor operates based on the instruction value; a detection unit that detects contact between the end effector and the object based on a difference between the instruction value and the position information; A control device having the above configuration.
12. A tip portion made of a member that deforms upon contact with an object; A servo motor that moves the position of the tip in a predetermined direction; A method for controlling an end effector comprising: The servo motor is controlled using an instruction value; acquiring position information from the servo motor when the servo motor operates based on the instruction value; A control method comprising: detecting contact between the end effector and the object based on a difference between the instruction value and the position information.
Citation Information
Patent Citations
Automatic door device and contact detection device used for the automatic door device
JP2006083526A
Cited By
Robot system for engineering monitoring
CN120245082A
