Printing method and printer
The printing method and apparatus address drive vibrations in robots by using a stage with opposite phase vibrations to stabilize ink landing positions, enhancing image quality.
Patent Information
- Application Number
- JP2023070710
- 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
Drive vibrations in robots used for printing cause fluctuations in ink landing positions, leading to decreased image quality.
A printing method and apparatus that utilizes a robot with a stage supported by the robot, where the stage operates with a correction vibration phase opposite to the drive vibration, and the correction vibration has a resonant frequency removed, to stabilize the ink landing position.
Stabilizes ink landing positions, reducing deviations and improving image quality by counteracting drive vibrations with corrective vibrations.
Smart Images

Figure 2024156336000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a printing method and a printing device. [Background technology]
[0002] A printing method is known in which printing is performed using a print head provided on a robot. The system described in Patent Document 1 includes a robot, a print head, and a piezo actuator. The robot moves the print head to the surface of an object. The print head prints a print track when moved by the robot. The print head prints a plurality of print tracks in a predetermined direction. The piezo actuator moves the print head relative to the robot. The piezo actuator reduces strip formation occurring between the print tracks. [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 the robot moves the print head, drive vibrations are generated. Drive vibrations cause the ink landing position to fluctuate, resulting in reduced image quality. Patent Document 1 does not consider a method for correcting the ink landing position caused by drive vibrations. [Means for solving the problem]
[0005] The printing method disclosed herein is a printing method that uses a robot, a stage supported by the robot, and a print head supported by the stage, and when the print head is ejecting the ink, the stage operates with a corrective vibration that is in the opposite phase to the driving vibration generated by driving the robot, and the corrective vibration removes the resonant frequency of the robot.
[0006] The printing device disclosed herein comprises a print head that ejects ink, a stage that supports the print head, a robot that supports the stage and transports the print head supported by the stage, and a control unit that controls the print head, the stage, and the robot, wherein the control unit causes the robot to eject the ink while transporting the print head in a predetermined direction, and when the print head ejects the ink, the stage operates with a corrective vibration that is in the opposite phase to the driving vibration generated by the driving of the robot, and the corrective vibration removes the resonant frequency of the robot. [Brief description of the drawings]
[0007] [Figure 1] FIG. 1 is a diagram showing an overall configuration of a robot system. [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 diagram showing a schematic configuration of an end effector. [Diagram 5] FIG. 4 is a diagram illustrating the landing position of ink. [Figure 6A] FIG. 11 is a diagram illustrating a displacement of a landing position. [Figure 6B] FIG. 4 is a diagram illustrating the operation of a moving stage. [Figure 7] FIG. 1 is a diagram showing a control flow executed in the robot system. [Figure 8] FIG. 2 is a diagram showing a schematic configuration of an end effector. [Figure 9] FIG. 1 is a block diagram showing a configuration of a robot system. [Figure 10] FIG. 4 is a diagram showing an example of pre-print data. [Figure 11] FIG. 4 is a diagram showing a control flow for generating pre-print data. [Figure 12] FIG. 1 is a diagram showing a control flow executed in the robot system. [Figure 13]FIG. 1 is a block diagram showing a configuration of a robot system. [Figure 14] FIG. 4 is a diagram showing an example of an analysis result of time-frequency analysis. [Figure 15] FIG. 13 is a diagram showing an example of a result of data processing on Fourier transform data. [Figure 16] FIG. 13 shows the results of performing an inverse short-time Fourier transform on modified Fourier transform data. [Figure 17] 5A and 5B are diagrams showing a portion of pre-print data and a portion of corrected pre-print data. [Figure 18] FIG. 11 is a diagram showing a control flow for generating corrected preprint data. [Figure 19] FIG. 1 is a block diagram showing a configuration of a robot system. [Figure 20] FIG. 1 is a diagram showing a control flow executed in the robot system. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0008] Fig. 1 shows the overall configuration of a robot system 100. The robot system 100 includes an articulated robot 200, an end effector 300, and a control device 500. The robot system 100 and the control device 500 are communicatively connected. In Fig. 1, the robot system 100 and the control device 500 are shown as having different configurations, but the control device 500 may be built into the robot system 100. The robot system 100 corresponds to an example of a printing device.
[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 ink onto a surface of an object. The end effector 300 prints on the surface of the object by ejecting ink onto the object. A detailed configuration of the end effector 300 will be described later.
[0020] The control device 500 controls the articulated robot 200 and the end effector 300. The control device 500 controls the print head unit 310, the stage driving mechanism 325, and the like included in the end effector 300. The print head unit 310 and the stage driving mechanism 325 will be described later. 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 by 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 by 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 and the like from the external device. The control device 500 corresponds to an example of a control unit.
[0021] Fig. 2 shows an end effector 300 connected to the articulated robot 200. Fig. 2 shows a part of the articulated robot 200 and the end effector 300. 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 stage unit 320 included in the end effector 300.
[0022] 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 being driven by 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 stage driving mechanism 325 to the print head unit 310. The -Y direction is the direction from the print head unit 310 to the stage driving 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.
[0023] The articulated robot 200 moves the end effector 300 to a position where printing can be performed on the target object. The articulated robot 200 moves the end effector 300 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 end effector 300 in the +Y direction or the -Y direction. After the articulated robot 200 moves the end effector 300 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 end effector 300 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.
[0024] The end effector 300 performs printing on the surface of an object. The end effector 300 is fixed to the tip of the sixth arm 226. The end effector 300 includes a print head unit 310 and a stage unit 320.
[0025] The print head unit 310 ejects ink onto the surface of an object. The print head unit 310 ejects ink at predetermined time intervals when moved in the +X direction or the -X direction by the drive of the articulated robot 200. The print head unit 310 corresponds to an example of a print head.
[0026] The stage unit 320 is supported by the sixth arm 226. The stage unit 320 supports the print head unit 310. The stage unit 320 moves the print head unit 310 relative to the articulated robot 200. The stage unit 320 moves the print head unit 310 when the print head unit 310 ejects ink onto the surface of an object. The stage unit 320 shown in FIG. 2 moves the print head unit 310 along the Y axis. The stage unit 320 includes a fixed stage 321, a movable stage 323, and a stage driving mechanism 325.
[0027] 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 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.
[0028] The moving stage 323 is supported by the articulated robot 200 via the fixed stage 321. 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 disposed in the opening. 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.
[0029] The stage driving mechanism 325 moves the moving stage 323 relative to the fixed stage 321. The stage driving mechanism 325 moves the moving stage 323 based on the control of the control device 500. The 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 stage driving mechanism 325 moves the print head unit 310 along the Y axis by moving the moving stage 323 along the Y axis. The 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 stage driving mechanism 325 may move the moving stage 323 in the +X direction or the -X direction along the X axis. The stage driving mechanism 325 moves the moving stage 323 along the X axis by moving the moving stage 323 along the X axis to move the print head unit 310 along the X axis. The stage driving mechanism 325 moves the print head unit 310 along the X axis when the print head unit 310 moves along the X axis to eject ink. The stage driving mechanism 325 may move the moving stage 323 along the X axis and the Y axis when the print head unit 310 moves along the X axis to eject ink.
[0030] 3 shows a schematic configuration of the end effector 300. The end effector 300 includes a print head unit 310 and a stage unit 320. The print head unit 310 includes a liquid ejection head 311 and an ink tank 313. The stage unit 320 includes a fixed stage 321, a movable stage 323, a stage driving mechanism 325, a screw 335, and a stage controller 350.
[0031] The liquid ejection head 311 ejects ink toward an object. The liquid ejection head 311 prints by ejecting ink onto the surface of an object fixed at a position in the -Z direction. The liquid ejection head 311 is attached to the articulated robot 200 via a stage unit 320. The liquid ejection head 311 ejects ink when the end effector 300 moves in the +X direction or the -X direction by being driven by the articulated robot 200. The liquid ejection head 311 ejects ink at a predetermined time interval along the X axis. The liquid ejection head 311 has an ink supply path, a print controller 340, and the like inside, which are not shown. A plurality of nozzles are formed on the ink ejection surface of the liquid ejection head 311 that faces the object. The nozzles are openings that eject ink onto the surface of the object. The nozzles are not shown.
[0032] 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.
[0033] 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.
[0034] The moving stage 323 supports the liquid ejection head 311. The liquid ejection head 311 is placed in an opening (not shown) of the moving stage 323. The opening causes the ink ejection surface of the liquid ejection head 311 to face a target object placed at a position in the -Z direction of the moving stage 323. Nozzles formed on the ink ejection surface can eject ink onto the surface of the target object.
[0035] The stage driving mechanism 325 is disposed between the fixed stage 321 and the moving stage 323. The 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 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, whereby the end effector 300 is fixed to the articulated robot 200.
[0041] The stage controller 350 controls the driving of the 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] 3 is able to slide the print head unit 310 along the Y axis by moving the moving stage 323. The distance the print head unit 310 is moved by the moving stage 323 is shorter than the distance the print head unit 310 is transported by the articulated robot 200. By moving the moving stage 323, the end effector 300 is able to correct any deviation in the ink landing position in the +Y direction or the -Y direction.
[0043] 3 uses an ultrasonic motor 329 to move the moving stage 323, but is not limited to this configuration. The moving stage 323 may be moved by a piezoelectric drive, an electromagnetic direct drive, an electromagnetic reduction mechanism, or the like.
[0044] FIG. 4 shows a schematic configuration of the end effector 300. The end effector 300 shown in FIG. 4 is configured to be able to move the moving stage 323 along the X-axis and the Y-axis. The end effector 300 shown in FIG. 4 includes a print head unit 310 and a stage unit 320. The print head unit 310 shown in FIG. 4 has the same configuration as the print head unit 310 shown in FIG. 3. The stage unit 320 shown in FIG. 4 has a second moving stage 361 and a second carriage 363 in addition to the configuration of the stage unit 320 shown in FIG. 3. The fixed stage 321, the moving stage 323, the stage driving mechanism 325, the screw 335, and the stage controller 350 shown in FIG. 4 have the same configuration as the fixed stage 321, the moving stage 323, the stage driving mechanism 325, the screw 335, and the stage controller 350 shown in FIG. 3.
[0045] The second moving stage 361 is provided between the fixed stage 321 and the stage driving mechanism 325. The second moving stage 361 is movably supported by the fixed stage 321. The second moving stage 361 movably supports the moving stage 323. The second moving stage 361 slides in the +X direction or the -X direction along the X axis by a second stage driving mechanism including a second carriage 363. Components of the second stage driving mechanism other than the second carriage 363 are not shown.
[0046] The second carriage 363 is included in the second stage driving mechanism. The second carriage 363 moves the second moving stage 361 along the X-axis relative to the fixed stage 321. The second carriage 363 moves the second moving stage 361 by the driving force of a second ultrasonic motor (not shown).
[0047] 4 is able to slide the print head unit 310 along the Y axis by moving the moving stage 323. The distance the print head unit 310 is moved by the moving stage 323 is shorter than the distance the print head unit 310 is transported by the articulated robot 200. By moving the moving stage 323, the end effector 300 is able to correct any deviation in the ink landing position in the +Y direction or the -Y direction.
[0048] The end effector 300 shown in Fig. 4 can slide the print head unit 310 along the X-axis by moving the second moving stage 361. The movement distance of the print head unit 310 by the second moving stage 361 is shorter than the transport distance of the print head unit 310 by the articulated robot 200. The end effector 300 can correct deviations in the ink landing position in the +X direction or -X direction by moving the second moving stage 361. The robot system 100 is configured with the end effector 300 shown in Fig. 3 or the end effector 300 shown in Fig. 4.
[0049] FIG. 5 shows a schematic diagram of the ink landing position. FIG. 5 shows the ink landing position when the print head unit 310 ejects ink onto the surface of the target object. FIG. 5 shows a schematic diagram of an example of the landing position of ink ejected when the articulated robot 200 transports the print head unit 310 in the +X direction, as an actual landing position AP. The actual landing position AP indicates an ink dot formed on the surface of the target object. The print head unit 310 ejects ink onto the surface of the target object at a predetermined time interval. FIG. 5 shows a plurality of actual landing positions AP and a plurality of controlled landing positions CP. FIG. 5 shows a printing virtual line VL. The printing virtual line VL is a virtual line parallel to the X-axis.
[0050] The controlled landing position CP is the assumed position when the print head unit 310 ejects ink onto the surface of the target object based on the print data. The controlled landing position CP is located on the print virtual line VL. The print head unit 310 ejects ink toward the controlled landing position CP. If no displacement occurs in the print head unit 310, the actual landing position AP is located on the controlled landing position CP.
[0051] As shown in FIG. 5, the actual landing position AP is different from the controlled landing position CP. When the articulated robot 200 transports the end effector 300 along the X-axis, driving vibration is generated in the articulated robot 200. The position of the print head unit 310 is displaced by the driving vibration. Due to the displacement of the print head unit 310, the actual landing position AP of the ink is positioned at a position shifted from the controlled landing position CP. The actual landing position AP is positioned at a position shifted in the direction along the X-axis or Y-axis from the controlled landing position CP. The multiple actual landing positions AP are positioned at positions shifted from their respective controlled landing positions CP. As shown in FIG. 5, the kth actual landing position AP, which is the kth actual landing position AP, is disposed at a position shifted from the controlled landing position CP. k For example, the kth control landing position CP k , where k is an arbitrary integer.
[0052] FIG. 6A shows a schematic diagram of the deviation of the landing position. FIG. 6A shows a schematic diagram of the deviation of the actual landing position AP when the robot system 100 prints a line parallel to the X-axis. The articulated robot 200 transports the print head unit 310 along the X-axis. The print head unit 310 ejects ink onto the surface of the target object at a predetermined time interval. The horizontal axis of FIG. 6A shows the time when the line is printed. The horizontal axis corresponds to the position of the ink dots in the printed line parallel to the X-axis. The vertical axis of FIG. 6A shows the deviation of the actual landing position AP from the printing virtual line VL along the Y-axis as a displacement.
[0053] As an example, the articulated robot 200 transports the end effector 300 in the +X direction along the X axis. During the transport of the end effector 300, the print head unit 310 arranged on the end effector 300 ejects ink onto the surface of the target at a predetermined time interval. The ink landing position AP is displaced to a position shifted from the controlled landing position CP due to the operational vibration caused by the driving of the articulated robot 200. Each actual landing position AP varies depending on the displacement direction and displacement amount of the print head unit 310 at the timing of ejecting ink. The displacement of each actual landing position AP is shown in the graph in FIG. 6A as an example. FIG. 6A shows the displacement of the actual landing position AP relative to the controlled landing position CP for each timing of ejecting ink as a curve. FIG. 6A shows an example of the operational vibration. The operational vibration corresponds to an example of the driving vibration.
[0054] FIG. 6B is a schematic diagram showing the operation of the moving stage 323. FIG. 6B is a schematic diagram showing the direction and amount of movement of the moving stage 323 when the print head unit 310 prints a line parallel to the X-axis. The horizontal axis of FIG. 6B shows the time when the line is printed. The horizontal axis corresponds to the position along the X-axis of the print head unit 310 moving along the X-axis. The vertical axis of FIG. 6B shows the direction and amount of movement of the moving stage 323 along the Y-axis as a displacement.
[0055] When the print head unit 310 ejects ink onto the surface of the target, the actual landing position AP is displaced by a predetermined amount and in a predetermined direction relative to the controlled landing position CP due to the operational vibration. When the print head unit 310 ejects ink onto the surface of the target, the moving stage 323 moves in a direction opposite to the direction in which the actual landing position AP is displaced relative to the controlled landing position CP due to the operational vibration. The movement of the moving stage 323 in a direction opposite to the direction in which the actual landing position AP is displaced relative to the controlled landing position CP reduces the displacement of the actual landing position AP relative to the controlled landing position CP. As shown in FIG. 6B, the moving stage 323 operates with a stage vibration in the opposite phase to the operational vibration shown in FIG. 6A, thereby reducing the deviation of the landing position caused by the operational vibration. FIG. 6B shows an example of the stage vibration. The stage vibration corresponds to an example of the correction vibration.
[0056] Fig. 7 shows a control flow executed by the robot system 100. Fig. 7 shows, in a flowchart, a control flow for reducing operational vibrations using the moving stage 323. The control flow shown in Fig. 7 is performed by executing a control program. As an example, the control flow shown in Fig. 7 is executed by the robot system 100 having the end effector 300 shown in Fig. 3. The control flow corresponds to an example of a printing method.
[0057] In step S101, the control device 500 acquires operational vibrations. The control device 500 acquires head vibration data related to the operational vibrations. The control device 500 may acquire the head vibration data in advance and store it in a storage unit 530, which will be described later. The control device 500 may detect vibrations of the print head unit 310 with a sensor or the like, and acquire the head vibration data based on the detection results. Details of the method of acquiring the head vibration data will be described later.
[0058] After acquiring the operational vibration, the control device 500 generates movement data in step S103. The movement data is data for moving the moving stage 323. The movement data includes the direction and amount of movement of the moving stage 323 when the print head unit 310 ejects ink. The control device 500 generates movement data for operating the moving stage 323 with stage vibration. The control device 500 generates the movement data based on head vibration data acquired in advance. Alternatively, the control device 500 generates the movement data in real time based on the vibration of the print head unit 310 detected by a sensor or the like, immediately before ejecting ink at each timing. The movement data corresponds to an example of correction data.
[0059] After generating the movement data, in step S105, the control device 500 transports the print head unit 310 along the X axis. The control device 500 drives the articulated robot 200 to transport the end effector 300 along the X axis. The control device 500 moves the print head unit 310 placed on the end effector 300 by transporting the end effector 300. The articulated robot 200 moves the print head unit 310 in the +X direction or -X direction along the X axis.
[0060] In step S107, while the print head unit 310 is moving, the control device 500 moves the moving stage 323 based on the movement data. The control device 500 acquires a control value of the movement data for the position or time at which ink is ejected. The control device 500 acquires the movement direction and movement amount of the moving stage 323 for the position or time at which ink is ejected. The control device 500 moves the moving stage 323 in the acquired movement direction and movement amount. The control device 500 operates the moving stage 323 with stage vibration that is in the opposite phase to the operational vibration generated by the drive of the articulated robot 200.
[0061] After moving the moving stage 323, the control device 500 ejects ink in step S109. The control device 500 ejects ink onto the surface of the target object based on the print data. The print head unit 310 ejects ink toward the controlled landing position CP. By the moving stage 323 moving the print head unit 310, the deviation between the actual landing position AP and the controlled landing position CP is reduced.
[0062] After ejecting the ink, the control device 500 determines whether or not printing of the line has finished in step S111. The control device 500 determines whether or not ejection of ink along the X-axis has finished.
[0063] When the control device 500 determines that the ink ejection along the X-axis has ended, it ends printing the line along the X-axis (step S111; YES). The control device 500 drives the articulated robot 200 to move the end effector 300 in the +Y direction or -Y direction along the Y-axis. Alternatively, the control device 500 ends printing.
[0064] If the control device 500 determines that the ejection of ink along the X-axis has not ended, it returns to step S105 (step S111; NO). The control device 500 continues printing the line along the X-axis. The control device 500 moves the print head unit 310 in the +Y direction or the -Y direction. After moving the print head unit 310 in the +Y direction or the -Y direction, the control device 500 moves the print head unit 310 along the X-axis. The control device 500 causes the print head unit 310 to print the next line.
[0065] The control flow uses an articulated robot 200, a moving stage 323 supported by the articulated robot 200, and a print head unit 310 supported by the moving stage 323. The print head unit 310 ejects ink at predetermined time intervals when transported in the +X direction or -X direction by the articulated robot 200. When the print head unit 310 is ejecting ink, the moving stage 323 operates with a stage vibration that is in the opposite phase to the operational vibration generated by the driving of the articulated robot 200. The moving stage 323 operates in the opposite phase to the operational vibration caused by the driving of the articulated robot 200, thereby reducing the deviation between the actual landing position AP and the controlled landing position CP. This reduces degradation in image quality when the robot system 100 performs printing.
[0066] The robot system 100 includes a print head unit 310 that ejects ink, a moving stage 323 that supports the print head unit 310, an articulated robot 200 that supports the moving stage 323 and transports the print head unit 310 supported by the moving stage 323, and a control device 500 that controls the print head unit 310, the moving stage 323, and the articulated robot 200. The control device 500 causes the articulated robot 200 to transport the print head unit 310 in the +X direction or the -X direction, causes the print head unit 310 to eject ink at predetermined time intervals when the articulated robot 200 transports the print head unit 310 in the +X direction or the -X direction, and causes the moving stage 323 to operate with stage vibration in the opposite phase to the operational vibration generated by driving the articulated robot 200 when the print head unit 310 ejects ink. The moving stage 323 operates in the opposite phase to the operational vibration caused by the driving of the articulated robot 200, thereby reducing the deviation between the actual landing position AP and the controlled landing position CP. This reduces degradation in image quality when the robot system 100 performs printing.
[0067] First embodiment The first embodiment shows a robot system 100 that acquires head vibration data in advance and controls the operation of a moving stage 323 based on the head vibration data. A control device 500 operates the moving stage 323 using movement data generated based on the head vibration data. By operating the moving stage 323, the robot system 100 reduces the influence of operational vibration caused by driving the articulated robot 200 on the print image quality.
[0068] Fig. 8 shows a schematic configuration of the end effector 300. Fig. 8 shows a schematic configuration of the end effector 300 as viewed from the +Y direction. The end effector 300 shown in Fig. 8 has the same configuration as the end effector 300 shown in Fig. 3 except for the vision camera 401.
[0069] The vision camera 401 detects ink dots generated by ink ejected onto the surface of an object. The vision camera 401 is supported by the fixed stage 321. The vision camera 401 may be supported by a member different from the end effector 300. The vision camera 401 is supported so as to be movable along the X-axis. The vision camera 401 detects the ink dots as ink actual landing positions AP. The vision camera 401 transmits the detection results to the control device 500. The vision camera 401 may perform data processing based on the detection results. When performing data processing, the vision camera 401 transmits the processing results of the data processing to the control device 500.
[0070] Before printing on the surface of an object based on print data, the robot system 100 prints lines along the X-axis as pre-printing. In pre-printing, the articulated robot 200 transports the end effector 300 in the +X direction or the -X direction along the X-axis. The articulated robot 200 transports the print head unit 310 in the +X direction or the -X direction by transporting the end effector 300. When the print head unit 310 is transported in the +X direction or the -X direction, the print head unit 310 ejects ink at a predetermined time interval. The vision camera 401 detects the printed ink dots.
[0071] Fig. 9 shows a block configuration of the robot system 100. Fig. 9 shows a block configuration of the robot system 100 of the first embodiment. Fig. 9 shows a block configuration of the articulated robot 200, the end effector 300, and the control device 500.
[0072] 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.
[0073] 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.
[0074] The robot memory unit 231 stores motion control data and the like 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 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).
[0075] 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.
[0076] 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.
[0077] 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.
[0078] 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.
[0079] The end effector 300 has a liquid ejection head 311, a 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 a print head unit 310 shown in Fig. 3. The stage driving mechanism 325 and the stage controller 350 are included in a stage unit 320 shown in Fig. 3 and other figures.
[0080] 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 on an ejection surface that faces the object. The liquid ejection head 311 ejects ink from the nozzles based on a nozzle control signal transmitted from the print controller 340.
[0081] 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. 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.
[0082] The stage driving mechanism 325 operates the moving stage 323. The stage driving mechanism 325 includes a plurality of ultrasonic motors 329. The stage driving mechanism 325 slides the moving stage 323 by the driving force of the ultrasonic motors 329. The stage driving mechanism 325 receives a stage driving signal from a stage controller 350. The stage driving mechanism 325 operates based on the stage driving signal.
[0083] The stage controller 350 is a controller circuit that controls the operation of the 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 landing position of the ink. 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 stage driving mechanism 325.
[0084] The control device 500 generates various control data. The control device 500 transmits the various control data to the articulated robot 200 and the end effector 300, thereby causing the articulated robot 200 and the end effector 300 to execute printing. The control device 500 includes a print control unit 510 and a storage unit 530.
[0085] The print control unit 510 is a controller circuit that controls printing 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 data processing unit 512, 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 data processing unit 512, 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 data processing unit 512, the print data correction unit 513, the operation control unit 515, and the movement data generation unit 517.
[0086] 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.
[0087] The data processing unit 512 generates pre-print data PD based on the detection results sent from the vision camera 401. The pre-print data PD is an example of head vibration data. The pre-print data PD indicates the deviation of the actual landing position AP from the controlled landing position CP for each timing of ink ejection when the robot system 100 performs pre-printing. The actual landing position AP corresponds to an example of a landing position. The pre-print data PD is data related to operational vibrations. The pre-print data PD corresponds to an example of landing data. The data processing unit 512 generates the pre-print data PD and sends it to the storage unit 530.
[0088] FIG. 10 shows an example of pre-print data PD. FIG. 10 shows the pre-print data PD in a graph. The vertical axis of FIG. 10 shows the deviation of the actual landing position AP from the reference position as a displacement. The reference position is a position on a line parallel to the printing virtual line VL shown in FIG. 5. In FIG. 10, a reference line parallel to the X-axis is used as the reference position. The horizontal axis of FIG. 10 shows the time when the print head unit 310 prints along the X-axis. The time on the horizontal axis corresponds to the formation position of the ink dots when the print head unit 310 prints a line along the X-axis. FIG. 10 shows the deviation of the actual landing position AP from the reference position as a displacement along the Y-axis.
[0089] 10, the ink landing position AP is displaced along the Y axis relative to the reference position due to the driving of the articulated robot 200. The displacement of the ink landing position AP causes the lines printed by the print head unit 310 to meander. The meandering of the lines reduces the print quality.
[0090] Although Fig. 10 shows a displacement along the Y axis, the data processing unit 512 may generate a displacement along the X axis as the pre-print data PD. When the end effector 300 is configured to move the moving stage 323 along the Y axis, the data processing unit 512 generates the pre-print data PD shown in Fig. 10. When the end effector 300 is configured to move the moving stage 323 along the X axis, the data processing unit 512 generates pre-print data PD based on the displacement along the X axis. When the end effector 300 has the configuration shown in Fig. 4, the pre-print data PD shown in Fig. 10 and pre-print data PD based on the displacement along the X axis are generated.
[0091] Fig. 11 shows a control flow for generating pre-print data PD. Fig. 11 shows a method for generating pre-print data PD performed by the robot system 100. The robot system 100 executes pre-printing before printing on the surface of an object based on print data. Pre-printing involves printing lines along the X-axis. Pre-printing is printing in which ink is ejected at predetermined time intervals to generate ink dots as the print head unit 310 moves along the X-axis.
[0092] In step S201, the control device 500 causes the print head unit 310 to execute pre-printing. The articulated robot 200 transports the end effector 300 in the +X direction or the -X direction along the X axis. The articulated robot 200 transports the print head unit 310 in the +X direction or the -X direction by transporting the end effector 300. As an example, the print head unit 310 ejects ink at predetermined time intervals when the print head unit 310 moves in the +X direction, and prints lines including ink dots.
[0093] After executing pre-printing, the control device 500 detects the print result in step S203. The control device 500 causes the vision camera 401 to detect the printed ink dots. The vision camera 401 detects the ink dots generated by the print head unit 310 when the end effector 300 is transported in the +X direction. The vision camera 401 detects the ink dots, thereby detecting the ink landing position AP. The vision camera 401 transmits the detection result of the ink dots to the data processing unit 512.
[0094] After detecting the print result, the control device 500 generates pre-print data PD in step S205. The data processing unit 512 generates the pre-print data PD based on the detection results of the vision camera 401. The data processing unit 512 calculates the ink actual landing positions AP from the detection results of each ink dot. The data processing unit 512 calculates the deviation between the actual landing positions AP and a reference position as a displacement. The data processing unit 512 generates pre-print data PD including the displacement of each actual landing position AP.
[0095] After generating the pre-print data PD, the control device 500 stores the pre-print data PD in the storage unit 530 in step S207. The data processing unit 512 transmits the pre-print data PD to the storage unit 530. The storage unit 530 receives and stores the pre-print data PD. The control device 500 stores the pre-print data PD in the storage unit 530 and ends the process.
[0096] The print data correction unit 513 shown in FIG. 9 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 may acquire shape data based on imaging data transmitted from an external camera connected to the control device 500. The external 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.
[0097] 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 end effector 300. 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 when the robot arm 220 transports the end effector 300 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.
[0098] The movement data generating unit 517 generates movement data related to the movement of the moving stage 323. The movement data generating unit 517 generates movement data for correcting the displacement caused by the operational vibration. The movement data generating unit 517 acquires the pre-print data PD stored in the storage unit 530. The movement data generating unit 517 may acquire the pre-print data PD from the data processing unit 512. The movement data generating unit 517 converts the pre-print data PD into an inverse phase to generate the movement data. The movement data is data for moving the moving stage 323 in a direction opposite to the displacement direction of the displacement caused by the operational vibration. When the pre-print data PD is the data shown in FIG. 10, the movement data is data for moving in a direction opposite to the displacement direction caused by the operational vibration along the Y axis. The stage driving mechanism 325 reduces the operational vibration caused by the movement of the articulated robot 200 by moving the moving stage 323 based on the movement data.
[0099] The movement data generation unit 517 acquires the arm trajectory data, the corrected print data, the shape data of the target object, etc. from the storage unit 530 etc. The movement data generation unit 517 corrects the movement data based on the arm trajectory data, the corrected print data, and the shape data. The movement data generation unit 517 transmits the movement data to the stage controller 350.
[0100] The storage unit 530 stores various data, programs, etc. The storage unit 530 stores pre-print data PD transmitted from the data processing unit 512. 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 corrected print data, movement 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. The storage unit 530 corresponds to an example of a storage unit.
[0101] Fig. 12 shows a control flow executed by the robot system 100. Fig. 12 shows, in a flowchart, a control flow for reducing operational vibrations using the moving stage 323. The control flow shown in Fig. 12 is performed by executing a control program. As an example, the control flow shown in Fig. 12 is executed by the robot system 100 equipped with the end effector 300 shown in Fig. 3.
[0102] In step S301, the control device 500 reads out the pre-print data PD. The movement data generation unit 517 of the control device 500 reads out the pre-print data PD from the storage unit 530. The movement data generation unit 517 may read out arm trajectory data, object shape data, and the like from the storage unit 530.
[0103] After reading out the pre-print data PD, the control device 500 generates movement data in step S303. The movement data generation unit 517 generates movement data based on the pre-print data PD. The movement data generation unit 517 generates movement data for operating the moving stage 323 with stage vibration that is in the opposite phase to the phase of the pre-print data PD. The movement data generation unit 517 transmits the movement data to the stage controller 350.
[0104] After generating the movement data, in step S305, the control device 500 transports the print head unit 310 along the X axis. The control device 500 drives the articulated robot 200 to transport the end effector 300 along the X axis. The control device 500 transports the print head unit 310 placed on the end effector 300 by transporting the end effector 300. The articulated robot 200 moves the print head unit 310 in the +X direction or -X direction along the X axis.
[0105] In step S307, the control device 500 moves the moving stage 323 based on the movement data while the print head unit 310 is being transported. The control device 500 acquires the movement direction and movement amount of the moving stage 323 for the position or time at which ink is ejected based on the movement data. The control device 500 moves the moving stage 323 in the acquired movement direction and movement amount. The control device 500 operates the moving stage 323 with stage vibration that is in the opposite phase to the operational vibration generated by the drive of the articulated robot 200.
[0106] After moving the moving stage 323, the control device 500 ejects ink in step S309. The control device 500 ejects ink onto the surface of the target object based on the print data. The print head unit 310 ejects ink toward the controlled landing position CP. By the moving stage 323 moving the print head unit 310, the deviation between the actual landing position AP and the controlled landing position CP is reduced.
[0107] After ejecting the ink, the control device 500 determines whether or not printing of the line has finished in step S311. The control device 500 determines whether or not ejection of ink along the X-axis has finished.
[0108] When the control device 500 determines that the ink ejection along the X-axis has ended, it ends printing the line along the X-axis (step S311; YES). The control device 500 drives the articulated robot 200 to move the end effector 300 in the +Y direction or -Y direction along the Y-axis. Alternatively, the control device 500 ends printing.
[0109] If the control device 500 determines that the ejection of ink along the X-axis has not ended, it returns to step S305 (step S311; NO). The control device 500 continues printing the line along the X-axis. The control device 500 moves the print head unit 310 in the +Y direction or the -Y direction. After moving the print head unit 310 in the +Y direction or the -Y direction, the control device 500 moves the print head unit 310 along the X-axis. The control device 500 causes the print head unit 310 to print the next line.
[0110] In the control flow, pre-print data PD relating to operational vibration is stored in advance, movement data relating to stage vibration is generated based on the pre-print data PD, and the moving stage 323 operates with the stage vibration based on the movement data. The robot system 100 can prepare movement data before printing is executed, and the load on the movement data generator 517 for generating movement data in real time is reduced.
[0111] The pre-print data PD is generated based on the actual landing positions AP of ink droplets ejected at predetermined time intervals detected when the print head unit 310 moves in the +X or -X direction. The pre-print data PD is data obtained by executing printing, and therefore has high measurement accuracy for operational vibrations.By using the pre-print data PD, the robot system 100 can further reduce operational vibrations.
[0112] The robot system 100 includes a storage unit 530 that stores pre-print data PD related to operational vibrations. The control device 500 generates movement data related to stage vibrations based on the pre-print data PD, and causes the moving stage 323 to operate with the stage vibrations based on the movement data. The robot system 100 can prepare movement data before printing is executed, and the load on the movement data generator 517 for generating movement data in real time is reduced.
[0113] In the first embodiment, the end effector 300 is equipped with a vision camera 401, but is not limited to this. As long as the operational vibration of the articulated robot 200 can be detected in advance, the configuration is not limited. The end effector 300 may be equipped with an acceleration sensor or the like instead of the vision camera 401. The robot system 100 uses the acceleration sensor or the like to acquire vibration data related to the operational vibration of the articulated robot 200 during pre-printing. The vibration data is an example of pre-print data PD.
[0114] Second embodiment The second embodiment shows a robot system 100 that acquires head vibration data such as pre-print data PD in advance and controls the operation of a moving stage 323 based on the head vibration data. In the second embodiment, a control device 500 performs frequency analysis on the head vibration data and corrects the movement data based on the analysis results. The control device 500 operates the moving stage 323 using the corrected movement data. The robot system 100 can suppress deterioration of print image quality caused by resonance of the articulated robot 200.
[0115] Fig. 13 shows a block configuration of a robot system 100. Fig. 13 shows a block configuration of a robot system 100 according to a second embodiment. Fig. 13 shows a block configuration of an articulated robot 200, an end effector 300, and a control device 500.
[0116] The block configuration of the robot system 100 shown in FIG. 13 is the same as the block configuration of the robot system 100 shown in FIG. 9, except that the storage unit 530 stores the resonance data RD.
[0117] The memory unit 530 stores the resonance data RD. The resonance data RD includes the resonance frequency of the articulated robot 200. The resonance frequency is measured in advance by a manufacturer or the like of the articulated robot 200. The manufacturer or the like stores the resonance data RD in the memory unit 530. The resonance data RD includes the value of the resonance frequency or the format of range data including the resonance frequency. The resonance data RD may be stored in the robot memory unit 231 in advance, and the resonance data RD may be transmitted to the memory unit 530. The memory unit 530 may store the resonance data RD measured by a user of the robot system 100.
[0118] The movement data generating unit 517 corrects the movement data using the resonance data RD. The movement data generating unit 517 acquires the pre-print data PD from the storage unit 530. The movement data generating unit 517 acquires, as an example, the pre-print data PD shown in FIG.
[0119] The movement data generation unit 517 performs time-frequency analysis such as a short-time Fourier transform on the pre-print data PD. The movement data generation unit 517 analyzes frequency information by performing a short-time Fourier transform on the pre-print data PD. The time-frequency analysis performed by the movement data generation unit 517 is not limited to the short-time Fourier transform. As long as the frequency information of the pre-print data PD can be analyzed by any method, the method is not limited. As an example, the movement data generation unit 517 may perform a wavelet transform or the like. The time-frequency analysis corresponds to an example of frequency analysis.
[0120] Fig. 14 shows an example of the analysis result of the time-frequency analysis. Fig. 14 shows Fourier transform data FD, which is the result of performing a short-time Fourier transform on the pre-print data PD shown in Fig. 10. The Fourier transform data FD is calculated by performing a short-time Fourier transform on the pre-print data PD. Fig. 14 shows the magnitude of displacement for each frequency. The Fourier transform data FD corresponds to an example of frequency data.
[0121] When calculating the Fourier transform data FD, the movement data generation unit 517 reads out the resonance data RD from the storage unit 530. The movement data generation unit 517 performs data processing on the Fourier transform data FD using the resonance data RD. The movement data generation unit 517 processes the resonance frequency included in the resonance data RD or the components of the region including the resonance frequency for the pre-print data PD.
[0122] Fig. 15 shows an example of the data processing result for the Fourier transform data FD. Fig. 15 shows a state in which components in a region including the resonance frequency are set to 0 for the Fourier transform data FD. Here, the resonance frequency included in the resonance data RD is, for example, a value between 30 Hz and 40 Hz. Fig. 15 shows the case in which components in a region between 30 Hz and 40 Hz including the resonance frequency are set to 0.
[0123] FIG. 15 shows a case where the components in the region including the resonance frequency are set to 0, but the present invention is not limited to this configuration. The movement data generating unit 517 may reduce the components in the region including the resonance frequency at a predetermined ratio. The movement data generating unit 517 may reduce the components in the region including the resonance frequency to a predetermined value. The movement data generating unit 517 removes or reduces the components in the region including the resonance frequency. The movement data generating unit 517 removes or reduces the components of the resonance frequency of the articulated robot 200 from the pre-print data PD by removing or reducing the components in the region including the resonance frequency. The movement data generating unit 517 may change the range of the region including the resonance frequency as appropriate. The movement data generating unit 517 performs data processing on the Fourier transform data FD to generate modified Fourier transform data. The movement data generating unit 517 performs an inverse short-time Fourier transform on the modified Fourier transform data.
[0124] Fig. 16 shows the result of performing an inverse short-time Fourier transform on the modified Fourier transform data. Fig. 16 shows modified preprint data CD which is the result of performing an inverse short-time Fourier transform on the modified Fourier transform data shown in Fig. 15. The movement data generator 517 generates the modified preprint data CD shown in Fig. 16 by removing components in the region including the resonant frequency from the preprint data PD shown in Fig. 10.
[0125] Fig. 17 shows a portion of the preprint data PD and a portion of the modified preprint data CD. Fig. 17 shows a portion of the preprint data PD and a portion of the modified preprint data CD overlapping each other. Fig. 17 shows the modified preprint data CD for the enlarged area EA shown in Fig. 16, and the preprint data PD for an area corresponding to the enlarged area EA. As shown in Fig. 17, the modified preprint data CD differs from the preprint data PD. The modified preprint data CD is data from which components of the area including the resonant frequency of the articulated robot 200, which are included in the preprint data PD, have been removed. The modified preprint data CD corresponds to an example of landing data.
[0126] The movement data generating unit 517 converts the modified pre-print data CD into an inverse phase to generate modified movement data. The modified movement data is data for moving the moving stage 323 in a direction opposite to the displacement direction of the displacement caused by the operational vibration. The modified movement data is data related to the stage vibration. By generating the modified movement data based on the modified pre-print data CD, components in a region including the resonance frequency of the articulated robot 200 are removed from the modified movement data. When the moving stage 323 operates with a stage vibration based on the modified movement data, the movement of the moving stage 323 with vibrations in a region including the resonance frequency of the articulated robot 200 is reduced. An increase in the operational vibration of the articulated robot 200 caused by the articulated robot 200 resonating with the stage vibration of the moving stage 323 is suppressed. The modified movement data corresponds to an example of correction data from which the resonance frequency of the articulated robot 200 has been removed.
[0127] Fig. 18 shows a control flow for generating the modified pre-print data CD. Fig. 18 shows a method for generating the modified pre-print data CD performed by the robot system 100. The robot system 100 performs pre-printing before printing on the surface of an object based on the print data. Pre-printing is printing in which ink is ejected at predetermined time intervals to generate ink dots as the print head unit 310 moves along the X-axis.
[0128] In step S401, the control device 500 causes the print head unit 310 to execute pre-printing. The articulated robot 200 transports the end effector 300 in the +X direction or the -X direction along the X axis. The articulated robot 200 transports the print head unit 310 in the +X direction or the -X direction by transporting the end effector 300. As an example, the print head unit 310 ejects ink at predetermined time intervals when the print head unit 310 moves in the +X direction, and prints lines including ink dots.
[0129] After executing pre-printing, the control device 500 detects the print result in step S403. The control device 500 causes the vision camera 401 to detect the printed ink dots. The vision camera 401 detects the ink dots generated by the print head unit 310 when the end effector 300 is transported in the +X direction. The vision camera 401 detects the ink dots, thereby detecting the ink landing position AP. The vision camera 401 transmits the detection result of the ink dots to the data processing unit 512.
[0130] After detecting the printing result, the control device 500 generates pre-print data PD in step S405. The data processing unit 512 generates the pre-print data PD based on the detection result of the vision camera 401. The data processing unit 512 calculates the ink actual landing position AP from the detection result of each ink dot. The data processing unit 512 calculates the deviation between the actual landing position AP and a reference position as a displacement. The data processing unit 512 detects the displacement of each actual landing position AP. The data processing unit 512 generates pre-print data PD including the displacement of each actual landing position AP. The data processing unit 512 transmits the pre-print data PD to the storage unit 530. The storage unit 530 stores the pre-print data PD.
[0131] After generating the pre-print data PD, the control device 500 calculates Fourier transform data FD in step S407. The movement data generation unit 517 reads out the pre-print data PD from the storage unit 530. The movement data generation unit 517 performs a short-time Fourier transform on the pre-print data PD to calculate the Fourier transform data FD.
[0132] After calculating the Fourier transform data FD, the control device 500 generates modified preprint data CD in step S409. The movement data generation unit 517 reads out the resonance data RD from the storage unit 530. The movement data generation unit 517 generates modified Fourier transform data by removing components in a region including the resonance frequency of the articulated robot 200 from the Fourier transform data FD. The movement data generation unit 517 performs an inverse short-time Fourier transform on the modified Fourier transform data to generate modified preprint data CD.
[0133] The modified preprint data CD is generated by, but is not limited to, the movement data generation unit 517. The modified preprint data CD may be generated by the data processing unit 512. The data processing unit 512 acquires the preprint data PD and the resonance data RD. The data processing unit 512 generates the modified preprint data CD using the preprint data PD and the resonance data RD. The data processing unit 512 stores the modified preprint data CD in the storage unit 530. The movement data generation unit 517 acquires the modified preprint data CD from the storage unit 530 and generates modified movement data.
[0134] The control flow performs a time-frequency analysis on the pre-print data PD to generate Fourier transform data FD, and generates movement data based on corrected pre-print data CD obtained by removing the resonance frequency of the articulated robot 200 from the Fourier transform data FD. It is possible to prevent the articulated robot 200 from resonating due to the movement of the moving stage 323, and to prevent the deterioration of print image quality.
[0135] The control device 500 performs time-frequency analysis on the pre-print data PD to generate Fourier transform data FD, and generates movement data based on corrected pre-print data CD obtained by removing the resonance frequency of the articulated robot 200 from the Fourier transform data FD. The robot system 100 can suppress resonance of the articulated robot 200 caused by the movement of the moving stage 323.
[0136] Third embodiment The third embodiment shows a robot system 100 that detects operational vibrations of the articulated robot 200 when the print head unit 310 prints, and corrects the operational vibrations. In the third embodiment, a control device 500 corrects the operational vibrations of the articulated robot 200 in real time while the print head unit 310 is printing. The control device 500 operates the moving stage 323 using the measurement results of the distance sensor 403. The robot system 100 can suppress degradation of print image quality caused by operational vibrations of the articulated robot 200.
[0137] Fig. 19 shows a block configuration of a robot system 100. Fig. 19 shows a block configuration of a robot system 100 according to a third embodiment. Fig. 19 shows block configurations of an articulated robot 200, an end effector 300, and a control device 500.
[0138] The end effector 300 shown in FIG. 19 does not have a vision camera 401. The print control unit 510 of the control device 500 shown in FIG. 19 does not have a data processing unit 512. The robot system 100 shown in FIG. 19 is equipped with a distance sensor 403. The robot system 100 shown in FIG. 19 has the same configuration as the robot system 100 shown in FIG. 9 except for the vision camera 401, the data processing unit 512, and the distance sensor 403. The stage controller 350 of the end effector 300 shown in FIG. 19 may have a band stop filter 355.
[0139] The distance sensor 403 detects vibrations of the print head unit 310. The distance sensor 403 is provided on a housing or the like that covers the robot system 100. The distance sensor 403 measures the distance to the print head unit 310 when the articulated robot 200 transports the end effector 300 in the +X direction or -X direction along the X axis. The distance sensor 403 measures the distance to the print head unit 310 when the print head unit 310 is printing. The distance sensor 403 detects vibrations of the print head unit 310 by measuring the distance to the print head unit 310. The print head unit 310 vibrates when the articulated robot 200 is driven.
[0140] The distance sensor 403 detects vibrations of the print head unit 310 along the Y axis by measuring the distance to the print head unit 310 along the Y axis. The distance sensor 403 may detect vibrations of the print head unit 310 along the X axis by measuring the distance to the print head unit 310 along the X axis. The vibrations of the print head unit 310 are caused by operational vibrations of the articulated robot 200.
[0141] The robot system 100 may be equipped with two distance sensors 403. When the robot system 100 is equipped with the end effector 300 shown in FIG. 4, the robot system 100 is equipped with two distance sensors 403. One distance sensor 403 detects vibration of the print head unit 310 along the Y axis by measuring the distance to the print head unit 310 along the Y axis. The other distance sensor 403 detects vibration of the print head unit 310 along the X axis by measuring the distance to the print head unit 310 along the X axis.
[0142] 19 includes a distance sensor 403, but is not limited to this. As long as the vibration of the print head unit 310 can be detected, the configuration of the sensor is not limited. The robot system 100 may include a displacement meter such as a laser displacement meter instead of the distance sensor 403. The robot system 100 may include an acceleration sensor, an inertial measurement unit, etc. instead of the distance sensor 403. The acceleration sensor, the inertial measurement unit, etc. are provided in the end effector 300.
[0143] The distance sensor 403 measures the distance to the print head unit 310 during printing. Based on the measured distance, the distance sensor 403 detects the displacement caused by the operational vibration of the print head unit 310 as vibration data. The distance sensor 403 transmits the vibration data to the control device 500.
[0144] The movement data generating unit 517 of the control device 500 receives the vibration data. The movement data generating unit 517 generates movement data that is in the opposite phase to the vibration data. The movement data generating unit 517 transmits the movement data to the stage controller 350.
[0145] The stage controller 350 receives the movement data, and generates a stage driving signal based on the movement data. The stage driving signal is a signal related to stage vibration. The stage controller 350 transmits the stage driving signal to the stage driving mechanism 325. The stage driving mechanism 325 moves the moving stage 323 based on the stage driving signal. The moving stage 323 operates with a stage vibration in the opposite phase to the operational vibration of the articulated robot 200. When the robot system 100 includes the end effector 300 shown in FIG. 4, the stage controller 350 transmits a stage driving signal to the second stage driving mechanism. The second stage driving mechanism moves the second moving stage 361 based on the stage driving signal. The second moving stage 361 operates with a stage vibration in the opposite phase to the operational vibration of the articulated robot 200.
[0146] The stage controller 350 may have a band-stop filter 355. The band-stop filter 355 attenuates components in a predetermined frequency range from the input data. The band-stop filter 355 receives movement data or a stage drive signal as input data. The band-stop filter 355 attenuates components in a predetermined frequency range included in the movement data or the stage drive signal. A range including the resonance frequency of the articulated robot 200 is set as the predetermined frequency range in the band-stop filter 355. As an example, a frequency range from 30 Hz to 40 Hz is set as the predetermined frequency range in the band-stop filter 355.
[0147] The band-stop filter 355 attenuates the resonance frequency of the articulated robot 200 from the movement data or the stage drive signal to generate a corrected stage drive signal. The corrected stage drive signal is a signal related to stage vibration. The stage controller 350 operates the moving stage 323 based on the corrected stage drive signal. The band-stop filter 355 attenuates the resonance frequency of the articulated robot 200, thereby suppressing deterioration in print image quality caused by the articulated robot 200 resonating with the movement of the moving stage 323. The corrected stage drive signal corresponds to an example of a corrected drive signal. The band-stop filter 355 corresponds to an example of a band filter.
[0148] Fig. 20 shows a control flow executed by the robot system 100. Fig. 20 shows, in a flowchart, a control flow for reducing operational vibrations using the moving stage 323. The control flow shown in Fig. 20 is performed by executing a control program. As an example, the control flow shown in Fig. 20 is executed by the robot system 100 equipped with the end effector 300 shown in Fig. 3.
[0149] In step S501, the control device 500 transports the print head unit 310 along the X axis. The control device 500 drives the articulated robot 200 to transport the end effector 300 along the X axis. The control device 500 transports the print head unit 310 placed on the end effector 300 by transporting the end effector 300. The articulated robot 200 moves the print head unit 310 in the +X direction or -X direction along the X axis.
[0150] In step S503, the control device 500 detects vibration data when the print head unit 310 is transported along the X-axis. The distance sensor 403 measures the distance to the print head unit 310. The distance sensor 403 detects the displacement of the print head unit 310 along the Y-axis at each time by measuring the distance to the print head unit 310. The distance sensor 403 detects a set of displacements at each time as vibration data. The distance sensor 403 transmits the vibration data to the control device 500.
[0151] After detecting the vibration data, the control device 500 generates movement data in step S505. The movement data generation unit 517 of the control device 500 generates movement data based on the vibration data. The movement data generation unit 517 generates movement data in the opposite phase to the vibration data. The movement data causes the moving stage 323 to operate with a stage vibration in the opposite phase to the operational vibration. The movement data generation unit 517 transmits the movement data to the stage controller 350.
[0152] In step S507, the control device 500 moves the moving stage 323 based on the movement data while the print head unit 310 is being transported. The stage controller 350 acquires the movement direction and movement amount of the moving stage 323 for each position or time at which ink is ejected based on the vibration data. The stage controller 350 moves the moving stage 323 in the acquired movement direction and movement amount. The stage controller 350 operates the moving stage 323 with stage vibration that is in the opposite phase to the operational vibration generated by the drive of the articulated robot 200.
[0153] When the stage controller 350 has the band-stop filter 355, it operates the moving stage 323 based on the corrected stage drive signal generated by the band-stop filter 355. The band-stop filter 355 receives the movement data or the stage drive signal and generates a corrected stage drive signal. The band-stop filter 355 attenuates components in a range including the resonance frequency of the articulated robot 200.
[0154] After moving the moving stage 323, the control device 500 ejects ink in step S509. The control device 500 ejects ink onto the surface of the target object based on the print data. The print head unit 310 ejects ink toward the controlled landing position CP. By the moving stage 323 moving the print head unit 310, the deviation between the actual landing position AP and the controlled landing position CP is reduced.
[0155] After ejecting the ink, the control device 500 determines whether or not printing of the line has finished in step S511. The control device 500 determines whether or not ejection of ink along the X-axis has finished.
[0156] When the control device 500 determines that the ink ejection along the X-axis has ended, it ends printing the line along the X-axis (step S511; YES). The control device 500 drives the articulated robot 200 to move the end effector 300 in the +Y direction or -Y direction along the Y-axis. Alternatively, the control device 500 ends printing.
[0157] If the control device 500 determines that the ejection of ink along the X-axis has not ended, it returns to step S505 (step S511; NO). The control device 500 continues printing the line along the X-axis. The control device 500 moves the print head unit 310 in the +Y direction or the -Y direction. After moving the print head unit 310 in the +Y direction or the -Y direction, the control device 500 moves the print head unit 310 along the X-axis. The control device 500 causes the print head unit 310 to print the next line.
[0158] In the control flow, operational vibrations caused when the print head unit 310 ejects ink are detected, and the moving stage 323 operates with stage vibrations that are in the opposite phase to the detected operational vibrations. The robot system 100 can reduce vibrations caused by driving the articulated robot 200 in real time.
[0159] Based on the detected operational vibration, a corrected stage drive signal related to the stage vibration is generated, and the moving stage 323 operates with the stage vibration based on the corrected stage drive signal via a band-stop filter 355 that attenuates the resonant frequency of the articulated robot 200. The robot system 100 suppresses deterioration of print image quality caused by resonance of the articulated robot 200 resulting from the movement of the moving stage 323.
[0160] The print head unit 310 of the end effector 300 ejects ink onto the surface of an object to perform printing, but may eject liquid other than ink. The print head unit 310 may eject liquid such as adhesive instead of ink. By ejecting liquid such as adhesive, the print head unit 310 causes the robot system 100 to function as an adhesive applicator or the like.
[0161] The end effector 300 may be equipped with a functional unit such as a laser processing unit or a welding unit instead of the print head unit 310. By mounting a functional unit on the end effector 300, the robot system 100 functions as a processing device or the like. [Explanation of symbols]
[0162] 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, 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, 310... print head unit, 311... liquid ejection head, 313... ink tank, 320... stage unit, 321... fixed stage, 323... moving Moving stage, 325...stage drive mechanism, 327...support section, 329...ultrasonic motor, 331...carriage, 333...rail, 335...screw, 340...print controller, 350...stage controller, 355...band stop filter, 361...second moving stage, 363...second carriage, 401...vision camera, 403...distance sensor, 500...control device, 510...print control unit, 511...print data generation section, 512...data processing section, 513...print data correction section, 515...operation control section, 517...movement data generation section, 530...storage section, AP...actually landed bullet position, AP k …kth actual landing position, CD…corrected pre-print data, CP…controlled landing position, CP k ...kth control impact position, EA...enlarged area, FD...Fourier transform data, J1...first joint, J1E...first joint encoder, J1M...first joint motor, J2...second joint, J2E...second joint encoder, J2M...second joint motor, J3...third joint, J3E...third joint encoder, J3M...third joint motor, J4...fourth joint, J4E...fourth joint encoder, J4M...fourth joint motor, J5...fifth joint, J5E...fifth joint encoder, J5M...fifth joint motor, J6...sixth joint, J6E...sixth joint encoder, J6M...sixth joint motor, PD...pre-print data, RD...resonance data, VL...printing virtual line.
Claims
1. A printing method using a robot, a stage supported by the robot, and a print head supported by the stage, comprising: When the print head is ejecting ink, the stage operates with a compensation vibration in an opposite phase to a drive vibration generated by the drive of the robot, The compensation vibration is such that the resonant frequency of the robot is eliminated. Printing method.
2. storing impact data relating to the driving vibration in advance; generating correction data for the correction vibration based on the impact data; Based on the correction data, the stage moves with the corrective vibration. The printing method according to claim 1 .
3. the landing data is generated based on the landing positions of the ink ejected at predetermined time intervals detected when the print head moves in a predetermined direction; The printing method according to claim 2 .
4. Vibration data relating to the driving vibration is stored in advance; performing a frequency analysis on the vibration data to generate frequency data; The corrected vibration is obtained by removing a resonant frequency of the robot from the frequency data. The printing method according to claim 3.
5. generating a correction drive signal related to the correction vibration based on the drive vibration detected in advance; The stage operates with the corrective vibration based on the corrective drive signal that has been passed through a band filter that attenuates a resonant frequency of the robot. The printing method according to claim 1 .
6. A print head that ejects ink; A stage for supporting the print head; a robot that supports the stage and transports the print head supported by the stage; a control unit that controls the print head, the stage, and the robot, The control unit causing the robot to eject the ink while transporting the print head in a predetermined direction; when the print head ejects the ink, the stage operates with a compensation vibration in an opposite phase to a drive vibration generated by the drive of the robot; The compensation vibration is such that the resonant frequency of the robot is eliminated. Printing device.
7. a storage unit for storing impact data relating to the driving vibration; The control unit generating correction data for the correction vibration based on the impact data; operating the stage with the corrected vibration based on the correction data; The printing device according to claim 6.
8. The control unit Vibration data relating to the driving vibration is stored in advance; performing a frequency analysis on the vibration data to generate frequency data; The corrected vibration is obtained by removing a resonant frequency of the robot from the frequency data. The printing device according to claim 6.
Citation Information
Patent Citations
System for printing on object
JP2013202781A
