Robot system and printer
The robot system stabilizes ink landing by using a weight and counter mechanism to compensate for vibrations, addressing trajectory shifts and ensuring precise printing on three-dimensional surfaces.
Patent Information
- Application Number
- JP2023070711
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-04-24
- Publication Date
- 2024-11-06
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The shaking of the robot's trajectory during printing causes shifts in the ink landing position, and attempting to correct this with head vibration leads to robot arm vibration, making precise landing difficult.
A robot system with a head unit and stage drive mechanism, where a weight portion on the opposite side of the ejection head compensates for displacement by vibrating in an opposite phase to the stage movement, and a counter mechanism applies a counter inertial force to attenuate vibrations.
This configuration stabilizes the ink landing position by counteracting vibrations, reducing image disturbances and ensuring precise printing on three-dimensional surfaces.
Smart Images

Figure 2024156337000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a robot system and a printing apparatus. [Background technology]
[0002] A system including a print head and a robot is known. In the system described in Patent Document 1, the robot moves the print head along the surface of an object. The robot generates a primary motion to form at least two print tracks located side by side on the sides of the print head. A piezo actuator generates a secondary motion performed approximately perpendicular to the primary motion to cause the print tracks to be adjacent to each other laterally. The system reduces strips formed between the print tracks by the secondary motion. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2013-202781 A Summary of the Invention [Problem to be solved by the invention]
[0004] When a robot moves a print head in a specific direction to print, the robot's trajectory becomes unstable, causing deviations in the ink landing position. If you try to correct this by vibrating the print head, the reaction force will cause the robot arm to vibrate, making it difficult to correct the landing position. [Means for solving the problem]
[0005] The robot system of the present disclosure comprises a head unit having an ejection head that ejects liquid, a stage that supports the ejection head, and a stage driving mechanism that moves the stage, and a robot that supports the head unit and moves the ejection head in a predetermined direction when the ejection head ejects the liquid, the stage driving mechanism moves the stage when the ejection head ejects the liquid and corrects displacement caused by the movement of the robot, and the head unit has a weight portion that is positioned on the opposite side to the ejection head with respect to the axis of the robot's tip arm, and the weight portion vibrates in the opposite phase to the movement of the stage.
[0006] The printing device disclosed herein comprises a head unit having a print head that ejects ink, a stage that supports the print head, and a stage driving mechanism that moves the stage, and a robot that supports the head unit and moves the print head in a predetermined direction when the print head ejects the ink, the stage driving mechanism corrects displacement caused by movement of the robot when the print head ejects the ink, and the head unit has a weight portion that is positioned on the opposite side to the print head with respect to the axis of the robot's tip arm, and the weight portion vibrates in the opposite phase to the movement of the stage. [Brief description of the drawings]
[0007] [Figure 1] FIG. 1 is a diagram showing an overall configuration including a robot system and a control device. [Diagram 2] FIG. 2 is a diagram showing an end effector connected to an articulated robot. [Diagram 3] FIG. 2 is a diagram showing a schematic configuration of an end effector. [Figure 4] FIG. 2 is a block diagram showing the configuration of a robot system and a control device. [Figure 5A] FIG. 4 is a diagram showing the state of the end effector. [Figure 5B] FIG. 4 is a diagram showing the state of the end effector. [Figure 5C]FIG. 4 is a diagram showing the state of the end effector. [Figure 6A] FIG. 4 is a diagram showing the state of the end effector. [Figure 6B] FIG. 4 is a diagram showing the state of the end effector. [Figure 6C] FIG. 4 is a diagram showing the state of the end effector. [Figure 7] FIG. 2 is a diagram showing an end effector connected to an articulated robot. [Figure 8A] FIG. 4 is a diagram showing the state of the end effector. [Figure 8B] FIG. 4 is a diagram showing the state of the end effector. [Figure 8C] FIG. 4 is a diagram showing the state of the end effector. [Figure 9A] FIG. 4 is a diagram showing the state of the end effector. [Figure 9B] FIG. 4 is a diagram showing the state of the end effector. [Figure 9C] FIG. 4 is a diagram showing the state of the end effector. [Figure 10] FIG. 2 is a diagram showing an end effector connected to an articulated robot. [Figure 11] FIG. 2 is a diagram showing an end effector connected to an articulated robot. [Figure 12] FIG. 2 is a diagram showing an end effector connected to an articulated robot. [Figure 13A] FIG. 4 is a diagram showing the state of the end effector. [Figure 13B] FIG. 4 is a diagram showing the state of the end effector. [Figure 13C] FIG. 4 is a diagram showing the state of the end effector. [Figure 14A] FIG. 4 is a diagram showing the state of the end effector. [Figure 14B] FIG. 4 is a diagram showing the state of the end effector. [Figure 14C] FIG. 4 is a diagram showing the state of the end effector. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0008] 1 shows an overall configuration including a robot system 100 and a control device 500. The robot system 100 includes an articulated robot 200 and an end effector 300. The control device 500 is communicatively connected to the robot system 100. In FIG. 1, the robot system 100 and the control device 500 are shown as different configurations, but the control device 500 may be included in the robot system 100.
[0009] The articulated robot 200 is a six-axis robot having six drive axes. The articulated robot 200 includes a base 210, a robot arm 220, and a robot controller 230. The articulated robot 200 corresponds to an example of a robot.
[0010] The base 210 is fixed to an installation surface such as a floor. The base 210 is connected to a robot arm 220. The base 210 rotatably supports the robot arm 220. The base 210 includes an interface for connecting to the control device 500 and the like.
[0011] The robot arm 220 is connected to the base 210. The robot arm 220 has a plurality of arm members. The robot arm 220 shown in Fig. 1 is composed of a first arm 221, a second arm 222, a third arm 223, a fourth arm 224, a fifth arm 225, and a sixth arm 226. The number of arm members is not limited to six. The robot arm 220 is composed of two or more arm members.
[0012] The first arm 221 is connected to the base 210 via a first joint J1. A first joint motor J1M and a first joint encoder J1E are disposed in the first joint J1. The first joint motor J1M rotates the first arm 221. The first joint encoder J1E detects the amount of rotation of the first joint motor J1M or the rotation angle of the first arm 221. The first joint J1 is a torsion joint.
[0013] The second arm 222 is connected to the first arm 221 via a second joint J2. A second joint motor J2M and a second joint encoder J2E are disposed in the second joint J2. The second joint motor J2M rotates the second arm 222. The second joint encoder J2E detects the amount of rotation of the second joint motor J2M or the rotation angle of the second arm 222. The second joint J2 is a bending joint.
[0014] The third arm 223 is connected to the second arm 222 via a third joint J3. A third joint motor J3M and a third joint encoder J3E are disposed in the third joint J3. The third joint motor J3M rotates the third arm 223. The third joint encoder J3E detects the amount of rotation of the third joint motor J3M or the rotation angle of the third arm 223. The third joint J3 is a bending joint.
[0015] The fourth arm 224 is connected to the third arm 223 via a fourth joint J4. A fourth joint motor J4M and a fourth joint encoder J4E are disposed in the fourth joint J4. The fourth joint motor J4M rotates the fourth arm 224. The fourth joint encoder J4E detects the amount of rotation of the fourth joint motor J4M or the rotation angle of the fourth arm 224. The fourth joint J4 is a torsion joint.
[0016] The fifth arm 225 is connected to the fourth arm 224 via a fifth joint J5. A fifth joint motor J5M and a fifth joint encoder J5E are disposed in the fifth joint J5. The fifth joint motor J5M rotates the fifth arm 225. The fifth joint encoder J5E detects the amount of rotation of the fifth joint motor J5M or the rotation angle of the fifth arm 225. The fifth joint J5 is a bending joint.
[0017] The sixth arm 226 is connected to the fifth arm 225 via a sixth joint J6. A sixth joint motor J6M and a sixth joint encoder J6E are disposed in the sixth joint J6. The sixth joint motor J6M rotates the sixth arm 226. The sixth joint encoder J6E detects the amount of rotation of the sixth joint motor J6M or the rotation angle of the sixth arm 226. The sixth joint J6 is a torsion joint. The sixth arm 226 supports the end effector 300.
[0018] The robot controller 230 controls the driving of the robot arm 220. The robot controller 230 controls the driving of the first joint motor J1M, the second joint motor J2M, the third joint motor J3M, the fourth joint motor J4M, the fifth joint motor J5M, and the sixth joint motor J6M. The robot controller 230 acquires the rotation amount or the rotation angle of each arm detected by the first joint encoder J1E, the second joint encoder J2E, the third joint encoder J3E, the fourth joint encoder J4E, the fifth joint encoder J5E, and the sixth joint encoder J6E. The robot controller 230 performs various controls based on the rotation amount or the rotation angle of each arm.
[0019] The end effector 300 ejects a liquid onto a surface of an object. The end effector 300 shown in FIG. 1 ejects ink, which is an example of a liquid, onto the object. The end effector 300 prints on the surface of the object by ejecting ink onto the object. The end effector 300 corresponds to an example of a head unit. When the end effector 300 prints on the surface of the object using ink, the end effector 300 corresponds to an example of a printing device.
[0020] The control device 500 controls the driving of the articulated robot 200 and the end effector 300. The control device 500 is communicatively connected to the articulated robot 200 and the end effector 300. The control device 500 transmits motion control data to the articulated robot 200. The control device 500 controls the driving of the articulated robot 200 using the motion control data. The control device 500 transmits print data to the end effector 300. The control device 500 controls printing by the end effector 300 using the print data. The control device 500 receives various data from the articulated robot 200 and the end effector 300. The control device 500 may be communicatively connected to an external device. The control device 500 receives image data, etc. from the external device.
[0021] First embodiment The first embodiment shows the configuration of a robot system 100 equipped with an end effector 300 shown in Fig. 2. The robot system 100 of the first embodiment performs printing by ejecting ink onto the surface of an object. The object is a structure with a three-dimensional shape. The object has a flat or curved surface.
[0022] FIG. 2 shows an end effector 300 connected to the articulated robot 200. FIG. 2 shows a first end effector 300a, which is an example of the end effector 300. FIG. 2 shows a part of the articulated robot 200 and the first end effector 300a. FIG. 2 shows a fourth arm 224, a fifth arm 225, and a sixth arm 226 included in the articulated robot 200. FIG. 2 shows a print head unit 310 and a first stage unit 320a included in the first end effector 300a. The first stage unit 320a is an example of the stage unit 320.
[0023] A number of figures including FIG. 2 show an XYZ coordinate system. The X axis is an axis parallel to the direction in which the print head unit 310 moves by the drive of the articulated robot 200 when ejecting ink. The +X direction is the direction from the back to the front in FIG. 2. The -X direction is the direction from the front to the back in FIG. 2. The Y axis is an axis perpendicular to the X axis within the plane of the moving stage 323 that supports the print head unit 310. The +Y direction is the direction from the moving stage drive mechanism 325 to the print head unit 310. The -Y direction is the direction from the print head unit 310 to the moving stage drive mechanism 325. The Z axis is an axis perpendicular to the X axis and the Y axis. The +Z direction is the direction from the fixed stage 321 to the sixth arm 226 in FIG. 2. The -Z direction is the direction from the sixth arm 226 to the fixed stage 321 in FIG. 2.
[0024] The articulated robot 200 moves the first end effector 300a to a position where printing can be performed on the target object. The articulated robot 200 moves the first end effector 300a in the +X direction or the -X direction when the print head unit 310 ejects ink on the surface of the target object. The print head unit 310 moves in the +X direction or the -X direction by the drive of the articulated robot 200 when printing on the surface of the target object. After the print head unit 310 prints along the X axis, the articulated robot 200 moves the first end effector 300a in the +Y direction or the -Y direction. After the articulated robot 200 moves the first end effector 300a in the +Y direction or the -Y direction, the print head unit 310 prints on the surface of the target object. The articulated robot 200 moves the first end effector 300a in the +X direction or the -X direction when the print head unit 310 prints on the surface of the target object. The +X direction or the -X direction corresponds to an example of a predetermined direction.
[0025] The first end effector 300a performs printing on the surface of an object. The first end effector 300a is fixed to the tip of the sixth arm 226. The first end effector 300a includes a print head unit 310 and a first stage unit 320a.
[0026] The print head unit 310 ejects ink onto the surface of an object. When the print head unit 310 is moved in the +X direction or the -X direction by the drive of the articulated robot 200, the print head unit 310 ejects ink at predetermined intervals.
[0027] The first stage unit 320a is supported by the sixth arm 226. The first stage unit 320a supports the print head unit 310. The first stage unit 320a moves the print head unit 310 relative to the articulated robot 200. The first stage unit 320a moves the print head unit 310 when the print head unit 310 ejects ink onto the surface of an object. The first stage unit 320a shown in FIG. 2 moves the print head unit 310 along the Y axis. The first stage unit 320a includes a fixed stage 321, a movable stage 323, and a movable stage drive mechanism 325.
[0028] The fixed stage 321 is supported by the sixth arm 226. The fixed stage 321 is fixed to the sixth arm 226 directly or via another member. The fixed stage 321 movably supports the moving stage 323 via a moving stage driving mechanism 325. The fixed stage 321 is disposed between the articulated robot 200 including the sixth arm 226 and the moving stage 323. The fixed stage 321 corresponds to an example of a substrate stage.
[0029] The moving stage 323 is supported so as to be movable relative to the fixed stage 321. The moving stage 323 supports the print head unit 310. The moving stage 323 has an opening (not shown). The print head unit 310 is placed in the opening. The ink ejection surface of the print head unit 310 faces an object located in the -Z direction of the print head unit 310. The moving stage 323 supports the print head unit 310 at a position in the +Y direction of the fixed stage 321. The moving stage 323 corresponds to an example of a stage.
[0030] The moving stage driving mechanism 325 moves the moving stage 323 relative to the fixed stage 321. The moving stage driving mechanism 325 shown in FIG. 2 moves the moving stage 323 in the +Y direction or the -Y direction along the Y axis. The moving stage driving mechanism 325 moves the moving stage 323 along the Y axis, thereby moving the print head unit 310 along the Y axis. The moving stage driving mechanism 325 moves the print head unit 310 along the Y axis when the print head unit 310 moves along the X axis to eject ink. The moving stage driving mechanism 325 corresponds to an example of a stage driving mechanism.
[0031] Fig. 3 shows a schematic configuration of the end effector 300. Fig. 3 shows a schematic configuration of a first end effector 300a, which is an example of the end effector 300. The first end effector 300a includes a print head unit 310 and a first stage unit 320a. The print head unit 310 includes a liquid ejection head 311 and an ink tank 313. The first stage unit 320a includes a fixed stage 321, a movable stage 323, a movable stage driving mechanism 325, a screw 335, and a stage controller 350.
[0032] The liquid ejection head 311 ejects ink toward an object. The liquid ejection head 311 performs printing by ejecting ink onto the surface of an object fixed at a position in the -Z direction. The liquid ejection head 311 ejects ink when the first end effector 300a moves in the +X direction or the -X direction by driving the articulated robot 200. The liquid ejection head 311 ejects ink at a predetermined interval along the X axis. The liquid ejection head 311 has an ink supply path, a print controller 340, and the like, which are not shown, inside. A plurality of nozzles 315 are formed on the ink ejection surface of the liquid ejection head 311 facing the object. The nozzles 315 are openings that eject ink onto the surface of the object. The liquid ejection head 311 is an example of an ejection head and an example of a print head.
[0033] The ink tank 313 stores ink. The ink tank 313 is connected to an ink supply path and supplies ink to the liquid ejection head 311. The print head unit 310 shown in FIG. 3 has multiple ink tanks 313. Each of the multiple ink tanks 313 stores ink of a different color. The multiple ink tanks 313 may store ink of the same color. The print head unit 310 shown in FIG. 3 has four ink tanks 313, but is not limited to this. The number of ink tanks 313 may be three or less, or five or more. The number of ink tanks 313 is set as appropriate.
[0034] 3 has an ink tank 313, but is not limited to this. Instead of the ink tank 313, an ink storage container may be provided outside the print head unit 310. The ink storage container supplies ink to the liquid ejection head 311 via an ink flow path.
[0035] The moving stage driving mechanism 325 is disposed between the fixed stage 321 and the moving stage 323. The moving stage driving mechanism 325 includes a support 327, an ultrasonic motor 329, a carriage 331, and a rail 333.
[0036] The support section 327 is disposed on the moving stage 323. The support section 327 is disposed at a position in the -Y direction of the print head unit 310. The support section 327 supports a carriage 331 and a rail 333.
[0037] The ultrasonic motor 329 generates a driving force for moving the moving stage 323. The ultrasonic motor 329 generates a driving force by piezo driving. The ultrasonic motor 329 moves the moving stage 323 relative to the fixed stage 321 along the Y axis in the +Y direction or the -Y direction.
[0038] The carriage 331 moves the moving stage 323 along the Y axis relative to the fixed stage 321. The carriage 331 moves the moving stage 323 by the driving force of an ultrasonic motor 329.
[0039] The rail 333 is disposed on the +Z direction surface of the support portion 327. The rail 333 is connected to the carriage 331 via a linear guide ball (not shown). The rail 333 supports the carriage 331 so that the carriage 331 can slide along the Y axis.
[0040] The screw 335 fixes the sixth arm 226 and the fixed stage 321. The fixed stage 321 is an example of an attachment portion that attaches the end effector 300 as a printing device to the robot arm 220. The screw 335 fixes the sixth arm 226 and the fixed stage 321 directly or via another member. The screw 335 fixes the fixed stage 321 to the sixth arm 226, thereby fixing the first end effector 300a to the articulated robot 200.
[0041] The stage controller 350 controls the driving of the moving stage driving mechanism 325. The stage controller 350 controls the movement timing, movement direction, movement amount, etc. of the moving stage 323. The stage controller 350 shown in Fig. 3 is disposed on the moving stage 323, but is not limited to this. The arrangement position of the stage controller 350 is set appropriately.
[0042] Fig. 4 shows a block configuration of the robot system 100 and the control device 500. Fig. 4 shows a block configuration of the articulated robot 200 and the first end effector 300a included in the robot system 100, and a block configuration of the control device 500.
[0043] The articulated robot 200 includes a robot controller 230 and an arm driving mechanism 240. The articulated robot 200 operates based on operation control data transmitted from a control device 500.
[0044] The robot controller 230 is a controller circuit that controls the arm driving mechanism 240. As an example, the robot controller 230 is a processor having a CPU (Central Processing Unit). The robot controller 230 is configured with one or more processors. The robot controller 230 may be configured with a programmable logic device such as an FPGA (Field Programmable Gate Array). The robot controller 230 controls the operation of the robot arm 220 by controlling the arm driving mechanism 240. The robot controller 230 has a robot memory unit 231 and an arm control unit 233.
[0045] The robot memory unit 231 stores various types of motion control data related to the motion of the articulated robot 200. The robot memory unit 231 stores motion control data and the like transmitted from the control device 500. The robot memory unit 231 stores a robot control program executed by the robot controller 230. The robot control program is a program that causes the robot controller 230 to operate as functional units such as the arm control unit 233. The robot memory unit 231 stores various types of detection data transmitted from the arm drive mechanism 240. The robot memory unit 231 is composed of semiconductor memories such as a RAM (Random Access Memory) and a ROM (Read Only Memory).
[0046] The arm control unit 233 is a functional unit operated by the robot controller 230. The arm control unit 233 controls the operation of the robot arm 220. The arm control unit 233 receives operation control data from the control device 500. The arm control unit 233 may receive operation control data stored in the robot storage unit 231. The arm control unit 233 generates a motor drive signal and the like based on the operation control data. The arm control unit 233 transmits the motor drive signal to the arm drive mechanism 240 to operate the robot arm 220. The arm control unit 233 receives detection data from the arm drive mechanism 240. The arm control unit 233 corrects the operation control data or the motor drive signal based on the detection data.
[0047] The arm driving mechanism 240 operates the robot arm 220. The arm driving mechanism 240 includes a joint motor group 241 and a joint encoder group 243. The arm driving mechanism 240 may include mechanisms, sensors, etc. different from the joint motor group 241 and the joint encoder group 243.
[0048] The joint motor group 241 includes a first joint motor J1M, a second joint motor J2M, a third joint motor J3M, a fourth joint motor J4M, a fifth joint motor J5M, and a sixth joint motor J6M. The joint motor group 241 drives each arm member of the robot arm 220 under the control of the arm control unit 233.
[0049] The joint encoder group 243 includes a first joint encoder J1E, a second joint encoder J2E, a third joint encoder J3E, a fourth joint encoder J4E, a fifth joint encoder J5E, and a sixth joint encoder J6E. The joint encoder group 243 measures the amount of rotation of each motor included in the joint motor group 241, or the rotation angle of each arm member driven by the joint motor group 241. The joint encoder group 243 transmits the measured amount of rotation of each motor, or the measured rotation angle of each arm member to the arm control unit 233.
[0050] The first end effector 300a shown in Fig. 4 has a liquid ejection head 311, a moving stage driving mechanism 325, a print controller 340, and a stage controller 350. The liquid ejection head 311 and the print controller 340 are included in the print head unit 310 shown in Fig. 3. The moving stage driving mechanism 325 and the stage controller 350 are included in the first stage unit 320a shown in Fig. 3.
[0051] The liquid ejection head 311 ejects ink onto the surface of an object. One example of the liquid ejection head 311 is an inkjet head. The liquid ejection head 311 has a plurality of nozzles 315 on an ejection surface that faces the object. The liquid ejection head 311 ejects ink from the nozzles 315 based on nozzle control data transmitted from the print controller 340.
[0052] The print controller 340 is a controller circuit that controls the operation of the liquid ejection head 311. As an example, the print controller 340 is a processor having a CPU. The print controller 340 may be configured with a programmable logic device such as an FPGA. The print controller 340 receives print data from the control device 500. The print controller 340 generates a nozzle control signal based on the print data. The nozzle control signal is a signal that controls the ejection of ink from each nozzle 315. The print controller 340 controls the operation of the liquid ejection head 311 by transmitting the nozzle control signal to the liquid ejection head 311.
[0053] The moving stage driving mechanism 325 operates the moving stage 323. The moving stage driving mechanism 325 includes a plurality of ultrasonic motors 329. The moving stage driving mechanism 325 slides the moving stage 323 by the driving force of the ultrasonic motors 329. The moving stage driving mechanism 325 receives a stage driving signal from a stage controller 350. The moving stage driving mechanism 325 operates based on the stage driving signal.
[0054] The stage controller 350 is a controller circuit that controls the operation of the moving stage driving mechanism 325. As an example, the stage controller 350 is a processor having a CPU. The stage controller 350 may be configured with a programmable logic device such as an FPGA. The stage controller 350 receives movement data from the control device 500. The movement data is data for correcting the ink ejection position. The stage controller 350 generates a stage driving signal based on the movement data. The stage controller 350 controls the sliding movement of the moving stage 323 by transmitting the stage driving signal to the moving stage driving mechanism 325.
[0055] The control device 500 generates various control data. The control device 500 transmits the various control data to the articulated robot 200 and the first end effector 300a, thereby causing the robot system 100 to execute printing. The control device 500 includes a print control unit 510 and a storage unit 530.
[0056] The print control unit 510 is a controller circuit that controls the printing operation by the robot system 100. The print control unit 510 is a processor having a CPU. The print control unit 510 is composed of one or more processors. The print control unit 510 may be composed of a programmable logic device such as an FPGA. The print control unit 510 executes a print control program to function as a print data generation unit 511, a print data correction unit 513, an operation control unit 515, and a movement data generation unit 517. The print data generation unit 511, the print data correction unit 513, the operation control unit 515, and the movement data generation unit 517 are functional units. The print control unit 510 may function as a functional unit other than the print data generation unit 511, the print data correction unit 513, the operation control unit 515, and the movement data generation unit 517.
[0057] The print data generation unit 511 generates print data. The print data generation unit 511 generates print data based on image data acquired from an external device, image data stored in the storage unit 530, etc. The print data is data related to the ejection position, ejection amount, etc. of ink ejected by the liquid ejection head 311. The print data generation unit 511 transmits the print data to the print data correction unit 513.
[0058] The print data correction unit 513 corrects the print data. The print data correction unit 513 acquires shape data of the object from the memory unit 530 or an external device. The print data correction unit 513 acquires shape data based on imaging data transmitted from a camera connected to the control device 500. The camera is not shown. The print data correction unit 513 acquires arm trajectory data from the memory unit 530 or the operation control unit 515, etc. The print data correction unit 513 corrects the print data based on the shape data and the arm trajectory data. The print data correction unit 513 corrects the ink ejection position, the ink ejection order, etc. The print data correction unit 513 transmits the corrected print data to the print controller 340 and the movement data generation unit 517.
[0059] The operation control unit 515 generates arm trajectory data related to the operation of the robot arm 220. The arm trajectory data is data related to the movement trajectory of the robot arm 220 when the articulated robot 200 moves the first end effector 300a. The arm trajectory data is generated based on the shape data of the target object, the operation range conditions of the robot arm 220, and the like. The operation control unit 515 acquires the shape data, the operation range conditions, and the like from the storage unit 530, and the like. The operation control unit 515 generates the arm trajectory data based on the shape data, the operation range conditions, and the like. As an example, the arm trajectory data includes ink ejection position information of each printing dot when the robot arm 220 moves the first end effector 300a along the X-axis. The operation control unit 515 transmits the arm trajectory data to the arm control unit 233, the print data correction unit 513, the movement data generation unit 517, and the like.
[0060] The movement data generating unit 517 generates movement data related to the movement of the moving stage 323. When the liquid ejection head 311 ejects ink on the surface of the target object, the articulated robot 200 moves the first end effector 300a in the +X direction or the -X direction. When the articulated robot 200 moves the first end effector 300a, vibration occurs due to the driving of the robot arm 220. When the vibration is transmitted to the first end effector 300a, the position of the liquid ejection head 311 at the time of ejecting ink is displaced. The movement data generating unit 517 generates movement data for correcting the displacement due to the vibration. The movement data is data for moving the moving stage 323 in the direction opposite to the displacement direction of the displacement due to the vibration. The moving stage driving mechanism 325 corrects the displacement caused by the movement of the articulated robot 200 by moving the moving stage 323 based on the movement data.
[0061] The movement data generating unit 517 acquires arm trajectory data, corrected print data, shape data of the target object, and the like from the storage unit 530 and the like. The movement data generating unit 517 acquires vibration data stored in the storage unit 530. The vibration data is, for example, displacement information when the articulated robot 200 moves in the +X direction or the -X direction from the movement start point to the movement end point. The vibration data is measured in advance and stored in the storage unit 530. When the robot system 100 has a vibration sensor (not shown), the vibration data may be acquired from the vibration sensor. The movement data generating unit 517 calculates the displacement direction and displacement amount of the displacement for each ink ejection position using the vibration data, the arm trajectory data, the corrected print data, and the like. The movement data generating unit 517 generates movement data based on the displacement direction and displacement amount of the displacement. The movement data includes the movement direction and movement amount of the moving stage 323 for each ink ejection position. The movement direction of the moving stage 323 is opposite to the displacement direction of the displacement. The amount of movement of the moving stage 323 corresponds to the amount of displacement. The movement data generator 517 transmits the movement data to the stage controller 350.
[0062] The storage unit 530 stores various data, programs, etc. The storage unit 530 stores arm trajectory data, object shape data, etc. generated by the print control unit 510. The storage unit 530 may store displacement information, corrected print data, etc. The storage unit 530 may store image data acquired from an external device. The storage unit 530 stores a print control program executed by the print control unit 510. The storage unit 530 is composed of semiconductor memories such as RAM and ROM.
[0063] It is preferable that the control device 500 acquires in advance the displacement direction and displacement amount due to the displacement for each discharge position. The user of the robot system 100 moves the first end effector 300a in the +X direction or the -X direction along the X axis by driving the articulated robot 200 with the articulated robot 200 in a predetermined posture. The user acquires the displacement direction and displacement amount of the displacement for each discharge position when the first end effector 300a is moved along the X axis. The displacement direction and displacement amount of the displacement for each discharge position are stored in the storage unit 530 as displacement information. The movement data generation unit 517 generates movement data based on the displacement information. The control device 500 may prepare in advance movement data generated using the displacement information stored in the storage unit 530.
[0064] Figures 5A, 5B, and 5C show the state of the end effector 300. Figures 5A, 5B, and 5C show the state of a first end effector 300a, which is an example of the end effector 300. Figures 5A, 5B, and 5C show the state of the first end effector 300a as viewed from the -Z direction.
[0065] Figures 5A, 5B, and 5C show the moving stage 323 and the liquid ejection head 311. Figures 5A, 5B, and 5C show one of the multiple nozzles 315 formed on the ejection surface of the liquid ejection head 311. Figures 5A, 5B, and 5C virtually show the sixth arm 226. Figures 5A, 5B, and 5C show the control position CP and the printing position PP with virtual lines. Figures 5A, 5B, and 5C show the arm center 226a, which is the central position of the sixth arm 226.
[0066] 5A shows the state of the first end effector 300a when the articulated robot 200 is located at a position controlled by the print control unit 510. When the articulated robot 200 is not displaced due to vibration of the arm drive mechanism 240, etc., the arm center 226a of the sixth arm 226 is located at the control position CP, for example. The control position CP shows the control trajectory of the arm center 226a when the articulated robot 200 moves the first end effector 300a along the X-axis.
[0067] Fig. 5B shows a state of the first end effector 300a when the articulated robot 200 is displaced due to vibration. Fig. 5B shows a state when the moving stage 323 is not operating. Fig. 5B shows a state when the articulated robot 200 is displaced in the -Y direction due to vibration. The articulated robot 200 is displaced due to vibration that occurs when the first end effector 300a is moved in the +X direction or the -X direction.
[0068] The arm center 226a of the sixth arm 226 is displaced to a displacement position DP in the -Y direction by the vibration. The displacement position DP is a position displaced by a first displacement amount Δd1 in the -Y direction from the control position CP. When the arm center 226a is displaced to the displacement position DP, the nozzle 315 is displaced to a nozzle position NP displaced by the first displacement amount Δd1 in the -Y direction. When the nozzle 315 ejects ink at the nozzle position NP, the ink landing position is shifted to a position displaced by the first displacement amount Δd1 in the -Y direction from the printing position PP. The vibration of the articulated robot 200 causes distortion in the image printed on the surface of the target object.
[0069] FIG. 5C shows the state of the first end effector 300a when the moving stage 323 is moved to correct the ink landing position. FIG. 5C shows the state in which the moving stage 323 is moved in the +Y direction. The arm center 226a of the sixth arm 226 is located at a displacement position DP in the -Y direction due to vibration. When the moving stage 323 moves a first displacement amount Δd1 in the +Y direction along the Y axis, the nozzle 315 is located at the printing position PP. The moving stage driving mechanism 325 moves the moving stage 323 in the +Y direction along the Y axis, so that the displacement caused by the movement of the articulated robot 200 can be corrected. The Y axis corresponds to an example of an orthogonal axis perpendicular to a predetermined direction.
[0070] 5C shows a case where the moving stage 323 is moved by the first displacement amount Δd1 in the +Y direction, but is not limited to this. The moving stage driving mechanism 325 can correct the displacement caused by vibration by moving the moving stage 323 in the direction opposite to the displacement direction of the displacement caused by the movement of the articulated robot 200. It is preferable that the moving stage driving mechanism 325 moves the moving stage 323 by the first displacement amount Δd1 or a distance smaller than the first displacement amount Δd1 in the direction opposite to the displacement direction of the displacement.
[0071] Figures 6A, 6B, and 6C show the state of the end effector 300. Figures 6A, 6B, and 6C show the state of a first end effector 300a, which is an example of the end effector 300. Figures 6A, 6B, and 6C show the state of the first end effector 300a as viewed from the -Z direction.
[0072] Figures 6A, 6B, and 6C show the moving stage 323 and the liquid ejection head 311. Figures 6A, 6B, and 6C show one of the multiple nozzles 315 formed on the ejection surface of the liquid ejection head 311. Figures 6A, 6B, and 6C virtually show the sixth arm 226. Figures 6A, 6B, and 6C show the control position CP and the printing position PP with virtual lines. Figures 6A, 6B, and 6C show the arm center 226a, which is the central position of the sixth arm 226.
[0073] Fig. 6A shows the state of the first end effector 300a when the articulated robot 200 is located at a position controlled by the print control unit 510. When the articulated robot 200 is not displaced due to vibration of the arm drive mechanism 240, etc., the arm center 226a of the sixth arm 226 is located at the control position CP, for example. Fig. 6A shows the same state as Fig. 5A.
[0074] Fig. 6B shows a state of the first end effector 300a when the articulated robot 200 is displaced due to vibration. Fig. 6B shows a state when the moving stage 323 is not operating. Fig. 6B shows a state when the articulated robot 200 is displaced in the +Y direction due to vibration. The articulated robot 200 is displaced due to vibration that occurs when the first end effector 300a is moved in the +X direction or the -X direction.
[0075] The arm center 226a of the sixth arm 226 is displaced to a displacement position DP in the +Y direction by the vibration. The displacement position DP is a position displaced by a second displacement amount Δd2 in the +Y direction from the control position CP. When the arm center 226a is displaced to the displacement position DP, the nozzle 315 is displaced to a nozzle position NP displaced by the second displacement amount Δd2 in the +Y direction. When the nozzle 315 ejects ink at the nozzle position NP, the ink landing position is shifted to a position displaced by the second displacement amount Δd2 in the +Y direction from the printing position PP. The vibration of the articulated robot 200 causes distortion in the image printed on the surface of the target object.
[0076] 6C shows the state of the first end effector 300a when the moving stage 323 is moved to correct the ink landing position. FIG. 6C shows the state after the moving stage 323 has been moved in the -Y direction. The arm center 226a of the sixth arm 226 is positioned at a displacement position DP in the +Y direction due to vibration. When the moving stage 323 moves a second displacement amount Δd2 in the -Y direction along the Y axis, the nozzle 315 is positioned at the printing position PP. The moving stage driving mechanism 325 moves the moving stage 323 in the -Y direction along the Y axis, thereby making it possible to correct the displacement caused by the movement of the articulated robot 200.
[0077] 6C shows a case where the moving stage 323 is moved by the second displacement amount Δd2 in the -Y direction, but is not limited to this. The moving stage driving mechanism 325 can correct the displacement caused by vibration by moving the moving stage 323 in the direction opposite to the displacement direction of the displacement caused by the movement of the articulated robot 200. It is preferable that the moving stage driving mechanism 325 moves the moving stage 323 by the second displacement amount Δd2 or a distance smaller than the second displacement amount Δd2 in the direction opposite to the displacement direction of the displacement.
[0078] The robot system 100 of the first embodiment performs printing by ejecting ink onto the surface of an object, but is not limited to this. The liquid ejection head 311 may eject a liquid such as an adhesive instead of ink. When the liquid ejection head 311 ejects a liquid such as an adhesive, the robot system 100 functions as a system that applies a liquid to an object.
[0079] The robot system 100 includes a first end effector 300a having a liquid ejection head 311 that ejects liquid, a moving stage 323 that supports the liquid ejection head 311, and a moving stage driving mechanism 325 that moves the moving stage 323, and an articulated robot 200 that supports the first end effector 300a and moves the liquid ejection head 311 in the +X direction or the -X direction when the liquid ejection head 311 ejects liquid. The moving stage driving mechanism 325 moves the moving stage 323 when the liquid ejection head 311 ejects liquid, and corrects displacement caused by the movement of the articulated robot 200. The robot system 100 can land the liquid at a desired position by correcting the displacement caused by the movement of the articulated robot 200.
[0080] The moving stage driving mechanism 325 moves the moving stage 323 along the Y axis perpendicular to the +X direction or the -X direction. The robot system 100 can correct the deviation of the ink landing position along the Y axis.
[0081] The moving stage driving mechanism 325 moves the moving stage 323 in the direction opposite to the displacement. The robot system 100 can reduce deviations in the ink landing positions caused by the displacement by moving the moving stage 323 in the direction opposite to the displacement caused by the vibration.
[0082] The moving stage driving mechanism 325 corrects the displacement based on the displacement information when the articulated robot 200 moves the liquid ejection head 311 in the +X direction or the -X direction. The robot system 100 is able to determine the correction direction and amount of correction based on the displacement information.
[0083] The robot system 100 includes a first end effector 300a having a liquid ejection head 311 that ejects ink, a moving stage 323 that supports the liquid ejection head 311, and a moving stage driving mechanism 325 that moves the moving stage 323, and an articulated robot 200 that supports the first end effector 300a and moves the liquid ejection head 311 in the +X direction or the -X direction when the liquid ejection head 311 ejects ink. The moving stage driving mechanism 325 moves the moving stage 323 when the liquid ejection head 311 ejects ink, and corrects displacement caused by the movement of the articulated robot 200. The robot system 100 can reduce image distortion by correcting the displacement caused by the movement of the articulated robot 200.
[0084] In the first embodiment, the moving stage 323 moves along the Y axis, but is not limited to this. The moving stage 323 may move in the +X direction or the -X direction along the X axis. By moving the moving stage 323 along the X axis, it is possible to correct the displacement along the X axis due to vibration.
[0085] Second embodiment The second embodiment shows the configuration of a robot system 100 including an end effector 300 shown in Fig. 7. The robot system 100 of the second embodiment performs printing by ejecting ink onto the surface of an object. The object is a structure with a three-dimensional shape. The object has a flat or curved surface.
[0086] FIG. 7 shows an end effector 300 connected to the articulated robot 200. FIG. 7 shows a second end effector 300b, which is an example of the end effector 300. FIG. 7 shows a part of the articulated robot 200 and the second end effector 300b. FIG. 7 shows a fourth arm 224, a fifth arm 225, and a sixth arm 226 included in the articulated robot 200. The articulated robot 200 shown in FIG. 7 has the same configuration as the articulated robot 200 shown in FIG. 2. FIG. 7 shows a print head unit 310 and a second stage unit 320b included in the second end effector 300b. The second stage unit 320b is an example of the stage unit 320.
[0087] The second end effector 300b performs printing on the surface of an object. The second end effector 300b is fixed to the tip of the sixth arm 226. The second end effector 300b includes a print head unit 310 and a second stage unit 320b. The print head unit 310 shown in FIG. 7 has the same configuration as the print head unit 310 shown in FIG.
[0088] The second stage unit 320b is supported by the sixth arm 226. The second stage unit 320b supports the print head unit 310. The second stage unit 320b moves the print head unit 310 relative to the articulated robot 200. The second stage unit 320b moves the print head unit 310 when the print head unit 310 ejects ink onto the surface of an object. The second stage unit 320b shown in FIG. 7 moves the print head unit 310 along the Y axis. The second stage unit 320b includes a fixed stage 321, a movable stage 323, a movable stage driving mechanism 325, a counter mechanism 360, and a counter stage 363.
[0089] The fixed stage 321 is supported by the sixth arm 226. The fixed stage 321 is fixed to the sixth arm 226 directly or via another member. The fixed stage 321 supports the moving stage driving mechanism 325 and the counter mechanism 360 along the Y axis. The fixed stage 321 movably supports the moving stage 323 via the moving stage driving mechanism 325. The fixed stage 321 movably supports the counter stage 363 via the counter mechanism 360.
[0090] The moving stage 323 shown in Fig. 7 has the same configuration as the moving stage 323 shown in Fig. 2. The moving stage 323 supports the print head unit 310. The moving stage 323 is not in contact with the counter mechanism 360.
[0091] The counter mechanism 360 is supported by the fixed stage 321. The counter mechanism 360 is disposed on the opposite side of the print head unit 310 with respect to the central axis of the arm (the axis passing through the arm center 226a and extending in the direction in which the fixed stage 321 and the sixth arm 226 are aligned). The counter mechanism 360 applies an inertial force, which is a reaction force, to the fixed stage 321. The counter mechanism 360 moves the counter stage 363 in the opposite direction to the direction in which the movable stage 323 moves each time the movable stage 323 moves. The counter mechanism 360 applies an inertial force to the fixed stage 321 that reduces the inertial force of movement applied to the fixed stage 321 by the movable stage 323 each time the movable stage 323 moves. The counter mechanism 360 applies the inertial force to the fixed stage 321 as additional vibration. The counter mechanism 360 corresponds to an example of a vibration imparting mechanism. The inertial force corresponds to an example of a correction vibration. The counter mechanism 360 corresponds to an example of a weight portion.
[0092] The counter stage 363 is moved in the +Y direction or the -Y direction by the counter mechanism 360. The counter mechanism 360 applies an inertial force in the +Y direction or the -Y direction to the fixed stage 321 by moving the counter stage 363 in the +Y direction or the -Y direction. When the moving stage driving mechanism 325 moves the moving stage 323 in the +Y direction, the counter mechanism 360 moves the counter stage 363 in the -Y direction. When the moving stage driving mechanism 325 moves the moving stage 323 in the -Y direction, the counter mechanism 360 moves the counter stage 363 in the +Y direction.
[0093] When the moving stage driving mechanism 325 moves the moving stage 323 in the +Y direction or the -Y direction, it applies a moving inertia force to the fixed stage 321. The moving inertia force is propagated to the articulated robot 200 via the fixed stage 321. The moving inertia force propagated to the articulated robot 200 vibrates the articulated robot 200. When the articulated robot 200 vibrates due to the moving inertia force, the ink landing position is displaced, and image quality is deteriorated. When the moving stage driving mechanism 325 moves the moving stage 323 in the +Y direction or the -Y direction, the counter mechanism 360 moves the counter stage 363 in the opposite direction to the moving direction of the moving stage 323. When the counter mechanism 360 moves the counter stage 363, a counter inertia force is applied to the fixed stage 321. The counter inertia force is propagated to the articulated robot 200 via the fixed stage 321. The counter inertial force attenuates the movement inertial force propagated to the articulated robot 200. The counter mechanism 360 reduces the movement inertial force generated by the movement of the moving stage 323. The deviation of the ink landing position caused by the movement of the moving stage 323 is suppressed.
[0094] Figures 8A, 8B, and 8C show the state of the end effector 300. Figures 8A, 8B, and 8C show the state of a second end effector 300b, which is an example of the end effector 300. Figures 8A, 8B, and 8C show the state of the second end effector 300b as viewed from the -Z direction.
[0095] 8A, 8B, and 8C show the fixed stage 321, the moving stage 323, the liquid ejection head 311, and the counter stage 363. FIG. 8A, 8B, and 8C show one of the multiple nozzles 315 formed on the ejection surface of the liquid ejection head 311. FIG. 8A, 8B, and 8C show the sixth arm 226 and the counter mechanism 360 in an imaginary manner. FIG. 8A, 8B, and 8C show the control position CP and the printing position PP with imaginary lines. FIG. 8A, 8B, and 8C show the arm center 226a, which is the central position of the sixth arm 226.
[0096] 8A shows the state of the second end effector 300b when the articulated robot 200 is located at a position controlled by the print control unit 510. When the articulated robot 200 is not displaced due to vibration of the arm drive mechanism 240 or the like, the arm center 226a of the sixth arm 226 is located at the control position CP, for example.
[0097] Fig. 8B shows a state of the second end effector 300b when the articulated robot 200 is displaced due to vibration. Fig. 8B shows a state when the moving stage 323 and the counter stage 363 are not operating. Fig. 8B shows a state when the articulated robot 200 is displaced in the -Y direction due to vibration. The articulated robot 200 is displaced due to vibration that occurs when the second end effector 300b is moved in the +X direction or the -X direction.
[0098] The arm center 226a of the sixth arm 226 is displaced to a displacement position DP in the -Y direction by the vibration. The displacement position DP is a position displaced by a third displacement amount Δd3 in the -Y direction from the control position CP. When the arm center 226a is displaced to the displacement position DP, the nozzle 315 is displaced to a nozzle position NP displaced by the third displacement amount Δd3 in the -Y direction. When the nozzle 315 ejects ink at the nozzle position NP, the ink landing position is shifted to a position displaced by the third displacement amount Δd3 in the -Y direction from the printing position PP. The vibration of the articulated robot 200 causes distortion in the image printed on the surface of the target object.
[0099] FIG. 8C shows the state of the second end effector 300b when the moving stage 323 is moved to correct the ink landing position. FIG. 8C shows the state in which the moving stage 323 is moved in the +Y direction. The arm center 226a of the sixth arm 226 is located at a displacement position DP in the -Y direction due to vibration. When the moving stage 323 moves a third displacement amount Δd3 in the +Y direction along the Y axis, the nozzle 315 is located at the printing position PP. The moving stage driving mechanism 325 moves the moving stage 323 in the +Y direction along the Y axis, so that the displacement caused by the movement of the articulated robot 200 can be corrected. The Y axis corresponds to an example of an orthogonal axis perpendicular to a predetermined direction.
[0100] When the moving stage 323 moves in the +Y direction, the counter mechanism 360 moves the counter stage 363 in the -Y direction. When the moving stage drive mechanism 325 moves the moving stage 323, a moving inertia force is generated due to the movement of the moving stage 323. The moving inertia force is transmitted to the multi-joint robot 200 via the fixed stage 321. When the moving inertia force is transmitted to the multi-joint robot 200, the multi-joint robot 200 vibrates due to the moving inertia force. When the multi-joint robot 200 vibrates due to the moving inertia force, the ink landing position is shifted and image quality is degraded. When the moving stage 323 moves in the +Y direction, the counter mechanism 360 moves the counter stage 363 in the -Y direction, a counter inertia force in the opposite direction to the moving inertia force is generated. When the counter inertia force is transmitted to the fixed stage 321, the moving inertia force is attenuated by the counter inertia force. The counter mechanism 360 attenuates the inertial force generated by the movement of the moving stage 323. The counter mechanism 360 can suppress the generation of vibrations caused by the movement of the moving stage 323.
[0101] 8C shows a case where the moving stage 323 is moved by the third displacement amount Δd3 in the +Y direction, but is not limited to this. The moving stage driving mechanism 325 can correct the displacement caused by vibration by moving the moving stage 323 in the direction opposite to the displacement direction of the displacement caused by the movement of the articulated robot 200. It is preferable that the moving stage driving mechanism 325 moves the moving stage 323 by the third displacement amount Δd3 or a distance smaller than the third displacement amount Δd3 in the direction opposite to the displacement direction of the displacement.
[0102] The counter mechanism 360 may move the counter stage 363 in the -Y direction by the third displacement amount Δd3, or may move the counter stage 363 by an amount different from the third displacement amount Δd3. The amount of movement of the counter stage 363 by the counter mechanism 360 is appropriately adjusted.
[0103] Figures 9A, 9B, and 9C show the state of the end effector 300. Figures 9A, 9B, and 9C show the state of a second end effector 300b, which is an example of the end effector 300. Figures 9A, 9B, and 9C show the state of the second end effector 300b as viewed from the -Z direction.
[0104] 9A, 9B, and 9C show the fixed stage 321, the moving stage 323, the liquid ejection head 311, and the counter stage 363. FIG. 9A, 9B, and 9C show one of the multiple nozzles 315 formed on the ejection surface of the liquid ejection head 311. FIG. 9A, 9B, and 9C show the sixth arm 226 and the counter mechanism 360 in a virtual manner. FIG. 9A, 9B, and 9C show the control position CP and the printing position PP in virtual lines. FIG. 9A, 9B, and 9C show the arm center 226a, which is the central position of the sixth arm 226.
[0105] Fig. 9A shows the state of the second end effector 300b when the articulated robot 200 is located at a position controlled by the print control unit 510. When the articulated robot 200 is not displaced due to vibration of the arm drive mechanism 240, etc., the arm center 226a of the sixth arm 226 is located at the control position CP, for example. Fig. 9A shows the same state as Fig. 8A.
[0106] Fig. 9B shows a state of the second end effector 300b when the articulated robot 200 is displaced due to vibration. Fig. 9B shows a state when the moving stage 323 and the counter stage 363 are not operating. Fig. 9B shows a state when the articulated robot 200 is displaced in the +Y direction due to vibration. The articulated robot 200 is displaced due to vibration that occurs when the second end effector 300b is moved in the +X direction or the -X direction.
[0107] The arm center 226a of the sixth arm 226 is displaced to a displacement position DP in the +Y direction by the vibration. The displacement position DP is a position displaced by a fourth displacement amount Δd4 in the +Y direction from the control position CP. When the arm center 226a is displaced to the displacement position DP, the nozzle 315 is displaced to a nozzle position NP displaced by a fourth displacement amount Δd4 in the +Y direction. When the nozzle 315 ejects ink at the nozzle position NP, the ink landing position is shifted to a position displaced by the fourth displacement amount Δd4 in the +Y direction from the printing position PP. The vibration of the articulated robot 200 causes distortion in the image printed on the surface of the target object.
[0108] FIG. 9C shows the state of the second end effector 300b when the moving stage 323 is moved to correct the ink landing position. FIG. 9C shows the state in which the moving stage 323 is moved in the -Y direction. The arm center 226a of the sixth arm 226 is located at a displacement position DP in the +Y direction due to vibration. When the moving stage 323 moves a fourth displacement amount Δd4 in the -Y direction along the Y axis, the nozzle 315 is located at the printing position PP. The moving stage driving mechanism 325 moves the moving stage 323 in the -Y direction along the Y axis, so that the displacement caused by the movement of the articulated robot 200 can be corrected. The Y axis corresponds to an example of an orthogonal axis perpendicular to a predetermined direction.
[0109] When the moving stage 323 moves in the -Y direction, the counter mechanism 360 moves the counter stage 363 in the +Y direction. When the moving stage drive mechanism 325 moves the moving stage 323, a moving inertia force is generated due to the movement of the moving stage 323. The moving inertia force is transmitted to the multi-joint robot 200 via the fixed stage 321. When the moving inertia force is transmitted to the multi-joint robot 200, the multi-joint robot 200 vibrates due to the moving inertia force. When the multi-joint robot 200 vibrates due to the moving inertia force, the ink landing position is shifted and image quality is degraded. When the moving stage 323 moves in the -Y direction, the counter mechanism 360 moves the counter stage 363 in the +Y direction, a counter inertia force in the opposite direction to the moving inertia force is generated. When the counter inertia force is transmitted to the fixed stage 321, the moving inertia force is attenuated by the counter inertia force. The counter mechanism 360 attenuates the inertial force generated by the movement of the moving stage 323. The counter mechanism 360 can suppress the generation of vibrations caused by the movement of the moving stage 323.
[0110] 9C shows a case where the moving stage 323 is moved in the -Y direction by the fourth displacement amount Δd4, but is not limited to this. The moving stage driving mechanism 325 can correct the displacement caused by vibration by moving the moving stage 323 in the direction opposite to the displacement direction of the displacement caused by the movement of the articulated robot 200. It is preferable that the moving stage driving mechanism 325 moves the moving stage 323 by the fourth displacement amount Δd4 or a distance smaller than the fourth displacement amount Δd4 in the direction opposite to the displacement direction of the displacement.
[0111] The counter mechanism 360 may move the counter stage 363 in the +Y direction by the fourth displacement amount Δd4, or may move the counter stage 363 by an amount different from the fourth displacement amount Δd4. The amount of movement of the counter stage 363 by the counter mechanism 360 is adjusted as appropriate.
[0112] In the second embodiment, the counter mechanism 360 generates a counter inertial force by moving the counter stage 363, but is not limited to this configuration. The counter mechanism 360 is not limited to a specific configuration as long as it generates a counter inertial force in the opposite direction to the moving inertial force.
[0113] The second end effector 300b preferably has a fixed stage 321 that is disposed between the articulated robot 200 and the moving stage 323 and supports the moving stage 323, and a counter mechanism 360 that applies an inertial force to the fixed stage 321 in a direction opposite to the direction in which the moving stage 323 moves. In other words, the counter mechanism 360 serves as a weight and vibrates in an antiphase to the movement of the moving stage 323. The counter mechanism 360 can reduce vibrations that occur in the articulated robot 200 when the moving stage 323 moves.
[0114] The robot system 100 of the second embodiment performs printing by ejecting ink onto the surface of an object, but is not limited to this. The liquid ejection head 311 may eject a liquid such as an adhesive instead of ink. When the liquid ejection head 311 ejects a liquid such as an adhesive, the robot system 100 functions as a system that applies a liquid to an object.
[0115] Third embodiment The third embodiment shows the configuration of a robot system 100 including an end effector 300 shown in Fig. 10. The robot system 100 of the third embodiment performs printing by ejecting ink onto the surface of an object. The object is a structure with a three-dimensional shape. The object has a flat or curved surface.
[0116] FIG. 10 shows an end effector 300 connected to the articulated robot 200. FIG. 10 shows a third end effector 300c, which is an example of the end effector 300. FIG. 10 shows a part of the articulated robot 200 and the third end effector 300c. FIG. 10 shows a fourth arm 224, a fifth arm 225, and a sixth arm 226 included in the articulated robot 200. The articulated robot 200 shown in FIG. 10 has the same configuration as the articulated robot 200 shown in FIG. 7. FIG. 10 shows a print head unit 310 and a third stage unit 320c included in the third end effector 300c. The third stage unit 320c is an example of the stage unit 320.
[0117] The third end effector 300c performs printing on the surface of an object. The third end effector 300c is fixed to the tip of the sixth arm 226. The third end effector 300c includes a print head unit 310 and a third stage unit 320c. The print head unit 310 shown in FIG. 10 has the same configuration as the print head unit 310 shown in FIG.
[0118] The third stage unit 320c is supported by the sixth arm 226. The third stage unit 320c supports the print head unit 310. The third stage unit 320c moves the print head unit 310 relative to the articulated robot 200. The third stage unit 320c moves the print head unit 310 when the print head unit 310 ejects ink onto the surface of an object. The third stage unit 320c shown in FIG. 10 moves the print head unit 310 along the Y axis. The third stage unit 320c includes a fixed stage 321, a moving stage 323, a moving stage driving mechanism 325, a counter mechanism 360, a counter stage 363, and a weight 370. The third stage unit 320c has the same configuration as the second stage unit 320b shown in FIG. 7, except that it includes the weight 370.
[0119] The weight 370 is provided on the counter stage 363. The weight 370 is supported on the fixed stage 321 via the counter stage 363 and the counter mechanism 360. The weight 370 increases the load when the counter mechanism 360 moves the counter stage 363. By providing the weight 370 on the counter stage 363, the counter inertial force generated by driving the counter mechanism 360 increases. The counter inertial force is adjusted by the weight of the weight 370.
[0120] The weight of the weight 370 is preferably the same as or approximately the same as the weight of the print head unit 310. The total weight obtained by adding the weight of the weight 370 to the weight of the counter stage 363 is preferably the same as or approximately the same as the total weight obtained by adding the weight of the print head unit 310 to the weight of the moving stage 323. The moving inertia force and the counter inertia force become equal or approximately equal, further reducing deviation in the ink landing position. The weight 370 corresponds to an example of a weight section.
[0121] 10, the counter stage 363 and the weight 370 are configured as separate bodies, but are not limited to this. The counter stage 363 and the weight 370 may be configured as a single body. The weight 370 may be provided so that its weight can be adjusted.
[0122] The fixed stage 321 preferably includes a weight 370 . By providing the weight 370, vibrations caused by the movement of the moving stage 323 are suppressed.
[0123] Fourth embodiment The fourth embodiment shows the configuration of a robot system 100 including an end effector 300 shown in Fig. 11. The robot system 100 of the fourth embodiment performs printing by ejecting ink onto the surface of an object. The object is a structure with a three-dimensional shape. The object has a flat or curved surface.
[0124] FIG. 11 shows an end effector 300 connected to the articulated robot 200. FIG. 11 shows a fourth end effector 300d, which is an example of the end effector 300. FIG. 11 shows a part of the articulated robot 200 and the fourth end effector 300d. FIG. 11 shows a fourth arm 224, a fifth arm 225, and a sixth arm 226 included in the articulated robot 200. The articulated robot 200 shown in FIG. 11 has the same configuration as the articulated robot 200 shown in FIG. 10 and the like. FIG. 11 shows a print head unit 310 and a fourth stage unit 320d included in the fourth end effector 300d. The fourth stage unit 320d is an example of the stage unit 320.
[0125] The fourth end effector 300d performs printing on the surface of an object. The fourth end effector 300d is fixed to the tip of the sixth arm 226. The fourth end effector 300d includes a print head unit 310, a fourth stage unit 320d, and a second print head unit 380. The print head unit 310 shown in FIG. 11 has the same configuration as the print head unit 310 shown in FIG. 10 etc.
[0126] The fourth stage unit 320d is supported by the sixth arm 226. The fourth stage unit 320d supports the print head unit 310. The fourth stage unit 320d moves the print head unit 310 relative to the articulated robot 200. The fourth stage unit 320d moves the print head unit 310 when the print head unit 310 ejects ink onto the surface of the target object. The fourth stage unit 320d shown in FIG. 11 moves the print head unit 310 along the Y axis. The fourth stage unit 320d includes a fixed stage 321, a moving stage 323, a moving stage driving mechanism 325, a second moving stage driving mechanism 365, and a second moving stage 367. The moving stage 323 and the moving stage driving mechanism 325 shown in FIG. 11 have the same configuration as the moving stage 323 and the moving stage driving mechanism 325 shown in FIG. 10 and the like.
[0127] The fixed stage 321 is supported by the sixth arm 226. The fixed stage 321 is fixed to the sixth arm 226 directly or via another member. The fixed stage 321 supports the moving stage driving mechanism 325 and the second moving stage driving mechanism 365 along the Y axis. The fixed stage 321 movably supports the moving stage 323 via the moving stage driving mechanism 325. The fixed stage 321 movably supports the second moving stage 367 via the second moving stage driving mechanism 365.
[0128] The second moving stage driving mechanism 365 moves the second moving stage 367 relative to the fixed stage 321. The second moving stage driving mechanism 365 shown in FIG. 11 moves the second moving stage 367 in the +Y direction or the -Y direction along the Y axis. The second moving stage driving mechanism 365 moves the second print head unit 380 along the Y axis by moving the second moving stage 367 along the Y axis. The second moving stage driving mechanism 365 moves the second print head unit 380 along the Y axis when the second print head unit 380 moves along the X axis to eject ink. The second moving stage driving mechanism 365 has the same configuration as the moving stage driving mechanism 325.
[0129] The second moving stage 367 is supported so as to be movable relative to the fixed stage 321. The second moving stage 367 supports the second print head unit 380. The second moving stage 367 has an opening (not shown). The second print head unit 380 is disposed in the opening. The ink ejection surface of the second print head unit 380 faces an object located in the -Z direction of the second print head unit 380. The second moving stage 367 supports the second print head unit 380 at a position in the -Y direction of the fixed stage 321.
[0130] The second print head unit 380 ejects ink onto the surface of an object. The second print head unit 380 ejects ink at predetermined intervals when moved in the +X direction or the -X direction by the drive of the articulated robot 200. The second print head unit 380 may have the same configuration as the print head unit 310, or may have a different configuration. It is preferable that the second print head unit 380 has the same configuration as the print head unit 310.
[0131] The second print head unit 380 may eject ink of a different color than the ink ejected by the print head unit 310, or may eject ink of the same color. It is preferable that the second print head unit 380 ejects ink of a different color than the ink ejected by the print head unit 310.
[0132] When the print head unit 310 ejects ink onto the surface of the object, the moving stage driving mechanism 325 moves the moving stage 323 in the +Y direction or the -Y direction. When the moving stage 323 moves in the +Y direction by the driving of the moving stage driving mechanism 325, the second moving stage driving mechanism 365 moves the second moving stage 367 in the -Y direction. When the moving stage 323 moves in the -Y direction by the driving of the moving stage driving mechanism 325, the second moving stage driving mechanism 365 moves the second moving stage 367 in the +Y direction. When the print head unit 310 ejects ink onto the surface of the object, the second print head unit 380 does not eject ink onto the surface of the object. When the print head unit 310 ejects ink onto the surface of the object, the second moving stage driving mechanism 365 operates as the counter mechanism 360 of the third embodiment. The second moving stage 367 functions as the counter stage 363. The second print head unit 380 functions as the weight 370 in the third embodiment.
[0133] When the second print head unit 380 ejects ink on the surface of the object, the second moving stage driving mechanism 365 moves the second moving stage 367 in the +Y direction or the -Y direction. When the second moving stage 367 moves in the +Y direction by the drive of the second moving stage driving mechanism 365, the moving stage driving mechanism 325 moves the moving stage 323 in the -Y direction. When the second moving stage 367 moves in the -Y direction by the drive of the second moving stage driving mechanism 365, the moving stage driving mechanism 325 moves the moving stage 323 in the +Y direction. When the second print head unit 380 ejects ink on the surface of the object, the print head unit 310 does not eject ink on the surface of the object. When the second print head unit 380 ejects ink on the surface of the object, the moving stage driving mechanism 325 operates as the counter mechanism 360 of the third embodiment. The moving stage 323 functions as a counter stage 363. The print head unit 310 functions as the weight 370 in the third embodiment.
[0134] The robot system 100 of the fourth embodiment performs printing by ejecting ink onto the surface of an object, but is not limited to this. The print head unit 310 or the second print head unit 380 may eject a liquid such as an adhesive instead of ink. The print head unit 310 and the second print head unit 380 may eject a liquid such as an adhesive instead of ink. When at least one of the liquid ejection head 311 and the second print head unit 380 ejects a liquid such as an adhesive, the robot system 100 functions as a system that applies a liquid to an object.
[0135] Fifth embodiment The fifth embodiment shows the configuration of a robot system 100 including an end effector 300 shown in Fig. 12. The robot system 100 of the fifth embodiment performs printing by ejecting ink onto the surface of an object. The object is a structure with a three-dimensional shape. The object has a flat or curved surface.
[0136] FIG. 12 shows an end effector 300 connected to the articulated robot 200. FIG. 12 shows a fifth end effector 300e, which is an example of the end effector 300. FIG. 12 shows a part of the articulated robot 200 and the fifth end effector 300e. FIG. 12 shows a fourth arm 224, a fifth arm 225, and a sixth arm 226 included in the articulated robot 200. The articulated robot 200 shown in FIG. 12 has the same configuration as the articulated robot 200 shown in FIG. 11 and the like. FIG. 12 shows a print head unit 310 and a fifth stage unit 320e included in the fifth end effector 300e. The fifth stage unit 320e is an example of the stage unit 320.
[0137] The fifth end effector 300e performs printing on the surface of an object. The fifth end effector 300e is fixed to the tip of the sixth arm 226. The fifth end effector 300e includes a print head unit 310 and a fifth stage unit 320e. The print head unit 310 shown in FIG. 12 has the same configuration as the print head unit 310 shown in FIG. 11 and the like.
[0138] The fifth stage unit 320e is supported by the sixth arm 226. The fifth stage unit 320e supports the print head unit 310. The fifth stage unit 320e moves the print head unit 310 relative to the articulated robot 200. The fifth stage unit 320e moves the print head unit 310 when the print head unit 310 ejects ink onto the surface of an object. The fifth stage unit 320e shown in FIG. 12 moves the print head unit 310 along the X-axis and Y-axis. The fifth stage unit 320e includes a fixed stage 321, a moving stage 323, a moving stage driving mechanism 325, a support stage 385, and a support stage driving mechanism 390. The moving stage 323 and the moving stage driving mechanism 325 shown in FIG. 12 have the same configuration as the moving stage 323 and the moving stage driving mechanism 325 shown in FIG. 10 and the like.
[0139] The support stage 385 is disposed between the fixed stage 321 and the moving stage 323. The support stage 385 is disposed at a position in the -Z direction of the fixed stage 321. The support stage 385 supports the moving stage 323 so that it can be moved by the moving stage driving mechanism 325. The support stage 385 is movably supported by the fixed stage 321. The support stage 385 is driven by a support stage driving mechanism 390. The support stage 385 corresponds to an example of an adjustment stage.
[0140] The support stage driving mechanism 390 moves the support stage 385 relative to the fixed stage 321. The support stage driving mechanism 390 shown in FIG. 12 moves the support stage 385 in the +X direction or the -X direction along the X axis. The support stage driving mechanism 390 moves the support stage 385 along the X axis, thereby moving the print head unit 310 along the X axis. The support stage driving mechanism 390 corrects the position of the print head unit 310 along the X axis when the print head unit 310 moves along the X axis to eject ink. The movement distance of the print head unit 310 along the X axis by the support stage driving mechanism 390 is shorter than the transport distance of the print head unit 310 along the X axis by the articulated robot 200. The support stage driving mechanism 390 corresponds to an example of an adjustment stage driving mechanism.
[0141] Figures 13A, 13B, and 13C show the state of the end effector 300. Figures 13A, 13B, and 13C show the state of a fifth end effector 300e, which is an example of the end effector 300. Figures 13A, 13B, and 13C show the fifth end effector 300e as viewed from the -Z direction.
[0142] 13A, 13B, and 13C show the moving stage 323, the liquid ejection head 311, and the support stage 385. FIG. 13A, 13B, and 13C show one of the nozzles 315 formed on the ejection surface of the liquid ejection head 311. FIG. 13A, 13B, and 13C show the sixth arm 226 virtually. FIG. 13A, 13B, and 13C show the control position CP and the printing position PP with imaginary lines. FIG. 13A, 13B, and 13C show the arm center 226a, which is the central position of the sixth arm 226. The printing position PP shown in FIG. 13A, 13B, and 13C is a virtual line parallel to the Y axis that passes over the nozzle 315 when the arm center 226a is located on the control position CP.
[0143] 13A shows the state of the fifth end effector 300e when the articulated robot 200 is located at a position controlled by the print control unit 510. When the articulated robot 200 is not displaced due to vibration of the arm drive mechanism 240 or the like, the arm center 226a of the sixth arm 226 is located at the control position CP, for example.
[0144] Fig. 13B shows a state of the fifth end effector 300e when the articulated robot 200 is displaced due to vibration. Fig. 13B shows a state when the moving stage 323 and the support stage 385 are not operating. Fig. 13B shows a state when the articulated robot 200 is displaced in the +X direction due to vibration. The articulated robot 200 is displaced due to vibration that occurs when the fifth end effector 300e is moved in the +X direction or the -X direction.
[0145] The arm center 226a of the sixth arm 226 is displaced to a displacement position DP in the +X direction by the vibration. The displacement position DP is a position displaced by a fifth displacement amount Δd5 in the +X direction from the control position CP. When the arm center 226a is displaced to the displacement position DP, the nozzle 315 is displaced to a nozzle position NP displaced by a fifth displacement amount Δd5 in the +X direction. When the nozzle 315 ejects ink at the nozzle position NP, the ink landing position is shifted to a position displaced by the fifth displacement amount Δd5 in the +X direction from the printing position PP. The vibration of the articulated robot 200 causes distortion in the image printed on the surface of the target object.
[0146] FIG. 13C shows the state of the fifth end effector 300e when the support stage 385 is moved to correct the ink landing position. FIG. 13C shows the state in which the support stage 385 is moved in the -X direction. The arm center 226a of the sixth arm 226 is located at a displacement position DP in the +X direction due to vibration. When the support stage 385 moves a fifth displacement amount Δd5 in the -X direction along the X axis, the nozzle 315 is located at the printing position PP. The support stage driving mechanism 390 moves the support stage 385 in the -X direction along the X axis, so that the displacement caused by the movement of the articulated robot 200 can be corrected. The X axis corresponds to an example of a parallel axis parallel to a predetermined direction.
[0147] 13C shows a case where the support stage 385 is moved in the -X direction by a fifth displacement amount Δd5, but is not limited thereto. The support stage driving mechanism 390 can correct the displacement caused by vibration by moving the support stage 385 in a direction opposite to the displacement direction of the displacement caused by the movement of the articulated robot 200. It is preferable that the support stage driving mechanism 390 moves the support stage 385 by the fifth displacement amount Δd5 or a distance smaller than the fifth displacement amount Δd5 in the direction opposite to the displacement direction of the displacement.
[0148] 13A, 13B, and 13C show a state in which the translation stage 323 does not move. When the support stage 385 moves along the X-axis, the translation stage 323 may move along the Y-axis. By moving the support stage 385 and the translation stage 323, the displacement along the X-axis and the displacement along the Y-axis can be corrected.
[0149] Figures 14A, 14B, and 14C show the state of the end effector 300. Figures 14A, 14B, and 14C show the state of a fifth end effector 300e, which is an example of the end effector 300. Figures 14A, 14B, and 14C show the fifth end effector 300e as viewed from the -Z direction.
[0150] 14A, 14B, and 14C show the moving stage 323, the liquid ejection head 311, and the support stage 385. FIG. 14A, 14B, and 14C show one of the nozzles 315 formed on the ejection surface of the liquid ejection head 311. FIG. 14A, 14B, and 14C show the sixth arm 226 virtually. FIG. 14A, 14B, and 14C show the control position CP and the printing position PP with imaginary lines. FIG. 14A, 14B, and 14C show the arm center 226a, which is the central position of the sixth arm 226. The printing position PP shown in FIG. 14A, 14B, and 14C is a virtual line parallel to the Y axis that passes over the nozzle 315 when the arm center 226a is located on the control position CP.
[0151] Fig. 14A shows the state of the fifth end effector 300e when the articulated robot 200 is located at a position controlled by the print control unit 510. When the articulated robot 200 is not displaced due to vibration of the arm drive mechanism 240, etc., the arm center 226a of the sixth arm 226 is located at the control position CP, for example. Fig. 14A shows the same state as Fig. 13A.
[0152] Fig. 14B shows a state of the fifth end effector 300e when the articulated robot 200 is displaced due to vibration. Fig. 14B shows a state when the moving stage 323 and the support stage 385 are not operating. Fig. 14B shows a state when the articulated robot 200 is displaced in the -X direction due to vibration. The articulated robot 200 is displaced due to vibration that occurs when the fifth end effector 300e is moved in the +X direction or the -X direction.
[0153] The arm center 226a of the sixth arm 226 is displaced to a displacement position DP in the -X direction by the vibration. The displacement position DP is a position displaced by a sixth displacement amount Δd6 in the -X direction from the control position CP. When the arm center 226a is displaced to the displacement position DP, the nozzle 315 is displaced to a nozzle position NP displaced by the sixth displacement amount Δd6 in the -X direction. When the nozzle 315 ejects ink at the nozzle position NP, the ink landing position is shifted to a position displaced by the sixth displacement amount Δd6 in the -X direction from the printing position PP. The vibration of the articulated robot 200 causes distortion in the image printed on the surface of the target object.
[0154] FIG. 14C shows the state of the fifth end effector 300e when the support stage 385 is moved to correct the ink landing position. FIG. 14C shows the state in which the support stage 385 is moved in the +X direction. The arm center 226a of the sixth arm 226 is located at a displacement position DP in the -X direction due to vibration. When the support stage 385 moves a sixth displacement amount Δd6 in the +X direction along the X axis, the nozzle 315 is located at the printing position PP. The support stage drive mechanism 390 moves the support stage 385 in the +X direction along the X axis, so that the displacement caused by the movement of the articulated robot 200 can be corrected.
[0155] 14C shows a case where the support stage 385 is moved in the +X direction by the sixth displacement amount Δd6, but is not limited thereto. The support stage drive mechanism 390 can correct the displacement caused by vibration by moving the support stage 385 in the direction opposite to the displacement direction of the displacement caused by the movement of the articulated robot 200. It is preferable that the support stage drive mechanism 390 moves the support stage 385 by the sixth displacement amount Δd6 or a distance smaller than the sixth displacement amount Δd6 in the direction opposite to the displacement direction of the displacement.
[0156] The fifth end effector 300e has a support stage 385 that moves the print head unit 310 along the X axis parallel to the +X direction or the -X direction, and a support stage drive mechanism 390 that moves the support stage 385 along the X axis. The robot system 100 can correct deviations in the ink landing position along the X-axis.
[0157] 14A, 14B, and 14C show a state in which the translation stage 323 does not move. When the support stage 385 moves along the X-axis, the translation stage 323 may move along the Y-axis. By moving the support stage 385 and the translation stage 323, the displacement along the X-axis and the displacement along the Y-axis can be corrected.
[0158] The robot system 100 of the fifth embodiment performs printing by ejecting ink onto the surface of an object, but is not limited to this. The liquid ejection head 311 may eject a liquid such as an adhesive instead of ink. When the liquid ejection head 311 ejects a liquid such as an adhesive, the robot system 100 functions as a system that applies a liquid to an object.
[0159] The robot system 100 of the fifth embodiment may include a counter mechanism 360 shown in FIG. 7 and the like. The counter mechanism 360 is provided on the fixed stage 321. The counter mechanism 360 attenuates the inertial force of movement generated by the movement of the moving stage 323 and the support stage 385. [Explanation of symbols]
[0160] 100...robot system, 200...articulated robot, 210...base, 220...robot arm, 221...first arm, 222...second arm, 223...third arm, 224...fourth arm, 225...fifth arm, 226...sixth arm, 226a...arm center, 230...robot controller, 231...robot memory unit, 233...arm control unit, 240...arm drive mechanism, 241...joint motor group, 243...joint encoder group, 300...end effector, 300a...first end effector, 300b...second end effector, 300c...third end effector end effector, 300d...fourth end effector, 300e...fifth end effector, 310...print head unit, 311...liquid ejection head, 313...ink tank, 315...nozzle, 320...stage unit, 320a...first stage unit, 320b...second stage unit, 320c...third stage unit, 320d...fourth stage unit, 320e...fifth stage unit, 321...fixed stage, 323...moving stage, 325...moving stage drive mechanism, 327...support part, 329...ultrasonic motor, 331...carriage, 333 ...rail, 335...screw, 340...print controller, 350...stage controller, 360...counter mechanism, 363...counter stage, 365...second moving stage drive mechanism, 367...second moving stage, 370...weight, 380...second print head unit, 385...support stage, 390...support stage drive mechanism, 500...control device, 510...print control unit, 511...print data generation unit, 513...print data correction unit, 515...operation control unit, 517...movement data generation unit, 530...memory unit, CP...control position, DP...displacement position, J1... 1st joint, J1E...1st joint encoder, J1M...1st joint motor, J2...2nd joint, J2E...2nd joint encoder, J2M...2nd joint motor, J3...3rd joint, J3E...3rd joint encoder, J3M...3rd joint motor, J4...4th joint, J4E...4th joint encoder, J4M...4th joint motor, J5...5th joint, J5E...5th joint encoder, J5M...5th joint motor, J6...6th joint, J6E...6th joint encoder, J6M...6th joint motor, NP...nozzle position, PP...printing position, Δd1...1st displacement amount, Δd2...2nd displacement amount,Δd3: third displacement amount, Δd4: fourth displacement amount, Δd5: fifth displacement amount, Δd6: sixth displacement amount.
Claims
1. a head unit including an ejection head that ejects liquid, a stage that supports the ejection head, and a stage drive mechanism that moves the stage; a robot that supports the head unit and moves the ejection head in a predetermined direction when the ejection head ejects the liquid, The stage driving mechanism includes: The stage is moved when the ejection head ejects the liquid, and a displacement caused by the movement of the robot is corrected; the head unit has a weight portion disposed on the opposite side of the ejection head with respect to an axis of the tip arm of the robot, The weight portion vibrates in an opposite phase to the movement of the stage. Robot system.
2. The stage driving mechanism moves the stage along an orthogonal axis perpendicular to the predetermined direction. The robot system of claim 1 .
3. The head unit includes: an adjustment stage that moves the ejection head along a parallel axis that is parallel to the predetermined direction; an adjustment stage drive mechanism that moves the adjustment stage along the parallel axis; The robot system according to claim 2 , further comprising:
4. the stage driving mechanism corrects the displacement based on displacement information when the robot moves the discharge head in the predetermined direction; The robot system of claim 1 .
5. The weight unit has a second stage driving mechanism. The robot system of claim 1 .
6. The weight portion has a second discharge head. The robot system according to claim 5 .
7. a base having a mounting portion adapted to be attached to a robot arm; a head unit having a print head that ejects ink, a stage that supports the print head, and a stage drive mechanism that moves the stage; The stage driving mechanism includes: correcting a displacement caused by a robot moving when the print head ejects the ink; the head unit has a weight portion that is disposed on the opposite side of the print head with respect to the axis of the tip arm of the robot, The weight portion vibrates in an opposite phase to the movement of the stage. Printing device.
Citation Information
Patent Citations
System for printing on object
JP2013202781A
