Robotic 3D printer and robot control device
The robot control device with input-side and output-side encoders and a correction unit addresses the precision and strength issues in 3D printers by accurately measuring and correcting the robot's motion trajectory, resulting in high-precision and strong 3D printed objects.
Patent Information
- Application Number
- JP2022566892
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2020-12-02
- Filing Date
- 2021-11-26
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2041-11-26
AI Technical Summary
3D printers using industrial robots face challenges in maintaining precision due to backlash and deformation in the robot's internal mechanism, leading to inaccuracies in the motion trajectory and reduced strength and rigidity of the modeled objects.
A robot control device that incorporates both input-side and output-side encoders to accurately measure the robot's motion trajectory, coupled with a control command correction unit to adjust for deviations caused by backlash and reaction forces, ensuring precise filament application.
Enhances the precision and strength of 3D printed objects by accurately correcting the robot's motion trajectory, allowing for complex and strong object formation with high accuracy.
Smart Images

Figure 0007590457000001 
Figure 0007590457000002 
Figure 0007590457000003
Abstract
Description
[Technical field]
[0001] The present invention relates to a 3D printer using a robot and a control device for the robot. [Background technology]
[0002] Additive manufacturing devices (so-called 3D printers), which form (print) three-dimensional objects by layering materials such as resin and metal, can easily form even complex shapes compared to injection molding, etc. A typical example of a 3D printer is a gate-type processing machine, but 3D printers that use industrial robots are also well known (see, for example, Patent Documents 1 and 2).
[0003] On the other hand, since the internal mechanism of a robot's reducer can bend or deform due to insufficient rigidity, etc., robots are known that are equipped with an output encoder that detects the rotation angle of the output shaft of the reducer in addition to an input encoder that detects the rotation angle of the motor's rotating shaft (see, for example, Patent Documents 3 and 4). [Prior art documents] [Patent documents]
[0004] [Patent Document 1] Special Publication No. 2019-537521 [Patent Document 2] JP 2019-098682 A [Patent Document 3] JP 2016-027951 A [Patent Document 4] JP 2020-121355 A Summary of the Invention [Problem to be solved by the invention]
[0005] In 3D printers using gate-type processing machines, the lamination direction of resin, etc. is limited, so the strength and rigidity of the model may be insufficient. On the other hand, in 3D printers using robots, the lamination direction can be changed freely, so the strength and rigidity of the model can be increased, but the accuracy of the robot's motion trajectory may deteriorate due to backlash in the reduction mechanism and the influence of the reaction force that the robot receives when molten resin is discharged from the nozzle at the end of the robot arm. As a means to prevent this deterioration in accuracy, simply providing an input side encoder to the motor that drives each axis of the robot makes it difficult to properly measure or estimate the influence of backlash, etc. in the reduction gear. [Means for solving the problem]
[0006] One aspect of the present disclosure is a robot control device that controls a multi-joint robot equipped with a nozzle that ejects material for an object to be modeled, the robot control device having: a control command storage unit that stores control commands including a planned printing path to be followed by the nozzle as it moves while applying the material to the object to be modeled; a deviation estimation unit that determines a printed path, which is the actual movement trajectory of the nozzle, based on angle information for each of the input and output sides of the joints of the multi-joint robot that operate based on the control commands, and estimates a deviation between the printed path and the planned printing path; and a control command correction unit that corrects the control command to reduce or eliminate the estimated deviation.
[0007] Another aspect of the present disclosure is a 3D printer including an articulated robot equipped with a nozzle that applies and layers material for an object to be molded, and a robot control device according to the above aspect that controls the articulated robot. Effect of the Invention
[0008] According to the present disclosure, in a 3D printer using a robot, an angle information acquisition unit is provided not only on the input axis side of the robot but also on the output axis side, and the robot movement trajectory is corrected to take into account the influence of the application reaction force, thereby making it possible to mold the object to be molded with extremely high precision. [Brief description of the drawings]
[0009] [Figure 1] FIG. 1 is a schematic diagram of a robot and a target object used in a 3D printer according to an embodiment. [Diagram 2] FIG. 2 is a schematic diagram of a nozzle unit attached to the robot of FIG. 1. [Diagram 3] FIG. 1 is a schematic diagram of a portal 3D printer and a modeling target object according to a comparative example. [Figure 4] FIG. 2 is a diagram showing a schematic view of a main part of the robot shown in FIG. [Diagram 5] FIG. 1 is a functional block diagram of a robot control device according to a first embodiment. [Figure 6] 1 is a schematic diagram showing a state in which a resin filament is applied to an object to be molded. FIG. [Figure 7] FIG. 7 is a schematic diagram showing a comparative example in which a resin filament is further applied to the state shown in FIG. 6. [Figure 8] FIG. 13 is a diagram showing an example of print density. [Figure 9] 13A and 13B are diagrams illustrating other examples of print density. [Figure 10] FIG. 13 is a diagram showing yet another example of print density. [Figure 11] FIG. 11 is a functional block diagram of a robot control device according to a second embodiment. [Figure 12] FIG. 7 is a schematic diagram showing a state in which a resin filament is further applied to the state shown in FIG. 6 in the second embodiment. [Figure 13] 11A and 11B are diagrams illustrating an example of a process for gradually correcting a trajectory of a robot. [Figure 14] FIG. 2 is a schematic diagram showing a comparative example in which resin filaments are applied to an uneven coating surface. [Figure 15] FIG. 2 is a schematic diagram of a main part of the robot of FIG. 1, to which a force sensor has been added. [Figure 16] FIG. 11 is a functional block diagram of a robot control device according to a third embodiment. [Figure 17]1 is a graph showing an example of a relationship between a coating direction and a coating reaction force. [Figure 18] FIG. 11 is a schematic diagram showing a state in which resin filaments are applied to a coating surface having projections and recesses in the third embodiment. [Figure 19] FIG. 11 is a schematic diagram showing the state in which resin filaments are laminated on a coating surface in the third embodiment. [Figure 20] FIG. 13 is a functional block diagram of a robot control device according to a fourth embodiment. [Figure 21] FIG. 13 is a schematic diagram showing the state in which resin filaments are laminated on a coating surface in the fourth embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0010] 1 is a schematic diagram of a robot 10 used as a 3D printer according to a preferred embodiment, and a modeling target object 12 modeled by the 3D printer. The robot 10 is, for example, a 6-axis industrial vertical articulated robot, and has a base 14 installed on a floor surface or the like, a rotating body 16 rotatably connected to the base 14 around an axis in a substantially vertical direction, an upper arm 18 rotatably connected to the rotating body 16, a forearm 20 rotatably connected to the upper arm 18, a wrist 22 rotatably connected to the forearm 20, and an end effector 24 rotatably connected to the wrist 22. In this embodiment, the end effector 24 is a nozzle unit that ejects a resin filament, which is a material constituting the modeling target object 12, and applies it to the target object 12.
[0011] 2 shows a schematic configuration of the nozzle unit 24. The nozzle unit 24 includes a nozzle 27 for applying a filament 26, which is a molten thread-like resin material, to the object 12 to be molded, a heater (not shown) for melting the filament 26, and a roller 28 for feeding the filament 26, which may be similar to known devices. The temperature of the heater and the rotation amount of the roller 28 can be controlled using at least a control command from a robot control device described later. In addition, data showing the correlation between the heater temperature and the rotation amount of the roller, and the feed amount of the filament can be acquired and stored in advance, and the feed amount of the filament can be controlled based on this data.
[0012] 3 is a schematic diagram of a portal-type 3D printer 11 according to a comparative example, and a modeling target 13 modeled by the portal-type 3D printer 11, where the shape of the modeling target 13 is the same as the shape of the modeling target 12. As shown in the figure, in the portal-type 3D printer 11, the application direction of the resin filament is limited to a substantially horizontal direction over the entire modeling target 13, and the filament is layered in a substantially vertical direction. If the application direction and layering direction are uniform in this way, the strength of the model against a force in a specific direction is weaker than in other directions, and there is a problem that the model is more likely to break at a portion where stress is likely to concentrate, such as the leg portion 15.
[0013] In contrast, in a robot 3D printer using an articulated robot 10, the position and posture of the nozzle 27 can be changed and determined arbitrarily within the movable range of the robot 10, and the filament can be applied so as to draw an arbitrary trajectory. Generally, the strength of the object to be printed varies depending on the direction in which the filament is applied, but in this embodiment, the filament can be applied so as to draw an arbitrary trajectory, so that 3D printing that prioritizes the strength of the object to be printed becomes possible. For example, as shown in FIG. 1, the resin layering direction can be changed for each part of the object to be printed 12, and a product that is stronger than the object to be printed 13 as a whole can be printed and manufactured. In particular, when the filament has anisotropy by mixing fibers into the resin filament, the trajectory can be determined so that the anisotropy can be effectively utilized, and the object to be printed can be made stronger.
[0014] In this way, a 3D printer using the robot 10 can form a high-strength model, but it is also required to apply the resin filament with at least the same level of accuracy as a portal-type 3D printer. Specific means for achieving this are described below.
[0015] 4 shows a schematic diagram of the main parts of the robot 10 around each axis, together with a robot control device 30 that controls the robot 10. The robot 10 includes an angle information acquisition unit that acquires angle information of each of the input and output shafts of the joints of the robot 10 that are operated based on a control command, and specifically includes an input-side encoder 36 that detects the rotation angle of the input shaft 34 driven by the motor 32, and an output-side encoder 42 that detects the rotation angle of the output shaft 40 connected to the input shaft 34 via a reducer 38 or the like. The output-side encoder 42 in the illustrated example includes a disk- or ring-shaped scale member 44 that rotates integrally with the output shaft 40, and a sensor 46 that optically reads an angle detection pattern provided on the scale member 44, and the input-side encoder 36 can be configured in a similar manner.
[0016] By providing both the input-side encoder 36 and the output-side encoder 42 on one rotating shaft, even if there is a backlash in the internal mechanism of the reducer 38 or bending or deformation occurs due to insufficient rigidity, the positioning accuracy and trajectory accuracy of each joint shaft of the robot 10 can be improved by using both the rotation angles detected by the input-side encoder 36 and the output-side encoder 42. Note that the configuration of such input-side encoder 36 and output-side encoder 42 may be the same as that described in Patent Document 4, for example, and therefore a detailed description will be omitted. Note that, as a means for acquiring angle information of the output shaft 40, in addition to the output-side encoder 42, a camera (not shown) may be provided on the robot arm, and an image processing device (not shown) that processes images from the camera may be used.
[0017] (First embodiment) 5 is a functional block diagram of a first embodiment of the robot control device 30. The control device 30 has a calculation unit 50 having, for example, a CPU, RAM, etc., a display device 52 such as a liquid crystal display, and a storage device 54 having non-volatile storage, ROM, etc., and the calculation unit 50 may be included in the storage device 54. In addition, a portable operation panel 56 that can be carried by an operator is connected to the control device 30 so as to be communicable via wire or wirelessly, and input contents, etc., by the operator to the operation panel 56 are transmitted and input to the control device 30.
[0018] The control device 30 is connected to the motors 32 and nozzle unit 24 of each axis of the articulated robot 10, and controls them using a control unit 57 such as a CPU. The input side encoder 36 and the output side encoder 42 provided on each axis are capable of detecting angle information of the input axis 34 and the output axis 40, respectively, and transmit the detected angle information to the control device 30. The nozzle unit 24 is capable of detecting the feed amount of the filament, and is capable of transmitting the detected feed amount to the control device 30, as well as receiving a command related to the feed amount from the control device 30.
[0019] As shown in FIG. 2, when the robot 10 is used as a 3D printer, the nozzle 27 discharges and applies the viscous molten filament 26 while maintaining a state in close proximity to the application surface 60, so that the nozzle 27 receives a coating reaction force. More specifically, the nozzle 27 is subjected to a reaction force 58 along the axial direction of the nozzle 27 and a reaction force 62 along the application surface 60 of the application target 12. Due to these reaction forces and the influence of friction and backlash inside the mechanism parts such as the reducer of the robot 10, a deviation may occur between the control command and the actual robot trajectory. Therefore, in the feedback using only the input side encoder 36, there is a relatively high possibility that a coating deviation may occur due to the deviation of the actual robot trajectory from the control command, such as the filament 26b for the filament 26a shown in FIG. 6. Furthermore, since it is difficult for the input side encoder 36 alone to provide appropriate feedback after a coating deviation such as that of the filament 26b occurs, if an attempt is made to coat further filament from the state shown in FIG. 6, an appropriate coating reaction force will not be obtained, for example, the nozzle 27 will come into contact with the filament 26b. As a result, as shown in the example of the filament 26c in FIG. 7, the filament may deform or float up from the coating surface 60, which may lead to a so-called coating defect.
[0020] Therefore, as shown in FIG. 5, the calculation unit 50 has a control command storage unit 66 that stores control commands to the motors 32 of each axis of the robot 10 that have been specified or created in advance, a deviation estimation unit 68 that receives the detection results of both the input side encoder 36 and the output side encoder 42 and estimates the deviation between the control command and the actual trajectory of the robot 10, and a control command correction unit 70 that corrects the control command using the estimation result of the deviation estimation unit 68.
[0021] The basic operation of the robot 3D printer configured in this manner will be described. The storage device 54 of the control device 30 stores the 3D shape data of the object 12, a print path generation algorithm required to mold the object 12 using a 3D printer in accordance with the 3D shape data, a planned print path, a printed path, a path correction algorithm, and a planned print correction path. Each term will be explained below.
[0022] The 3D shape data is data that represents the shape of the object to be finally formed by the 3D printer, and includes information on the strength required for (each part of) the object to be formed, the printing direction (the direction of movement of the nozzle when discharging the filament to the object to be formed), and information on the density of the print. As a specific example of the density, as shown in Figures 8-10, one of hollow parts 72a-72c with different cross-sectional areas is formed inside the object to be formed 12, which is approximately cylindrical, to set the effective density of the object 12 to a desired value. In the illustrated example, the cross-sectional shapes of the hollow parts are all hexagonal, but this is not limited to this and can be any shape. Such density of the print can be realized with a conventional gate-type 3D printer, but when a robot is used, the filament can be stacked in any direction, so that a hollow part with a more complex and suitable shape can be formed.
[0023] The planned print path is a path to be followed when the nozzle 27 moves while applying the resin filament to the object 12 to be printed, and is generated by reading 3D shape data of the object 12 into a path generation algorithm. The robot 10 starts and executes an operation based on the planned print path included in the control command. The path generation algorithm includes an algorithm for analyzing mechanical interference of the articulated robot, and generates a path as a trajectory along which the robot can operate. However, the planned print path does not have to completely depend on a mechanical path generation algorithm, and may be finely adjusted by, for example, an operator's operation. In this embodiment, path corrections are accumulated for each print to improve accuracy, and one print is also called a print job.
[0024] The printed path is the actual movement trajectory of the nozzle 27 reproduced based on the detection results of the input side encoder 36 and the output side encoder 42, the filament feed amount, and feedback from the force sensor described later, and can also be considered a print history for each print job.
[0025] The corrected planned print path is a path that is corrected by smoothly connecting the executed planned print path and the corresponding printed path during printing and applying a three-dimensional deformation to the remaining (unexecuted) planned print path, so that the final shape of the object to be printed coincides with the shape represented by the 3D shape data, using at least the above-mentioned 3D shape data, the executed planned print path, and the corresponding printed path. The planned print path, the printed path, and the corrected planned print path can be confirmed in a visually easy-to-understand state from an external user interface using the display device 52, the operation panel 56, etc.
[0026] The path correction algorithm is an algorithm for generating a corrected planned print path. The degree to which the original planned print path is reproduced faithfully, the timing to reflect the correction, and the timing to update can be separately specified.
[0027] Next, a specific example of the process in the control device 30 in Fig. 5 according to the first embodiment will be described. First, a control command based on the planned printing path described above is stored in the control command storage unit 66 of the calculation unit 50. When starting printing of the object 12, the control command is sent to the motors 32 of the axes of the robot 10 and the nozzle unit 24 so that the nozzle 27 ejects the resin filament 26 while moving along the planned printing path of the object 12. In accordance with the sent control command, the robot 10 applies the resin filament 26a to the object 12, for example, as shown in Fig. 6.
[0028] Here, the calculation unit 50 generates a printed path based on the detection results of the input side encoder 36 and the output side encoder 42. Next, the deviation estimation unit 68 calculates and estimates the deviation between the control command and the actual robot movement trajectory based on the difference between the planned printing path and the printed path. Then, the control command correction unit 70 corrects the control command to reduce or eliminate the estimated deviation. For example, in the example of FIG. 6, a printed path is created each time a linear filament is applied or each time a segment of a filament divided by a pre-specified length is applied, and the control command is corrected based on the deviation from the planned printing path. This makes it possible to detect that the filament 26b is significantly deviated from the planned path and correct the application path of the filament 26b to reduce or eliminate the deviation of the filament 26b. Therefore, it is possible to greatly reduce the possibility of a malfunction in which the deviation becomes even larger, such as the filament 26c in FIG. 7. As the printed path in the first embodiment, information on the filament or segment immediately adjacent to the filament or segment to be applied is sufficient.
[0029] In the first embodiment, the information of the output side encoder 42 is read before printing starts, and the control command is corrected using the read information, thereby improving the accuracy of the motion trajectory of the robot 10 (the nozzle 27). That is, the output side encoder 42 can accurately detect the error of the nozzle trajectory including the effect of the coating reaction force, which is a phenomenon unique to 3D printers, so that the problems unique to 3D printers are solved and extremely high-precision 3D printing is possible. For example, the probability of coating deviation such as the filament 26b in FIG. 6 occurring is greatly reduced, and even if coating deviation such as the filament 26b occurs, the probability of the coating deviation expanding further to the filament 26c in FIG. 7 is greatly reduced.
[0030] (Second Example) 11 is a functional block diagram of a second embodiment of the robot control device 30. Note that in the second embodiment, only the points different from the first embodiment will be described, and a description of the points similar to the first embodiment will be omitted.
[0031] In addition to the control command storage unit 66, the deviation estimation unit 68, and the control command correction unit 70, the calculation unit 50 further includes a recalculation unit 74 that accumulates the history of deviation correction and recalculates the trajectory that the nozzle 27 should follow, and the control command correction unit 70 changes the deviation correction amount based on the recalculated trajectory. In other words, after a coating deviation occurs in the width direction of coating, one or more print correction planned paths are generated by the recalculation unit 74 so that the actual trajectory asymptotically becomes the target trajectory, and the control command correction unit 70 corrects the control command stepwise based on the print correction planned path. For example, after a coating deviation such as the filament 26b in FIG. 6 occurs, coating is performed so as to gradually reduce the coating deviation as shown by the filament 26d, and finally coating that matches the target trajectory is performed as shown by the filament 26e. It is preferable that the printed path in the second embodiment includes all of the past print history.
[0032] Fig. 13 explains a specific example of a process for realizing coating as shown in Fig. 12. Here, the path along which the filament is coated is represented by point cloud data, and for the filament 26a, the planned printing path represented by a circle 76 generally coincides with the printed path represented by a triangle 78. However, suppose that due to factors such as variation in coating reaction force, the printed path 78 deviates from the planned printing path 76 as shown in the filament 26b.
[0033] For the filament 26d to be applied next, the path is not corrected by an amount equivalent to the deviation caused by the filament 26b, but rather, corrections are made multiple times (four times in the example of FIG. 12) by an amount smaller than the deviation, as in the print correction planned path represented by the square mark 80, so that the print correction planned path 80 finally coincides with the print planned path 76, as in the filament 26e. This makes it possible to smoothly correct the deviation and obtain a modeled object of a desired shape. Various methods can be used to adjust the coordinates of such point groups, and examples of such methods include a simple method of finding the average with the surroundings and a method using a numerical analysis thermal equilibrium model.
[0034] In the second embodiment, as in the first embodiment, the deviation between the planned printing path and the printed path is detected and estimated, and then a path correction algorithm is executed, and the above-mentioned corrected planned printing path is generated with a pre-specified correction strength based on the 3D shape data and the estimated deviation, and the 3D printing path (control command) is updated at the specified timing.
[0035] The correction strength here refers to the amount of correction to be performed on the planned print path, and is set or changed in advance by the operator. This amount includes how often the path deviation is corrected, how many steps the path is asymptotically made to the planned print path, and how far away from the path to be corrected the information on other paths is used to correct the deviation. The generation of the planned print path and the actual 3D printing may proceed simultaneously, but if the correction strength setting is set to reflect deviations over a wide range in the correction, the generation of the planned print path may be delayed until all printed paths in that range are generated.
[0036] In this way, in the second embodiment, a print correction planned path is generated in which the deviation between the planned print path and the printed path is gradually reduced for filament coating in the coating width direction (direction parallel to the coating surface), and the control command is corrected using the print correction planned path and the deviation between the print correction planned path and the printed path to asymptotically achieve the target coating state, thereby smoothly eliminating the coating deviation and achieving the desired appearance of the object to be molded.
[0037] (Third Example) FIG. 14 shows, as a comparative example, an example of a coating state when an appropriate reaction force is not obtained during filament coating. Here, the coating surface 61 of the object 12 to be molded is not flat but has irregularities. As described with reference to FIG. 2, coating reaction forces 58 and 62 act on the nozzle 27 when the filament 26 is being coated, but the coating reaction force may vary greatly, especially when the coating surface 61 has irregularities. If the coating reaction force is larger than the expected value, defects such as crushing of the filament 26 occur, and conversely, if it is small, the filament 26 does not fit the coating surface 61, and defects such as peeling off from the coating surface 61 occur as shown in FIG. 14. In addition to the unevenness of the coating surface, the coating reaction force may vary depending on the temperature and humidity of the coating surface or the surroundings, the deviation of the robot's trajectory, the state of the nozzle, etc., and this variation has an adverse effect on the print quality.
[0038] Therefore, as shown in FIG. 15, in the third embodiment, a force sensor 82 for measuring the reaction force acting on the nozzle 27 is provided in or near the nozzle unit 24. A specific example of the force sensor 82 is a six-axis force sensor capable of detecting forces in three orthogonal directions and torque in three rotational directions. By using such a force sensor 82, the magnitude and direction of the resultant force of the reaction forces 58 and 62 can be detected, and the magnitudes of the reaction forces 58 and 62 can be calculated by simple calculation using the resultant force. However, the means for estimating the coating reaction force is not limited to the six-axis force sensor, and examples include a method of providing a slider and a spring at the tip of the nozzle unit 24 and calculating the force from the slider's push-in amount and spring constant, and a method of using a capacitance sensor or a laser displacement meter to calculate the distance between the coating surface and the nozzle and calculating the force from the physical properties of the filament. These methods can also be realized as an auxiliary function inside the nozzle unit.
[0039] As shown in FIG. 16, the calculation unit 50 of the robot control device 30 has, in addition to the control command storage unit 66, the misalignment estimation unit 68, and the control command correction unit 70, a coating state estimation unit 84 that estimates the coating state of the filament, which has a strong correlation with the coating reaction force, using the detection result of the force sensor 82 when the resin filament is discharged, and the control command correction unit 70 corrects the control command using the estimated coating state in addition to the estimation result of the misalignment estimation unit 68.
[0040] Specifically, for example, the relationship between the coating direction and the ideal coating reaction force as shown in Fig. 17 is stored in advance as target data in the storage device 54 of the control device 30. The ideal reaction force is for obtaining a good coating state without crushing or peeling of the filament, and varies depending on the material and diameter of the filament, the printing speed, the printing quality, the coating direction, etc., and this information can also be provided in advance in the storage device 54. In addition, the relationship between the coating reaction force and the feed amount of the filament, and the mode of deformation during filament coating can also be acquired and stored in advance as data.
[0041] Then, feedback control can be performed so that the actual coating reaction force detected by the force sensor 82 falls within a predetermined target range that can achieve a good coating state. In this way, by providing the force sensor 82 between the robot arm 18 or 20 and the nozzle unit 24 and enabling the coating reaction force to be acquired by the control device 30, it becomes possible to press the nozzle 27 against the coating surface 61 so as to achieve a specified target coating reaction force using the history of the coating reaction force, and it becomes possible to perform printing that fits the curvature or unevenness of the coating surface 61, for example, as shown in Fig. 18.
[0042] (Fourth Example) Next, a fourth embodiment of the robot control device 30 will be described. Note that the fourth embodiment roughly corresponds to a combination of the second and third embodiments, but only the differences from the second and third embodiments will be described here, and a description of the similarities to the second and third embodiments will be omitted.
[0043] In the third embodiment, even if the coating surface 61 has unintended unevenness, a filament coating that fits the unevenness can be performed, but if such coating is repeated in the thickness direction (a direction substantially perpendicular to the coating surface 61), the outer shape of the final object to be molded may also reflect the unevenness of the coating surface 61, as shown in Fig. 19. Specifically, a filament 26f that fits the unevenness of the coating surface 61 is applied onto the coating surface 61, and a filament 26g having the same shape as the filament 26f is layered on top of the filament 26f.
[0044] Therefore, as shown in FIG. 20, the calculation unit 50 of the robot control device 30 further includes a recalculation unit 74 that accumulates the deviation correction and recalculates the trajectory in addition to the control command storage unit 66, the deviation estimation unit 68, the control command correction unit 70, and the coating state estimation unit 84, and the control command correction unit 70 changes the deviation correction amount based on the recalculated trajectory, as in the second embodiment. In other words, after a coating deviation occurs in the thickness direction of the coating, the control command is corrected in stages so that the actual trajectory asymptotically becomes the target trajectory. For example, after a filament that fits the unevenness of the coating surface is coated as in the filament 26f in FIG. 19, coating is performed to gradually reduce the unevenness as shown by the filament 26h, and finally, coating that matches the target trajectory is performed as shown in FIG. 21, as in the filament 26i.
[0045] In the fourth embodiment, as in the second embodiment described with reference to Fig. 13, the corrected planned print path 80 is generated based on the planned print path 76 included in the specified control command, but it is also possible to generate a new planned print path based on a previously generated printed path. For example, when there is an unintended large recess on the coating surface 61, the deviation between the printed path and the original planned print path is large, and appropriate coating may be difficult with asymptotic correction, a new planned print path including a path that fills only the recess can be generated based on the difference in shape between the printed path and the object to be modeled. Such processing can also be performed in the second embodiment including the recalculation unit 74.
[0046] The functions of each unit of the control device 30 described above can also be provided by a computer program. For example, the storage device 54 stores various data used in each process executed by the calculation unit 50 and various data generated during each process. Each component of the calculation unit 50 (such as the control command correction unit 70) can be a functional module realized by a computer program executed by a processor. Such a computer program may also be provided in a form recorded on a non-transitory computer-readable recording medium such as a semiconductor memory, a magnetic recording medium, or an optical recording medium. [Explanation of symbols]
[0047] 10. Robot 12 Modeling Object 24 Nozzle unit 26 Filament 27 Nozzle 30 Robot control device 32 Motor 36 Input Encoder 42 Output Encoder 50 Arithmetic section 52 Display device 54 Storage device 56 Control panel 57 Control Unit 58, 62 Coating reaction force 60, 61 Coating surface 66 Control command storage section 68 Displacement Estimation Unit 70 Control command correction unit 74 Recalculation part 82 Force Sensor 84 Coating condition estimation unit
Claims
1. A robot control device for controlling an articulated robot having a nozzle for discharging a material for a modeling object, a control command storage unit that stores control commands including a planned print path to be followed when the nozzle moves while applying the material to the object; a deviation estimation unit that determines a printed path, which is an actual movement trajectory of the nozzle, based on angle information of each of the input side and output side of the joint of the articulated robot that operates based on the control command, and estimates a deviation between the printed path and the planned printing path; a control command correction unit that corrects the control command to reduce or eliminate the estimated deviation; A robot control device having the above configuration.
2. A recalculation unit generates a correction planned print path so that the deviation between the planned print path and the printed path is gradually reduced and approaches the planned print path in the width direction of application, 2 . The robot control device according to claim 1 , wherein the control command correction unit corrects the control command based on the planned corrected path for printing generated by the recalculation unit and a deviation between the planned corrected path for printing and the printed path.
3. a coating state estimation unit that estimates a coating state of the object based on a reaction force acting on the nozzle during the discharge of the material, The robot control device according to claim 1 , wherein the control command correction unit corrects the control command so that the reaction force falls within a target range that is determined in advance based on the application state.
4. a recalculation unit for generating a plurality of corrected planned print paths in which the deviation between the planned print path and the printed path is gradually reduced; The robot control device according to claim 3 , wherein the control command correction unit corrects the control command stepwise based on the corrected planned printing path so that the printed path asymptotically approaches the planned printing path in a thickness direction of the applied material.
5. The robot control device according to claim 2 or 4, wherein the recalculation unit generates a new planned print path based on a previously generated printed path and a shape of the object to be formed.
6. an articulated robot equipped with a nozzle for applying and stacking material for an object to be molded; A 3D printer comprising: a robot control device according to any one of claims 1 to 5, which controls the articulated robot.
7. The 3D printer according to claim 6 , wherein the articulated robot has an input-side encoder that acquires angle information on the input side, and an output-side encoder that acquires angle information on the output side.
8. The 3D printer according to claim 6 or 7, wherein the articulated robot has a force sensor that detects a reaction force acting on the nozzle.
Citation Information
Patent Citations
Robot device control method and robot device
JP2016027951A
Correcting device and method for robot language programs, and program
JP2016218934A
Robot device, robot control method, program, recording medium and production method of article
JP2017209762A
Composite material molding method and composite material
JP2019098682A
Manufacturing method of laminated molding
JP2019136711A
