WO2023058243A1 - 制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体 - Google Patents

制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体 Download PDF

Info

Publication number
WO2023058243A1
WO2023058243A1 PCT/JP2021/037434 JP2021037434W WO2023058243A1 WO 2023058243 A1 WO2023058243 A1 WO 2023058243A1 JP 2021037434 W JP2021037434 W JP 2021037434W WO 2023058243 A1 WO2023058243 A1 WO 2023058243A1
Authority
WO
WIPO (PCT)
Prior art keywords
path
smoothing
control device
unit
pass filter
Prior art date
Application number
PCT/JP2021/037434
Other languages
English (en)
French (fr)
Other versions
WO2023058243A9 (ja
Inventor
大樹 村上
宏之 河村
次郎 藤山
直矢 小出
Original Assignee
ファナック株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by ファナック株式会社 filed Critical ファナック株式会社
Priority to PCT/JP2021/037434 priority Critical patent/WO2023058243A1/ja
Priority to DE112021007992.1T priority patent/DE112021007992T5/de
Priority to CN202180102937.8A priority patent/CN118043750A/zh
Publication of WO2023058243A1 publication Critical patent/WO2023058243A1/ja
Publication of WO2023058243A9 publication Critical patent/WO2023058243A9/ja

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/4093—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by part programming, e.g. entry of geometrical information as taken from a technical drawing, combining this with machining and material information to obtain control information, named part programme, for the NC machine
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/35—Nc in input of data, input till input file format
    • G05B2219/35097—Generation of cutter path, offset curve
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Definitions

  • the present invention relates to a computer-readable recording medium recording a control device and a program.
  • curves created by CAD are converted to points by CAM (Computer Aided Manufacturing). Convert to These points are called command points.
  • a curve is expressed as a plurality of continuous minute line segments by being converted into a sequence of command points.
  • FIG. 7 is a diagram illustrating a sequence of multiple command points converted by the CAM.
  • a plurality of command points 422 are indicated by black circles, and minute line segments 424 between the command points 422 are indicated by dotted arrows.
  • the movement path formed by minute line segments 424 has a polyhedral shape.
  • a control device creates a smooth tool path based on a plurality of minute points or a plurality of minute line segments commanded by this control program (for example, Patent Document 1, etc.).
  • a smooth machined surface is formed by machining the workpiece while moving the tool relative to the workpiece along the smooth tool path.
  • FIG. 8 shows an example of a curved path (hereinafter referred to as a smoothed path) created by smoothing a polygonal path composed of a plurality of continuous minute line segments with a low-pass filter.
  • smoothing paths 426 are indicated by solid arrows. Smoothing with a low-pass filter has the advantage of reducing the gap between adjacent paths.
  • the smoothing path 426 by the low-pass filter is in the direction of the main normal vector of the curve passing through the command points 422 (inwardly of the curve of the curve) compared to the original polygonal path. deviated path.
  • such a deviation amount is referred to as an inward turning amount. Therefore, although the smoothing path is smooth, it passes through positions shifted from the command point 422 . That is, the machining accuracy (shape accuracy) is lowered.
  • a tolerance permismissible error
  • a strict tolerance is set in an attempt to suppress a decrease in machining accuracy, a problem arises that the path will not be sufficiently smooth. Therefore, there is a demand for a technique for sufficiently smoothing the machining path while maintaining the machining accuracy.
  • the control device performs correction so that the curve after smoothing approaches a plurality of command points, taking into account the amount of inward turning, which is the deviation of the path that occurs when smoothing is performed with a low-pass filter.
  • This correction may be performed on the smoothing path after the smoothing process, or may be performed on the command point to be processed before the smoothing process.
  • the smoothing path or command points are corrected in the opposite direction of the principal normal vector of the curve passing through the command points (outward of the curve of the curve).
  • One aspect of the present disclosure is a control device that controls machining of a workpiece by an industrial machine based on a control program, and smoothing is performed by a low-pass filter on a command path commanded by the control program.
  • a low-pass filter unit for generating a smoothing path with a low-pass filter unit; an inner turn amount calculation unit for calculating an inner turn amount of the smoothing path obtained by the low-pass filter unit with respect to the command path; and based on the inner turn amount, the smoothing and a smoothing processor that outputs a route pulled back in a direction opposite to the inward turning direction.
  • Another aspect of the present disclosure is a computer-readable recording medium recording a program for operating a control device that controls machining of a workpiece by an industrial machine based on a control program, wherein the control program instructs a low-pass filter unit that generates a smoothed path by applying smoothing to the commanded path using a low-pass filter;
  • a computer-readable recording medium recording a program for operating a control device as a calculation unit and a smoothing processing unit that outputs a route in which the smoothing path is pulled back in a direction opposite to the direction of inward rotation based on the amount of inward rotation. is.
  • a smooth and highly accurate path (no loss of accuracy due to inner turns) can be obtained. Therefore, it is possible to obtain a machined work having a smooth machined surface and not deteriorating shape accuracy.
  • FIG. 1 is a schematic hardware configuration diagram of a control device according to an embodiment of the present invention
  • FIG. 3 is a block diagram showing schematic functions of a control device according to the first embodiment of the present invention
  • FIG. It is a figure explaining the inner rotation amount.
  • FIG. 6 is a block diagram showing the schematic functions of a control device according to a second embodiment of the present invention
  • FIG. 8 is a block diagram showing the schematic functions of a control device according to a third embodiment of the invention
  • FIG. 4 is a block diagram showing schematic functions of a control device according to another embodiment of the present invention
  • FIG. 5 is a diagram illustrating a sequence of multiple command points converted by the CAM
  • FIG. 10 is a diagram showing an example of a smoothing route created by smoothing a polygonal route with a low-pass filter;
  • FIG. 1 is a schematic hardware configuration diagram showing essential parts of a control device according to a first embodiment of the present invention.
  • the control device 1 of the present invention can be implemented, for example, as a control device that controls industrial machines such as machine tools, electric discharge machines, and robots based on control programs.
  • the control device 1 according to the present embodiment will be described below as an example of a control device that controls a machine tool that processes a work by moving the tool relative to the work based on a control program.
  • the CPU 11 included in the control device 1 is a processor that controls the control device 1 as a whole.
  • the CPU 11 reads a system program stored in the ROM 12 via the bus 22 and controls the entire control device 1 according to the system program.
  • the RAM 13 temporarily stores calculation data, display data, various data input from the outside, and the like.
  • the non-volatile memory 14 is composed of, for example, a memory backed up by a battery (not shown), an SSD (Solid State Drive), or the like, and retains the stored state even when the control device 1 is powered off.
  • the nonvolatile memory 14 stores data acquired from the industrial machine 2, control programs and data read from the external device 72 via the interface 15, control programs and data input via the input device 71, network Control programs and data acquired from other devices via 5 are stored.
  • the control program and data stored in the nonvolatile memory 14 may be developed in the RAM 13 at the time of execution/use.
  • Various system programs such as a well-known analysis program are pre-written in the ROM 12 .
  • the interface 15 is an interface for connecting the CPU 11 of the control device 1 and an external device 72 such as a USB device. From the external device 72 side, for example, a control program and setting data used for controlling the industrial machine 2 are read. Control programs and setting data edited in the control device 1 can be stored in the external storage means via the external device 72 .
  • a PLC (Programmable Logic Controller) 16 executes a ladder program to control the industrial machine 2 and peripheral devices of the industrial machine 2 (for example, a tool changer, an actuator of a transfer robot, a temperature sensor attached to the industrial machine 2, etc.). and a plurality of sensors 3) such as a humidity sensor, etc., through the I/O unit 19 to control them. It also receives signals from various switches on an operation panel provided on the main body of the industrial machine 2 and signals from peripheral devices, and passes the signals to the CPU 11 after performing necessary signal processing.
  • the interface 20 is an interface for connecting the CPU of the control device 1 and the wired or wireless network 5 .
  • Other industrial machines 4 such as machine tools and electrical discharge machines, fog computers 6, cloud servers 7, and the like are connected to the network 5 to exchange data with the control device 1 .
  • each data read into the memory, data obtained as a result of executing the program, etc. are output via the interface 17 and displayed.
  • An input device 71 composed of a keyboard, a pointing device, etc., transfers commands, data, etc. based on operations by an operator to the CPU 11 via the interface 18 .
  • the axis control circuit 30 for controlling the axes provided in the industrial machine 2 receives the axis movement command amount from the CPU 11 and outputs the axis command to the servo amplifier 40 .
  • the servo amplifier 40 receives this command and drives the servo motor 50 that moves the axis of the machine tool.
  • the axis servomotor 50 incorporates a position/velocity detector, and feeds back a position/velocity feedback signal from this position/velocity detector to the axis control circuit 30 to perform position/velocity feedback control.
  • Only one axis control circuit 30, one servo amplifier 40, and one servo motor 50 are shown in the hardware configuration diagram of FIG. only available.
  • FIG. 2 is a schematic block diagram showing the functions of the control device 1 according to the first embodiment of the present invention. Each function provided in the control device 1 according to the present embodiment is realized by the CPU 11 provided in the control device 1 shown in FIG.
  • the control device 1 of this embodiment includes an analysis section 100 , a smoothing processing section 110 , a low-pass filter section 112 , an inner turning amount calculation section 114 and a motor control section 120 .
  • a control program 200 for controlling the operation of the industrial machine 2 is stored in advance in the RAM 13 to the nonvolatile memory 14 of the control device 1 .
  • the analysis unit 100 reads and analyzes the blocks of the control program 200 and generates movement command data for the servo motors 50 that drive each part of the industrial machine 2 .
  • the analysis unit 100 generates data related to a movement command for the servo motor 50 that relatively moves the tool of the industrial machine 2 with respect to the work, based on the feed command issued by the block of the control program 200 .
  • the data related to the generated movement command includes at least a plurality of command point sequences.
  • the analysis unit 100 outputs data related to the generated movement command to the smoothing processing unit 110 .
  • the smoothing processing unit 110 generates a smoothed route by smoothing the movement route composed of a sequence of a plurality of command points included in the data related to the movement command based on the data related to the movement command input from the analysis unit 100. do.
  • the smoothing path generated by the smoothing processing unit 110 takes into consideration the inner turning amount calculated by the inner turning amount calculating unit 114 and is based on the curved path generated by the low-pass filter unit 112 .
  • the low-pass filter unit 112 generates a smoothed path by performing smoothing with a low-pass filter on a path composed of a plurality of minute line segments obtained by connecting a plurality of command points.
  • the low-pass filter section 112 defines the path composed of the plurality of minute line segments as, for example, a parametric curve P(t).
  • P(t) is a vector whose elements are the coordinate values of each axis, and the dimension of the vector matches the number of axes.
  • P(t) is a three-dimensional vector.
  • t is a parametric curve parameter. Since the method of representing the route commanded by the control program 200 by a parametric curve is a known technique, it will be omitted.
  • Q(t) can be calculated by the following equation (1), where Q(t) is the curved path obtained by smoothing the path P(t).
  • F(l) represents filtering operation by a low-pass filter.
  • the low-pass filter for example, a known moving average filter, Gaussian convolution filter, or the like can be used.
  • l is a parameter representing the application range (filter length) of the filter.
  • the filter length may be calculated based on at least one of the time, distance, and speed of movement of the tool along the commanded path, and the time constant determined by the filter.
  • the filter length By setting the filter length to about the length of the minute line segment that constitutes the path (when the parameter t of the parametric curve is the unit of time, about the time required for movement of the minute line segment), the polygonal path can be sufficiently smoothed.
  • the filter length is generally applied in a range longer than the line segment length. This line segment length may be checked in advance before filtering, or may be given separately.
  • low-pass filters may be used as the low-pass filter that the low-pass filter unit 112 uses for smoothing.
  • the inner turning amount calculation unit 114 determines how much the smoothing route generated by the low-pass filter unit 112 applying a low-pass filter to a route composed of a plurality of minute line segments obtained by connecting a plurality of command points is calculated. Calculate the inner turning amount of whether it will turn.
  • the inner turning amount calculation unit 114 may calculate the inner turning amount by simply taking a difference between a route composed of a plurality of minute line segments and the smoothing route. For example, using Equation 2 exemplified below, the inner turning amount may be calculated at a predetermined parameter period. In Expression 2, d(t) is the inner turning amount (scalar value) at the position of the predetermined parameter.
  • FIG. 3 is a diagram exemplifying the inner turning amount of a smoothing path for a path composed of a plurality of minute line segments.
  • a command point 422 is indicated by a black circle
  • a minute line segment 424 is indicated by a dotted line arrow
  • a smoothing path 426 is indicated by a solid line arrow. Note that FIG. 3 is drawn such that the smoothing route is larger than in reality, in order to make it easier to grasp the amount of inward turning. As exemplified in FIG.
  • the inner turning amount calculation unit 114 may, for example, calculate only the inner turning amount at the position of the command point 422 using Equation 2, and calculate the inner turning amount at other positions by proportional distribution or the like. For example, assume that the value of the parameter t at the position of a predetermined command point is ts, and the value of the parameter t at the position of the next command point is te. At this time, the value a shown in Equation 3 below is uniquely determined.
  • Equation 4 the amount of inward turning at a predetermined position between the command points can be calculated by the following Equation 4.
  • the inner turning amount calculation unit 114 may approximately calculate the inner turning amount based on, for example, the curvature of the smoothing curve.
  • a curvature radius R(t) at a predetermined position of the smoothing curve Q(t) can be obtained from the parametric curve by a known analytical method or approximate method.
  • the inward turning amount d(t) satisfies Expression 5 below.
  • the smoothing processing unit 110 corrects the smoothing path generated by the low-pass filter unit 112 based on the inner turning amount calculated by the inner turning amount calculation unit 114 in this way, thereby generating a smoothing path passing near the command point. You may do so.
  • a correction point is calculated by moving the command point in advance. Then, a smoothed path passing near the command point may be generated by applying a filter to the corrected movement path composed of a row of a plurality of correction points with the low-pass filter unit 112 .
  • the motor control unit 120 controls the servomotor 50 provided in the industrial machine 2 so that the tool and the workpiece move relatively along the smoothing path generated by the smoothing processing unit 110 .
  • a smooth and highly accurate path (no decrease in accuracy due to inner turning) can be obtained. Therefore, it is possible to obtain a machined work having a smooth machined surface and not deteriorating shape accuracy.
  • FIG. 4 is a schematic block diagram of the functions provided by the control device 1 according to the second embodiment of the present invention. Each function provided in the control device 1 according to the present embodiment is realized by the CPU 11 provided in the control device 1 shown in FIG.
  • the control device 1 of the present embodiment includes an analysis section 100 , a smoothing processing section 110 , a low-pass filter section 112 , an inner rotation amount calculation section 114 , a motor control section 120 , and further includes a pullback correction section 116 .
  • a control program 200 for controlling the operation of the industrial machine 2 is stored in advance in the RAM 13 to the nonvolatile memory 14 of the control device 1 .
  • the functions provided by the analysis unit 100, the low-pass filter unit 112, the inner rotation amount calculation unit 114, and the motor control unit 120 are the same as the functions provided by the control device 1 according to the first embodiment.
  • the smoothing processing unit 110 according to the present embodiment generates a smoothing curve by correcting a smoothing path in which a plurality of command points are inwardly turned in a direction opposite to the inwardly turning direction by the pullback correction unit 116 .
  • correction is performed in the direction opposite to the curvature center direction vector (principal normal vector) of the smoothing path.
  • correction in the direction opposite to the inward turning direction is referred to as pullback correction.
  • the pullback correction unit 116 generates a smoothing curve obtained by performing pullback correction on the smoothing path generated by the smoothing processing unit 110 .
  • the pull-back correction unit 116 may perform pull-back correction using, for example, the inner turn amount calculated by the inner turn amount calculation unit 114 as it is.
  • QC(t) be the center of curvature at each position of the smoothing curve Q(t).
  • a curvature unit vector eq(t) in this case can be expressed by the following equation (6).
  • the pullback vector h(t) can be calculated by the following Equation 7.
  • the pullback correction unit 116 can calculate the smoothing curve S(t) after the pullback correction using the following equation (8).
  • the smoothing processing unit 110 outputs the smoothing curve S(t) after pullback correction obtained in this manner to the motor control unit 120 as the final path.
  • the pullback correction unit 116 may perform a smoothing process as shown in Equation 9 below when calculating the pullback vector h(t).
  • F(l) represents the filtering operation by the low-pass filter
  • l is a parameter representing the filter application range (filter length).
  • This filter F(l) may be the same as the filter used by the low-pass filter section 112, or may be different.
  • the inner turning amount by the low-pass filter can be calculated, and the smoothing curve can be corrected using the calculated inner turning amount, so smooth and highly accurate (by the inner turning (no loss of accuracy) is obtained. Therefore, it is possible to obtain a machined work having a smooth machined surface and not deteriorating shape accuracy.
  • FIG. 5 is a schematic block diagram of the functions provided by the control device 1 according to the third embodiment of the present invention. Each function provided in the control device 1 according to the present embodiment is realized by the CPU 11 provided in the control device 1 shown in FIG.
  • the control device 1 of the present embodiment further includes an analysis section 100 , a smoothing processing section 110 , a low-pass filter section 112 , an inner rotation amount calculation section 114 and a motor control section 120 , and further includes a preliminary pullback correction section 118 .
  • a control program 200 for controlling the operation of the industrial machine 2 is stored in advance in the RAM 13 to the nonvolatile memory 14 of the control device 1 .
  • the functions provided by the analysis unit 100, the low-pass filter unit 112, the inner rotation amount calculation unit 114, and the motor control unit 120 are the same as the functions provided by the control device 1 according to the first embodiment.
  • the smoothing processing unit 110 according to the present embodiment generates correction points by correcting a plurality of command points before the smoothing processing in a direction opposite to the direction in which the pre-retraction correction unit 118 has turned inward.
  • a smoothing curve is generated by smoothing the plurality of correction points with the low-pass filter unit 112 .
  • the preliminary pullback correction unit 118 performs pullback correction in advance on a plurality of command points before performing smoothing processing.
  • a method of performing pullback correction in advance will be described below.
  • the commanded path be a parametric curve P(t)
  • the radius of curvature at each position be RP(t).
  • P(t) becomes polygonal.
  • the curvature is obtained from average shape information over a certain range, instead of obtaining the curvature locally.
  • the curvature at each position can be obtained by using polynomial fitting or the like.
  • Circle(R) denote an arc path with radius R.
  • the inner turning amount can be calculated by the following equation (10).
  • the pre-pullback vector h pre (t) can be calculated by the following equation (12).
  • the corrected commanded path S(t) is calculated by performing pullback correction in advance on P(t) using the prior pullback vector h pre (t) using Equation (13).
  • the smoothing processing unit 110 generates a smoothing curve by smoothing the corrected command path S(t) with the low-pass filter unit 112 .
  • the inner turning amount is calculated in advance, and the command point is corrected using the calculated inner turning amount. Then, since smoothing is performed on the corrected plurality of command points, a smooth and highly accurate path (no decrease in accuracy due to inner turning) can be obtained. A reduction in the amount of calculation is also expected compared to the case where correction is performed after calculating the smoothing curve.
  • the present invention is not limited to the above-described examples of the embodiments, and can be implemented in various modes by adding appropriate modifications.
  • the control program 200 shows a sequence of a plurality of command points as a route. Therefore, the description is based on the premise that the space between the command points is a minute line segment. However, even if the control program 200 explicitly designates the path between the command points not only by a minute line segment but also by a minute arc, a predetermined parametric curve, etc., the present invention cannot be applied. It is possible.
  • each value used for calculating the inner turning amount is calculated from the command path and the smoothing path. may be set.
  • the process of adding such information can be performed in advance on the CAD/CAM side. By configuring in this way, it is possible to reduce the calculation load in the control device 1 when performing the smoothing process.
  • the smoothing path is generated in one calculation pass. However, after generating a smoothing path once, similar processing may be repeated to generate a smoothing path.
  • the smoothing process unit 110 repeatedly performs smoothing on a smoothing path that has been created once. Repeat this process multiple times. By shortening the filter length of the low-pass filter that is used each time, the inward turning amount and the pullback amount are reduced, and the accuracy of the route after pullback can be improved.
  • a tolerance check unit 119 may be provided as illustrated in FIG. 6, for example. A predetermined tolerance (permissible error) is set in advance in the tolerance check unit 119 .
  • the tolerance check unit 119 checks whether the change amount (average change amount or maximum change amount) of the smoothing route with respect to the command route is within the tolerance each time the smoothing processing unit 110 performs smoothing processing. Then, if it does not fit within the tolerance, the smoothing process may be repeated.
  • the path output by the pullback correction unit 116 may be output as the final smoothing path (second embodiment), or the output of the low-pass filter unit 112 may be output as the final smoothing path. (second and third embodiments).
  • Control Device 2 4 Industrial Machine 5 Network 6
  • Cloud Server 11 CPU 12 ROMs 13 RAM 14 non-volatile memory 15, 17, 18, 20 interface 22 bus 30 axis control circuit 40
  • servo amplifier 50 servo motor 70 display device 71 input device 72 external device 100 analysis unit 110 smoothing processing unit 112 low-pass filter unit 114 inner turning amount calculation unit 116 Pullback correction unit 118 Pre-pullback correction unit 119 Tolerance check unit 120
  • Motor control unit 200 Control program

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Geometry (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Numerical Control (AREA)

Abstract

本開示による制御装置は、制御用プログラムにより指令された指令経路に対してローパスフィルタによるスムージングを施すことでスムージング経路を生成するローパスフィルタ部と、ローパスフィルタ部によって得られるスムージング経路の、指令経路に対して内回る内回り量を計算する内回り量計算部と、内回り量に基づいて、スムージング経路が内回る方向と逆方向へ引き戻された経路を出力するスムージング処理部と、を備える。

Description

制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体
　本発明は、制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体に関する。
　工作機械や放電加工機などの産業機械で滑らかな自由曲面を加工するための制御用プログラムを作成する場合、ＣＡＤ（Computer Aided Design）で作成された曲線を、ＣＡＭ（Computer Aided Manufacturing）により点列に変換する。これらの点を指令点と称する。曲線は指令点列に変換されることで、連続する複数の微小線分として表現される。
　図７は、ＣＡＭが変換した複数の指令点の列を例示する図である。図７では、複数の指令点４２２を黒丸で、指令点４２２の間の微小線分４２４を点線矢印で示している。図７に示されるように、微小線分４２４により構成される移動経路は多面体的な形状となる。制御装置は、この制御用プログラムにより指令される複数の微小点又は複数の微小線分に基づいて滑らかな工具経路を作成する（例えば、特許文献１など）。そして滑らかな工具経路に沿って工具をワークに対して相対的に移動させながら加工することで、滑らかな加工面を形成する。
　複数の微小線分から滑らかな工具経路を作成する方法の１つに、移動平均フィルタなどのローパスフィルタを用いたスムージングを行う方法がある。図８は、連続する複数の微小線分から為る多角経路をローパスフィルタでスムージングして作成される曲線経路（以下、スムージング経路とする）の例を示している。図８では、スムージング経路４２６を実線矢印で示している。ローパスフィルタによるスムージングには、隣接する経路間の断差を小さくするメリットがある。
特開２０００－３５３００６号公報
　図８に例示されるように、ローパスフィルタによるスムージング経路４２６は、元の多角経路と比較して、複数の指令点４２２を通る曲線の主法線ベクトルの方向（曲線のカーブの内側方向）にずれた経路となる。本明細書では、このようなずれの量を内回り量と称する。そのため、スムージング経路は、滑らかである反面、指令点４２２からずれた位置を通る。すなわち、加工精度（形状精度）が低下することとなる。スムージング処理をする際に、トレランス（許容誤差）を設定することで加工精度の低下をある程度抑えることもできる。しかしながら、加工精度の低下を抑えようとして厳しいトレランスを設定すると、経路が十分に滑らかにならないという問題が生じる。
　そこで、加工精度を保ちながら加工経路を十分に滑らかにする技術が望まれている。
　本開示による制御装置は、ローパスフィルタでスムージング処理をした場合に生じる経路のずれである内回り量を考慮して、スムージング後の曲線が複数の指令点に近づくように補正を行う。この補正は、スムージング処理の後にスムージング経路に対して行ってもよいし、スムージング処理の前に処理対象となる指令点に対して行ってもよい。スムージング経路又は指令点は、複数の指令点を通る曲線の主法線ベクトルの逆方向（曲線のカーブの外側方向）に補正される。
　そして、本開示の一態様は、制御用プログラムに基づいて産業機械によるワークの加工を制御する制御装置であって、前記制御用プログラムにより指令された指令経路に対してローパスフィルタによるスムージングを施すことでスムージング経路を生成するローパスフィルタ部と、前記ローパスフィルタ部によって得られるスムージング経路の、前記指令経路に対して内回る内回り量を計算する内回り量計算部と、前記内回り量に基づいて、前記スムージング経路が前記内回る方向と逆方向へ引き戻された経路を出力するスムージング処理部と、を備える制御装置である。
　本開示の他の一態様は、制御用プログラムに基づいて産業機械によるワークの加工を制御する制御装置を動作させるプログラムを記録したコンピュータ読み取り可能な記録媒体であって、前記制御用プログラムにより指令された指令経路に対してローパスフィルタによるスムージングを施すことでスムージング経路を生成するローパスフィルタ部と、前記ローパスフィルタ部によって得られるスムージング経路の、前記指令経路に対して内回る内回り量を計算する内回り量計算部と、前記内回り量に基づいて、前記スムージング経路が前記内回る方向と逆方向へ引き戻された経路を出力するスムージング処理部として、制御装置を動作させるプログラムを記録したコンピュータ読み取り可能な記録媒体である。
　本開示の一態様により、滑らかであり、かつ高精度な（内回りによる精度低下がない）経路が得られる。そのため、加工面が滑らかであり、かつ形状精度が悪化しない加工ワークが得られる。
本発明の一実施形態による制御装置の概略的なハードウェア構成図である。 本発明の第１実施形態による制御装置の概略的な機能を示すブロック図である。 内回り量について説明する図である。 本発明の第２実施形態による制御装置の概略的な機能を示すブロック図である。 本発明の第３実施形態による制御装置の概略的な機能を示すブロック図である。 本発明の他の実施形態による制御装置の概略的な機能を示すブロック図である。 ＣＡＭが変換した複数の指令点の列を例示する図である。 多角経路をローパスフィルタでスムージングして作成されるスムージング経路の例を示す図である。
　以下、本発明の実施形態を図面と共に説明する。
　図１は本発明の第１実施形態による制御装置の要部を示す概略的なハードウェア構成図である。本発明の制御装置１は、例えば制御用プログラムに基づいて工作機械や放電加工機、ロボットなどの産業機械を制御する制御装置として実装することができる。以下では、本実施形態による制御装置１について、制御用プログラムに基づいて工具をワークに対して相対的に移動させることで該ワークを加工する工作機械を制御する制御装置を例として説明する。
　本実施形態による制御装置１が備えるＣＰＵ１１は、制御装置１を全体的に制御するプロセッサである。ＣＰＵ１１は、バス２２を介してＲＯＭ１２に格納されたシステム・プログラムを読み出し、該システム・プログラムに従って制御装置１全体を制御する。ＲＡＭ１３には一時的な計算データや表示データ、及び外部から入力された各種データ等が一時的に格納される。
　不揮発性メモリ１４は、例えば図示しないバッテリでバックアップされたメモリやＳＳＤ（Solid State Drive）等で構成され、制御装置１の電源がオフされても記憶状態が保持される。不揮発性メモリ１４には、産業機械２から取得されたデータ、インタフェース１５を介して外部機器７２から読み込まれた制御用プログラムやデータ、入力装置７１を介して入力された制御用プログラムやデータ、ネットワーク５を介して他の装置から取得された制御用プログラムやデータ等が記憶される。不揮発性メモリ１４に記憶された制御用プログラムやデータは、実行時／利用時にはＲＡＭ１３に展開されても良い。また、ＲＯＭ１２には、公知の解析プログラムなどの各種システム・プログラムがあらかじめ書き込まれている。
　インタフェース１５は、制御装置１のＣＰＵ１１とＵＳＢ装置等の外部機器７２と接続するためのインタフェースである。外部機器７２側からは、例えば産業機械２の制御に用いられる制御用プログラムや設定データ等が読み込まれる。また、制御装置１内で編集した制御用プログラムや設定データ等は、外部機器７２を介して外部記憶手段に記憶させることができる。ＰＬＣ（プログラマブル・ロジック・コントローラ）１６は、ラダープログラムを実行して産業機械２及び産業機械２の周辺装置（例えば、工具交換装置や、搬送ロボットのアクチュエータ、産業機械２に取付けられている温度センサや湿度センサ等の複数のセンサ３）にＩ／Ｏユニット１９を介して信号を出力し制御する。また、産業機械２の本体に配備された操作盤の各種スイッチや周辺装置等の信号を受け、必要な信号処理をした後、ＣＰＵ１１に渡す。
　インタフェース２０は、制御装置１のＣＰＵと有線乃至無線のネットワーク５とを接続するためのインタフェースである。ネットワーク５には、工作機械や放電加工機などの他の産業機械４やフォグコンピュータ６、クラウドサーバ７等が接続され、制御装置１との間で相互にデータのやり取りを行っている。
　表示装置７０には、メモリ上に読み込まれた各データ、プログラム等が実行された結果として得られたデータ等がインタフェース１７を介して出力されて表示される。また、キーボードやポインティングデバイス等から構成される入力装置７１は、オペレータによる操作に基づく指令，データ等をインタフェース１８を介してＣＰＵ１１に渡す。
　産業機械２が備える軸を制御するための軸制御回路３０はＣＰＵ１１からの軸の移動指令量を受けて、軸の指令をサーボアンプ４０に出力する。サーボアンプ４０はこの指令を受けて、工作機械が備える軸を移動させるサーボモータ５０を駆動する。軸のサーボモータ５０は位置・速度検出器を内蔵し、この位置・速度検出器からの位置・速度フィードバック信号を軸制御回路３０にフィードバックし、位置・速度のフィードバック制御を行う。なお、図１のハードウェア構成図では軸制御回路３０、サーボアンプ４０、サーボモータ５０は１つずつしか示されていないが、実際には制御対象となる産業機械２に備えられた軸の数だけ用意される。
　図２は、本発明の第１実施形態による制御装置１が備える機能を概略的なブロック図として示したものである。本実施形態による制御装置１が備える各機能は、図１に示した制御装置１が備えるＣＰＵ１１がシステム・プログラムを実行し、制御装置１の各部の動作を制御することにより実現される。
　本実施形態の制御装置１は、解析部１００、スムージング処理部１１０、ローパスフィルタ部１１２、内回り量計算部１１４、モータ制御部１２０を備える。また、制御装置１のＲＡＭ１３乃至不揮発性メモリ１４には、予め産業機械２の運転を制御するための制御用プログラム２００が記憶されている。
　解析部１００は、制御用プログラム２００のブロックを読み出して解析し、産業機械２の各部を駆動するサーボモータ５０の移動指令データを生成する。解析部１００は、制御用プログラム２００のブロックにより指令される送り指令に基づいて、産業機械２の工具をワークに対して相対的に移動させるサーボモータ５０に対する移動指令に係るデータを生成する。生成した移動指令に係るデータには、少なくとも複数の指令点の列を含む。解析部１００は、生成した移動指令に係るデータをスムージング処理部１１０に出力する。
　スムージング処理部１１０は、解析部１００から入力された移動指令に係るデータに基づいて、該移動指令に係るデータに含まれる複数の指令点の列から構成される移動経路をスムージングしたスムージング経路を生成する。スムージング処理部１１０が生成するスムージング経路は、内回り量計算部１１４が計算する内回り量を考慮したものであり、また、ローパスフィルタ部１１２により生成された曲線経路に基づくものである。
　ローパスフィルタ部１１２は、複数の指令点の間を結んで得られる複数の微小線分から構成される経路に対してローパスフィルタによるスムージングを施すことでスムージング経路を生成する。ローパスフィルタ部１１２は、複数の微小線分から構成される経路に対してローパスフィルタを掛ける際に、複数の微小線分から構成される経路を、例えばパラメトリック曲線Ｐ（ｔ）として定める。ここで、Ｐ（ｔ）は各軸の座標値を要素とするベクトルであり、ベクトルの次元は軸数と一致する。例えば、産業機械２がＸ軸、Ｙ軸、Ｚ軸により工具とワークとを相対移動させている場合には、Ｐ（ｔ）は３次元のベクトルとなる。ｔはパラメトリック曲線のパラメータである。制御用プログラム２００により指令された経路をパラメトリック曲線で表す方法については公知の技術であるため割愛する。このように定義した場合、経路Ｐ（ｔ）に対してスムージング処理を施した曲線経路をＱ（ｔ）とすると、Ｑ（ｔ）は以下の数１式で計算することができる。なお、数１式においてＦ（ｌ）はローパスフィルタによるフィルタ操作を表す。ローパスフィルタとしては、例えば公知の移動平均フィルタやガウス畳み込みフィルタなどを用いることができる。この時、ｌはフィルタの適用範囲（フィルタ長）を表すパラメータである。フィルタ長は、指令経路に沿った工具の移動時間や移動距離、移動速度、及びフィルタによって定まる時定数の少なくともいずれかに基づいて計算すればよい。経路を構成する微小線分の長さ程度（パラメトリック曲線のパラメータｔが時間の単位である場合には、微小線分の移動に係る時間程度）にフィルタ長を設定することで、多角形の経路を十分に滑らかにすることができる。制御用プログラム２００が微小線分で表される場合は、フィルタ長は一般に線分長より長い範囲で適用する。この線分長はフィルタ処理の前に予めチェックしても良いし、別途与えても良い。
Figure JPOXMLDOC01-appb-M000001
　ローパスフィルタ部１１２がスムージングに用いるローパスフィルタとしては、他の公知のローパスフィルタを用いてもよい。
　内回り量計算部１１４は、複数の指令点の間を結んで得られる複数の微小線分から構成される経路に対してローパスフィルタ部１１２がローパスフィルタを掛けることで生成されるスムージング経路がどの程度内回るのか、その内回り量を計算する。
　内回り量計算部１１４は、例えば複数の微小線分から構成される経路と、スムージング経路との間で単純に差分を取ることで内回り量を計算してもよい。例えば、以下に例示する数２式を用いて、所定のパラメータ周期で内回り量を計算するようにしてよい。なお、数２式において、ｄ（ｔ）は所定のパラメータの位置における内回り量（スカラー値）である。
Figure JPOXMLDOC01-appb-M000002
　図３は、複数の微小線分から構成される経路に対するスムージング経路の内回り量を例示する図である。図３では、指令点４２２を黒丸で、微小線分４２４を点線矢印で、スムージング経路４２６を実線矢印で示している。なお、図３は内回り量を把握しやすくするために、現実よりもスムージング経路が大きく内回るように描画している。図３に例示するように、微小線分から構成される経路と、スムージング経路との間で単純に差分を取った内回り量を計算する場合、例えば指令点４２２の位置における内回り量や、指令点４２２間の所定のパラメータｔの値の位置における内回り量を算出することができる。
　内回り量計算部１１４は、例えば指令点４２２の位置における内回り量のみを数２式を用いて計算し、他の位置における内回り量を比例配分などで計算するようにしてもよい。例えば、所定の指令点の位置におけるパラメータｔの値がｔｓ、その次の指令点の位置におけるパラメータｔの値がｔｅであるとする。この時、以下の数３式に示す値ａが一意に定まる。
Figure JPOXMLDOC01-appb-M000003
　この値ａを用いて、指令点間における所定の位置の内回り量を以下の数４式で計算するようにすればよい。
Figure JPOXMLDOC01-appb-M000004
　内回り量計算部１１４は、例えばスムージング曲線の曲率に基づいて、近似的に内回り量を計算するようにしてもよい。スムージング曲線Ｑ（ｔ）の所定の位置における曲率半径Ｒ（ｔ）は、パラメトリック曲線から公知の解析的手法又は近似的手法により求めることができる。この曲率半径Ｒ（ｔ）の円弧経路をＣｉｒｃｌｅ（Ｒ）とした時、内回り量ｄ（ｔ）は以下の数５式を満たす。この数５式をｄ（ｔ）について解析的または近似的に解くことで、内回り量を計算することができる。
Figure JPOXMLDOC01-appb-M000005
　スムージング処理部１１０は、このようにして内回り量計算部１１４が計算する内回り量に基づいて、ローパスフィルタ部１１２により生成されたスムージング経路を補正することで、指令点近傍を通るスムージング経路を生成するようにしてもよい。他の手法としては、内回り量計算部１１４が計算する内回り量に基づいて、予め指令点を移動させた補正点を計算する。そして、この複数の補正点の列から構成される補正後の移動経路に対してローパスフィルタ部１１２によりフィルタを掛けることで、指令点近傍を通るスムージング経路を生成するようにしてもよい。
　モータ制御部１２０は、スムージング処理部１１０により生成されたスムージング経路に沿って工具とワークとが相対的に移動するように産業機械２が備えるサーボモータ５０を制御する。
　上記構成を備えた本開示の一態様により、滑らかであり、かつ高精度な（内回りによる精度低下がない）経路が得られる。そのため、加工面が滑らかであり、かつ形状精度が悪化しない加工ワークが得られる。
　図４は、本発明の第２実施形態による制御装置１が備える機能を概略的なブロック図として示したものである。本実施形態による制御装置１が備える各機能は、図１に示した制御装置１が備えるＣＰＵ１１がシステム・プログラムを実行し、制御装置１の各部の動作を制御することにより実現される。
　本実施形態の制御装置１は、解析部１００、スムージング処理部１１０、ローパスフィルタ部１１２、内回り量計算部１１４、モータ制御部１２０に加えて、更に引き戻し補正部１１６を備える。また、制御装置１のＲＡＭ１３乃至不揮発性メモリ１４には、予め産業機械２の運転を制御するための制御用プログラム２００が記憶されている。
　解析部１００、ローパスフィルタ部１１２、内回り量計算部１１４、モータ制御部１２０が備える各機能は、第１実施形態による制御装置１が備える各機能と同様である。
　本実施形態によるスムージング処理部１１０は、複数の指令点に対して内回りが生じたスムージング経路を、引き戻し補正部１１６により内回る方向とは逆方向に補正することで、スムージング曲線を生成する。言い換えると、スムージング経路の曲率中心方向ベクトル（主法線ベクトル）と逆方向に補正する。本明細書では、この内回る方向とは逆方向に補正することを引き戻し補正と称する。
　引き戻し補正部１１６は、スムージング処理部１１０が生成したスムージング経路に対して引き戻し補正をしたスムージング曲線を生成する。引き戻し補正部１１６は、例えば内回り量計算部１１４が計算した内回り量をそのまま使用して引き戻し補正をしてもよい。例えば、スムージング曲線Ｑ（ｔ）の各位置における曲率中心をＱＣ（ｔ）とする。この場合における曲率単位ベクトルｅｑ（ｔ）は、以下の数６式で示すことができる。
Figure JPOXMLDOC01-appb-M000006
　この場合において、引き戻しベクトルｈ（ｔ）は、以下の数７式で計算することができる。
Figure JPOXMLDOC01-appb-M000007
　そして、引き戻し補正部１１６は、以下の数８式で引き戻し補正後のスムージング曲線Ｓ（ｔ）を算出することができる。
Figure JPOXMLDOC01-appb-M000008
　スムージング処理部１１０は、このようにして得られた引き戻し補正後のスムージング曲線Ｓ（ｔ）を最終的な経路としてモータ制御部１２０へ出力する。
　引き戻し補正部１１６は、引き戻しベクトルｈ（ｔ）の計算時に、以下の数９式に示すように平滑化の処理を行うようにしてもよい。数９式において、Ｆ（ｌ）はローパスフィルタによるフィルタ操作を表し、ｌはフィルタの適用範囲（フィルタ長）を表すパラメータである。このフィルタＦ（ｌ）は、ローパスフィルタ部１１２が用いるフィルタと同じものであってもよいし、異なるものであってもよい。
Figure JPOXMLDOC01-appb-M000009
　上記構成を備えた本開示の一態様により、ローパスフィルタによる内回り量を計算し、計算した内回り量を用いてスムージング曲線の補正を行うことができるので、滑らかであり、かつ高精度な（内回りによる精度低下がない）経路が得られる。そのため、加工面が滑らかであり、かつ形状精度が悪化しない加工ワークが得られる。
　図５は、本発明の第３実施形態による制御装置１が備える機能を概略的なブロック図として示したものである。本実施形態による制御装置１が備える各機能は、図１に示した制御装置１が備えるＣＰＵ１１がシステム・プログラムを実行し、制御装置１の各部の動作を制御することにより実現される。
　本実施形態の制御装置１は、解析部１００、スムージング処理部１１０、ローパスフィルタ部１１２、内回り量計算部１１４、モータ制御部１２０に加えて、更に事前引き戻し補正部１１８を備える。また、制御装置１のＲＡＭ１３乃至不揮発性メモリ１４には、予め産業機械２の運転を制御するための制御用プログラム２００が記憶されている。
　解析部１００、ローパスフィルタ部１１２、内回り量計算部１１４、モータ制御部１２０が備える各機能は、第１実施形態による制御装置１が備える各機能と同様である。
　本実施形態によるスムージング処理部１１０は、スムージング処理を行う前の複数の指令点に対して、事前引き戻し補正部１１８により内回った方向とは逆方向に補正した補正点を生成する。そして、この複数の補正点に対してローパスフィルタ部１１２によりスムージングをすることで、スムージング曲線を生成する。
　事前引き戻し補正部１１８は、スムージング処理を行う前の複数の指令点に対して事前に引き戻し補正を行う。以下、事前に引き戻し補正を行う手法について説明する。指令経路をパラメトリック曲線Ｐ（ｔ）とし、その各位置における曲率半径をＲＰ（ｔ）とする。経路が微小線分で与えられる時、Ｐ（ｔ）は多角形的となる。この場合、局所的に曲率を求めるのではなく、ある程度の範囲の平均的な形状情報から曲率を求める。一般には、多項式によるフィッティングなどを用いることで、各位置における曲率を求めることができる。例えば、半径Ｒの円弧経路をＣｉｒｃｌｅ（Ｒ）で示すとする。この時、内回り量は以下の数１０式で計算できる。
Figure JPOXMLDOC01-appb-M000010
　また、Ｐ（ｔ）の各位置における曲率中心をＰＣ（ｔ）とする。この場合における曲率単位ベクトルｅｐ（ｔ）は、以下の数１１式で示すことができる。
Figure JPOXMLDOC01-appb-M000011
　このようにして求めたｄ（ｔ）及びｅｐ（ｔ）を用いて、以下の数１２式で事前引き戻しベクトルｈpre（ｔ）を計算することができる。
Figure JPOXMLDOC01-appb-M000012
　そして、数１３式を用いて、事前引き戻しベクトルｈpre（ｔ）を用いてＰ（ｔ）を事前に引き戻し補正を行うことで、補正された指令経路Ｓ（ｔ）を計算する。
Figure JPOXMLDOC01-appb-M000013
　スムージング処理部１１０は、この補正された指令経路Ｓ（ｔ）に対してローパスフィルタ部１１２によりスムージングをすることですることで、スムージング曲線を生成する。
　上記構成を備えた本開示の一態様により、事前に内回り量を計算し、計算した内回り量を用いて指令点の補正を行う。そして、補正された複数の指令点に対してスムージングを行うため、滑らかであり、かつ高精度な（内回りによる精度低下がない）経路が得られる。スムージング曲線を計算してから補正を行う場合と比較して、計算量の低減も見込まれる。
　以上、本発明の実施形態について説明したが、本発明は上述した実施の形態の例のみに限定されることなく、適宜の変更を加えることにより様々な態様で実施することができる。
　例えば、上記した実施形態では制御用プログラム２００により複数の指令点の列が経路として示されている例を示した。そのため、指令点の間が微小線分であることを前提とした説明となっている。しかしながら、制御用プログラム２００により指令点の間の経路が微小線分だけでなく、微小円弧、所定のパラメトリック曲線などで明示的に経路が指定されている場合においても、本願発明を適用することは可能である。
　また、上記した実施形態では、内回り量の計算に用いる各値を指令経路やスムージング経路から計算していたが、例えば指令経路の各部における曲率は、予め制御用プログラム２００の各ブロックに付随的に設定されるようにしてもよい。このような情報を付加する処理は、予めＣＡＤ／ＣＡＭの側で予め行うようにすることができる。このように構成することで、スムージング処理を行う際の制御装置１における計算負荷を低減させることができる。
　また、上記した実施形態では、１つの計算パスでスムージング経路を生成している。しかしながら、一度スムージング経路を生成した後に、同様の処理を繰り返してスムージング経路を生成するようにしてもよい。例えば、一度作成したスムージング経路を繰り返しスムージング処理部１１０によりスムージングを行う。この過程を複数回繰り返す。そして、繰り返すたびに用いるローパスフィルタのフィルタ長をより短くすることで、内回り量と引き戻し量を低減していき、引き戻し後経路の精度を高めることができる。この場合、例えば図６に例示するように、トレランスチェック部１１９を設けてもよい。トレランスチェック部１１９に、予め所定のトレランス（許容誤差）を設定しておく。トレランスチェック部１１９は、スムージング処理部１１０によるスムージング処理が行われるたびに、指令経路に対するスムージング経路の変更量（平均変更量、又は最大変更量）がトレランス内に収まっているかチェックを行う。そして、トレランス内に収まらない場合に、スムージング処理を繰り返すようにすればよい。この手法を用いる場合、引き戻し補正部１１６が出力した経路を最終的なスムージング経路として出力してもよいし（第２実施形態）、ローパスフィルタ部１１２の出力を最終的なスムージング経路として出力してもよい（第２、第３実施形態）。
　　　１　制御装置
　　　２，４　産業機械
　　　５　ネットワーク
　　　６　フォグコンピュータ
　　　７　クラウドサーバ
　　１１　ＣＰＵ
　　１２　ＲＯＭ
　　１３　ＲＡＭ
　　１４　不揮発性メモリ
　　１５，１７，１８，２０　インタフェース
　　２２　バス
　　３０　軸制御回路
　　４０　サーボアンプ
　　５０　サーボモータ
　　７０　表示装置
　　７１　入力装置
　　７２　外部機器
　１００　解析部
　１１０　スムージング処理部
　１１２　ローパスフィルタ部
　１１４　内回り量計算部
　１１６　引き戻し補正部
　１１８　事前引き戻し補正部
　１１９　トレランスチェック部
　１２０　モータ制御部
　２００　制御用プログラム

Claims (12)

  1. 　制御用プログラムに基づいて産業機械によるワークの加工を制御する制御装置であって、
    　前記制御用プログラムにより指令された指令経路に対してローパスフィルタによるスムージングを施すことでスムージング経路を生成するローパスフィルタ部と、
    　前記ローパスフィルタ部によって得られるスムージング経路の、前記指令経路に対して内回る内回り量を計算する内回り量計算部と、
    　前記内回り量に基づいて、前記スムージング経路が前記内回る方向と逆方向へ引き戻された経路を出力するスムージング処理部と、
    を備える制御装置。
  2. 　前記スムージング処理部は、
    　前記ローパスフィルタ部が生成したスムージング経路を、前記内回り量計算部が計算した前記内回り量の分だけ、前記内回る方向と逆方向へ引き戻す補正を行う引き戻し補正部を備え、
    　前記引き戻し補正部が補正した経路を出力する、
    請求項１に記載の制御装置。
  3. 　前記スムージング処理部は、
    　前記指令経路を、前記内回り量計算部が計算した前記内回り量の分だけ、前記内回る方向と逆方向へ事前に引き戻す補正を行う事前引き戻し補正部を備え、
    　前記事前引き戻し補正部が補正した指令経路を前記ローパスフィルタ部によりスムージングを施したスムージング経路を出力する、
    請求項１に記載の制御装置。
  4. 　前記内回り量計算部は、前記指令経路と、前記スムージング経路との差分を内回り量とする、
    請求項１に記載の制御装置。
  5. 　前記内回り量計算部は、前記制御用プログラムにより指令される複数の指令点と、前記スムージング経路との差分に基づいて内回り量を計算する、
    とする、
    請求項１に記載の制御装置。
  6. 　前記内回り量計算部は、前記指令経路の曲率と、前記ローパスフィルタのフィルタ長とに基づいて内回り量を計算する、
    請求項１に記載の制御装置。
  7. 　前記指令経路の曲率は、前記スムージング経路の曲率を用いて計算する、
    請求項６に記載の制御装置。
  8. 　前記指令経路の曲率は、前記制御用プログラムに付随する情報として指定されている、
    請求項６に記載の制御装置。
  9. 　前記フィルタ長は、前記指令経路に沿った移動速度及び前記ローパスフィルタの時定数の少なくともいずれかに基づいて計算する、
    請求項６に記載の制御装置。
  10. 　前記スムージング処理部は、出力した経路に対して前記内回り量計算部及び前記ローパスフィルタ部を用いたスムージング処理を繰り返し行う、
    請求項１に記載の制御装置。
  11. 　経路変更量が指定されたトレランス以内となっているかチェックするトレランスチェック部を更に備え、
    　前記スムージング処理部は、前記トレランスチェック部により前記経路変更量が指定されたトレランス以内となるまで、スムージング処理を繰り返し行う、
    請求項１０に記載の制御装置。
  12. 　制御用プログラムに基づいて産業機械によるワークの加工を制御する制御装置を動作させるプログラムを記録したコンピュータ読み取り可能な記録媒体であって、
    　前記制御用プログラムにより指令された指令経路に対してローパスフィルタによるスムージングを施すことでスムージング経路を生成するローパスフィルタ部と、
    　前記ローパスフィルタ部によって得られるスムージング経路の、前記指令経路に対して内回る内回り量を計算する内回り量計算部と、
    　前記内回り量に基づいて、前記スムージング経路が前記内回る方向と逆方向へ引き戻された経路を出力するスムージング処理部として、
    制御装置を動作させるプログラムを記録したコンピュータ読み取り可能な記録媒体。
PCT/JP2021/037434 2021-10-08 2021-10-08 制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体 WO2023058243A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
PCT/JP2021/037434 WO2023058243A1 (ja) 2021-10-08 2021-10-08 制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体
DE112021007992.1T DE112021007992T5 (de) 2021-10-08 2021-10-08 Steuergerät und computerlesbares Aufzeichnungsmedium mit Speicherprogramm
CN202180102937.8A CN118043750A (zh) 2021-10-08 2021-10-08 控制装置以及记录有程序的计算机可读取的记录介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2021/037434 WO2023058243A1 (ja) 2021-10-08 2021-10-08 制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体

Publications (2)

Publication Number Publication Date
WO2023058243A1 true WO2023058243A1 (ja) 2023-04-13
WO2023058243A9 WO2023058243A9 (ja) 2024-03-07

Family

ID=85804089

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/037434 WO2023058243A1 (ja) 2021-10-08 2021-10-08 制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体

Country Status (3)

Country Link
CN (1) CN118043750A (ja)
DE (1) DE112021007992T5 (ja)
WO (1) WO2023058243A1 (ja)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09160623A (ja) * 1995-12-06 1997-06-20 Toyoda Mach Works Ltd 工作物加工用数値制御装置
JPH10240328A (ja) * 1997-02-21 1998-09-11 Mitsubishi Electric Corp 数値制御装置
JP2001117617A (ja) * 1999-10-22 2001-04-27 Okuma Corp 数値制御装置
JP2005309990A (ja) * 2004-04-23 2005-11-04 Toyota Motor Corp 経路設定方法
US7444202B2 (en) * 2003-12-10 2008-10-28 Dr. Johannes Heidenhain Gmbh Method for smoothing polylines in NC programs
JP2010511919A (ja) * 2005-03-23 2010-04-15 ハーコ カンパニーズ，インコーポレイテッド 許容差ベースの経路設計と制御の方法
JP2014167684A (ja) * 2013-02-28 2014-09-11 Mitsubishi Electric Corp 数値制御装置
WO2016067392A1 (ja) * 2014-10-29 2016-05-06 株式会社牧野フライス製作所 工具経路の生成方法および工作機械

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3466111B2 (ja) 1999-06-10 2003-11-10 ファナック株式会社 数値制御装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09160623A (ja) * 1995-12-06 1997-06-20 Toyoda Mach Works Ltd 工作物加工用数値制御装置
JPH10240328A (ja) * 1997-02-21 1998-09-11 Mitsubishi Electric Corp 数値制御装置
JP2001117617A (ja) * 1999-10-22 2001-04-27 Okuma Corp 数値制御装置
US7444202B2 (en) * 2003-12-10 2008-10-28 Dr. Johannes Heidenhain Gmbh Method for smoothing polylines in NC programs
JP2005309990A (ja) * 2004-04-23 2005-11-04 Toyota Motor Corp 経路設定方法
JP2010511919A (ja) * 2005-03-23 2010-04-15 ハーコ カンパニーズ，インコーポレイテッド 許容差ベースの経路設計と制御の方法
JP2014167684A (ja) * 2013-02-28 2014-09-11 Mitsubishi Electric Corp 数値制御装置
WO2016067392A1 (ja) * 2014-10-29 2016-05-06 株式会社牧野フライス製作所 工具経路の生成方法および工作機械

Also Published As

Publication number Publication date
DE112021007992T5 (de) 2024-05-02
WO2023058243A9 (ja) 2024-03-07
CN118043750A (zh) 2024-05-14

Similar Documents

Publication Publication Date Title
EP1720085B1 (en) Curve interpolating method
US20090228138A1 (en) Numerical controller controlling five-axis processing machine
JP5037704B2 (ja) ３軸加工機用ワーク設置誤差補正部を有する数値制御装置
JP2010511919A (ja) 許容差ベースの経路設計と制御の方法
JP6646027B2 (ja) ポストプロセッサ装置、加工プログラム生成方法、ｃｎｃ加工システム及び加工プログラム生成用プログラム
JP6585666B2 (ja) 速度一定が要求されるアプリケーションにおいて学習制御を行うロボット及びその制御方法
JP4796936B2 (ja) 加工制御装置
JP6242539B1 (ja) 数値制御装置
JP6363642B2 (ja) 接線連続のコーナにおけるコーナ経路の最適化機能を有する数値制御装置
US10691091B2 (en) Controller and machine learning device
JP3350569B2 (ja) 数値制御装置
WO2023058243A1 (ja) 制御装置及びプログラムを記録したコンピュータ読み取り可能な記録媒体
JP4900968B2 (ja) 加工制御装置
JP6490118B2 (ja) 数値制御装置
JP6823032B2 (ja) プログラム修正装置
JP2020003958A (ja) 数値制御装置
WO2022138843A9 (ja) 数値制御装置
WO2021230237A1 (ja) 加工経路作成装置
JP7355951B1 (ja) 制御装置及びコンピュータ読み取り可能な記録媒体
JPH1148176A (ja) ロボット位置教示装置
WO2022264338A1 (ja) 制御装置、干渉チェック装置、及び制御システム
WO2023026484A1 (ja) 評価用プログラム作成装置、及びプログラムを記録したコンピュータ読み取り可能な記録媒体
JP6923736B2 (ja) 数値制御装置
JP6640822B2 (ja) 数値制御装置
WO2022075223A1 (ja) 制御装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21959982

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2023552672

Country of ref document: JP

WWE Wipo information: entry into national phase

Ref document number: 112021007992

Country of ref document: DE