Time information t and positional information about each axis are obtained, and the three-dimensional coordinates of tool center point Pe at time t are calculated to display the path of the tool center point Pe at time t. Then, whether a fixed time has elapsed or not is decided. If the fixed time has elapsed, the coordinates of the tool vector start point Ps at time t are calculated to display a line segment connecting between tool vector start point Ps and tool center point Pe, which is the end point of the tool vector. This display enables the orientation of the tool at each tool center point to be grasped at a glance.
|
1. A tool vector display apparatus for a machine tool that performs machining by using a plurality of drive axes including at least one rotational axis to control positions and orientations of a tool and a workpiece, the apparatus comprising:
a data acquiring unit that concurrently acquires actual positional information about the drive axes at different times, detected by detectors mounted on the drive axes;
a tool path display unit that calculates three-dimensional coordinates, viewed from a coordinate system fixed to the workpiece, of a tool center point of the tool from the actual positional information and information about a mechanical structure of the machine tool, and displays a three-dimensional path of the tool center points by using the three-dimensional coordinates; and
a tool vector display unit that calculates three-dimensional coordinates of a tool vector start point, which is a point away from the tool center point toward a root thereof by an amount of a preset distance, viewed from the coordinate system fixed to the workpiece, from the actual positional information and the information about the mechanical structure of the machine tool, and displays a line segment connecting between the tool vector start point and the tool center point, as a tool vector, on the three-dimensional path of the tool center points.
2. The tool vector display apparatus according to
3. The tool vector display apparatus according to
4. The tool vector display apparatus according to
5. The tool vector display apparatus according to
line-formulae description="In-line Formulae" end="lead"?>PosX=x(t)+L×cos (a(t))×sin (b(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosY=y(t)+L×sin (a(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosZ=z(t)−L×cos (a(t))×cos (b(t)line-formulae description="In-line Formulae" end="tail"?> and three-dimensional coordinates of the tool vector start point (PosX′(t), PosY′(t), PosZ′(t)) is calculated by the following equations;
line-formulae description="In-line Formulae" end="lead"?>PosX′=x(t)+(L−d)×cos (a(t))×sin (b(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosY′=y(t)+(L−d)×sin (a(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosZ′=z(t)−(L−d)×cos (a(t))×cos (b(t)),line-formulae description="In-line Formulae" end="tail"?> where x(t), y(t) and z(t) are X-, Y- and Z-axis coordinate values of intersections of two central axes around which each of the two rotational axes (A axis and B axis) rotate, at time t, and a(t) and b(t) are A- and B-axis coordinate values at time t, L is a tool length, and d is a preset distance.
6. The tool vector display apparatus according to
line-formulae description="In-line Formulae" end="lead"?>PosX=x(t)×cos (c(t))−y(t)×cos (a(t))×sin (c(t))−z(t)×sin (a(t))×sin (c(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosY=x(t)×sin (c(t))+y(t)×cos (a(t))×cos (c(t))+z(t)×sin (a(t))×cos (c(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosZ=−y(t)×sin (a(t))+z(t)×cos (a(t))line-formulae description="In-line Formulae" end="tail"?> and three-dimensional coordinates of the tool vector start point (PosX′(t), PosY′(t), PosZ′(t)) is calculated by the following equations;
line-formulae description="In-line Formulae" end="lead"?>PosX′=x(t)×cos (c(t))−y(t)×cos (a(t))×sin (c(t))−(z(t)+d)×sin (a(t))×sin (c(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosY′=x(t)×sin (c(t))+y(t)×cos (a(t))×cos (c(t))+(z(t)+d)×sin (a(t))×cos (c(t))line-formulae description="In-line Formulae" end="tail"?> line-formulae description="In-line Formulae" end="lead"?>PosZ′=−y(t)×sin (a(t))+z(t)×cos (a(t)),line-formulae description="In-line Formulae" end="tail"?> where x(t), y(t) and z(t) are X-, Y- and Z-axis coordinate values of the tool center point at time t in coordinate system fixed to a space, and a(t) and c(t) are A- and C-axis coordinate values at time t, L is a tool length, and d is a preset distance.
|
The present application is based on, and claims priority from, Japanese Application Number 2009-189818, filed Aug. 19, 2009, the disclosure of which is hereby incorporated by reference herein in its entirety.
1. Field of the Invention
The present invention relates to an apparatus for displaying tool vectors of a tool in a machine tool with rotational axes and, more particularly, to a tool vector display apparatus used for a machine tool to display a line segment connecting between a tool center point and a point on the central axis of the tool at a certain distance away from the tool center point, as a tool vector, on a path of the tool center points.
2. Description of the Related Art
Some currently-used numerical controllers for controlling machine tools have a function to display a commanded path or a function to display a path on which the tool actually has moved. For example, Japanese Patent Application Laid-Open No. 7-72914 discloses a tool path display apparatus for CAD/CAM systems that displays a three-dimensional path of the tool center points and changes the color or width of lines according to the tool speed.
In a 5-axis machine tool, which includes rotational axes, the orientation of the tool changes in various directions during machining. A workpiece may be machined by the tool side rather than the tool end, so the relation between the machined surface and the motion of the tool cannot be sufficiently verified only from the tool end path.
A technique for displaying tool vectors using data created by CAD or the like is disclosed in, for example, Japanese Patent Application Laid-Open No. 7-72914. However, this technique does not use actual feedback information, so comparison with machining failure points on a workpiece is not possible and thereby this technique is not useful for adjusting a 5-axis machine tool or finding the places of failures.
An object of the present invention is to provide a tool vector display apparatus for a machine tool that performs machining by driving a plurality of drive axes including at least one rotational axis to control the positions and orientations of a tool and workpiece, wherein the tool vector display apparatus is capable of displaying the orientation of the tool relative to the workpiece at points on a path of tool center points by using actual feedback information in a visually intuitive manner.
To achieve the above object, the tool vector display apparatus for a machine tool that performs machining by using a plurality of drive axes including at least one rotational axis to control the positions and orientations of a tool and workpiece comprises: a data acquiring unit that concurrently acquires actual positional information about the drive axes at different times; a tool path display unit that calculates three-dimensional coordinates, viewed from a coordinate system fixed to the workpiece, of a tool center point of the tool from the actual positional information and information about a mechanical structure of the machine tool, and displays a three-dimensional path of the tool center points by using the three-dimensional coordinates; and a tool vector display unit that calculates three-dimensional coordinates of a tool vector start point, which is a point away from the tool center point toward a root thereof by an amount of a preset distance, viewed from the coordinate system fixed to the workpiece, from the actual positional information and the information about the mechanical structure of the machine tool, and displays a line segment connecting between the tool vector start point and the tool center point, as a tool vector, on the three-dimensional path of the tool center points.
The line segment connecting between the tool vector start point and the tool center point may be displayed at intervals of a preset time.
A cylinder a radius of which is a diameter of the tool may displayed, centered around the line segment connecting between the tool vector start point and the end of the tool.
In a tool vector display apparatus for a machine tool that performs machining by driving a plurality of drive axes including at least one rotational axis to control the positions and orientations of a tool and workpiece, the present invention can provide a tool vector display apparatus that can display the orientation of the tool relative to a workpiece at points on a tool end path by using actual feedback information in a visually intuitive manner.
The purposes and advantages of the present invention, including those described above, will be clarified by referring to the attached drawings in combination with the description of the embodiments described below. Of these drawings:
If the intersection of axes around which the two rotational axes (A and B axes) of the five-axes machine tool, having a rotating tool head as the mechanical structure, rotate is denoted M, the coordinates of M are represented by (x(t), y(t), z(t)) in a coordinate system fixed to the workpiece in which the origin is appropriately set. If the length from the point M to the tool center point is denoted L, a point at which the tool faces right below is a reference point (or the origin) of the axis A and the axis B, then the coordinates (PosX (t), PosY(t), PosZ(t)) of a tool center point Pe are calculated according to the following equations.
PosX=x(t)+L×cos (a(t))×sin (b(t))
PosY=y(t)+L×sin (a(t))
PosZ=z(t)−L×cos (a(t))×cos (b(t)) (1)
If a point on the central axis of the tool away from the tool center point Pe toward the point M by distance d is taken as a tool vector start point Ps, then the coordinates (PosX′(t), PosY′(t), PosX′(t)) of the tool vector start point Ps are calculated according to the following equations.
PosX′=x(t)+(L−d)×cos (a(t))×sin (b(t))
PosY′=y(t)+(L−d)×sin (a(t))
PosZ′=z(t)−(L−d)×cos (a(t))×cos (b(t)) (2)
The tool length L, from the point M to the tool center point Pe, is stored in the numerical controller for the machine tool. As described above, the coordinates of the tool center point Pe and the tool vector start point Ps can be calculated according to the positional information of the five axes and the mechanical structure of the machine tool.
Next, a tool vector display apparatus for a machine tool in an embodiment of the present invention will be described.
A CPU 111, which is a processor, controls a numerical controller 10 entirely according to a system program stored in a ROM 112. A RAM 113 stores various types of data or input/output signals. Data stored in a non-volatile memory 114 is not erased even when power is turned off.
A graphic control circuit 115 converts digital signals into signals used for display purposes and sends the converted signals to a display unit 116. A keyboard 117 has numeric keys and character keys used to enter various settings.
An axis control circuit 118 receives axis moving commands from the CPU 111 and outputs them to a servo amplifier 119. Upon receipt of these moving commands, the servo amplifier 119 drives servo motors (not shown) of a machine tool 20. These constituents are mutually connected through a bus 121.
A programmable machine controller (PMC) 122 receives a T-function signal (tool selection signal) or the like through the bus 121 when a machining program is executed. The PMC processes the signal by using a sequence program and outputs a signal as an operation command to control the machine tool 20. The PMC also receives a status signal from the machine tool 20 and transfers a necessary input signal to the CPU 111.
Also connected to the bus 121 are a software keyboard 123 of which functions change according to the system program or the like and an interface 124 through which NC data is sent to external devices such as a storage device. The software keyboard 123 is disposed on the display unit/MDI (manual data input) panel 125 together with the display unit 116 and keyboard 117.
The machine tool 20 has servo motors 21x, 21y, 21z, 21A, and 21B that drive feed axes. Servo amplifiers (not shown) are controlled by torque commands from a driving axis control unit 11 in the numerical controller 10, and the servo motors 21x, 21y, 21z, 21A, and 21B are driven by the servo amplifiers. The servo motors 21x, 21y, 21z, 21A, and 21B each has a position/speed detector (not shown), which sends positional information and speed information about the relevant servo motor to the driving axis control unit 11.
The driving axis control unit 11 sends positional information Sa, speed information Sb, acceleration information Sc, position deviation information Sd, and a torque command Se to the data acquiring unit 12. The data acquiring unit 12 concurrently acquires these information items from the driving axis control unit 11 at intervals of a fixed time. The acquired information is stored in a memory (not shown). The display unit 13 displays a three-dimensional movement path of the tool center points in a tool path display area, and also displays tool vectors in the tool vector display area in time series.
[Step S1] Time information t and positional information about each axis, corresponding to the time information t, are acquired.
[Step S2] The three-dimensional coordinates of the tool center point Pe corresponding to the time information t obtained in step S1 are calculated.
[Step S3] The path of the tool center point Pe is calculated from its three-dimensional coordinates obtained in step S2 and displayed on the display unit.
[Step S4] Whether a ‘predetermined time’ has elapsed or not is decided. If the predetermined time has elapsed, the sequence proceeds to step S5. If not, the sequence proceeds to step S7.
At this step, whether a predetermined time has elapsed or not is decided because tool vectors 230 are displayed at intervals of a fixed time in the case of the present invention (see
[Step S5] The coordinates of the tool vector start point Ps corresponding to the time information t are calculated according to a calculating formula that corresponds to the mechanical structure of the machine tool.
[Step S6] A line segment connecting between the tool vector start point Ps and the tool center point Pe, which is the end point of the tool vector, is displayed on the display unit.
[Step S7] It is determined whether or not the workpiece has been machined by the machine tool or whether or not there is a signal indicating that the display processing has been completed. If the workpiece has been machined or there is a display end signal (the result is YES), the display processing is terminated. If the workpiece has not been completed and there is no display end signal (the result is NO), on the other hand, the sequence proceeds to step S8.
[Step S8] Waiting until a sampling time for displaying the path of the tool center points Pe on the display unit has elapsed, the sequence returns to step S1 and the display processing is continued. The sampling time is shorter than the ‘predetermined time’ used for the decision in step S4. In this step as well, a timer function can be used to confirm that the sampling time has elapsed.
When the processing in the flowchart shown in
The present invention can display, in the tool vector display area on the display unit 13, tool vectors with lengths that enable their behavior to be visually recognized with ease. If, for example, long tool vectors were displayed and oriented in various directions, the roots of respective tools 23 displayed would intersect with each other, thereby lowering visibility thereof. However, such problem can be prevented by the present invention. The workpiece shape defined in the machining program may be displayed as shown in
First, points are plotted at intervals of a fixed time on the path of the tool center points to be displayed in the vector display area on the display unit 13. The tool vector start point Ps corresponding to each point is then obtained, and a line segment connecting between the obtained tool vector start point Ps and its corresponding tool center point Pe, which is the end point of the tool vector, is drawn. The resulting tool vectors 230 shown in
The machine tool to which the tool vector display apparatus in the first or second embodiment described above is applied is a five-axis machine tool with a rotating tool head, as shown in
Now, two coordinate systems will be considered. A first coordinate system is fixed in a space, with its origin being a point M, and a second coordinate system is fixed to the table 22 with its origin also being the point M. The point M remains at the same position even when the A and C axes rotate, so the origin of the first coordinate system always matches the origin of the second coordinate system. If the coordinates of the A and C axes at time t are respectively denoted a(t) and c(t), when a(t) is 0 and c(t) is also 0, the first coordinate and the second coordinate mutually match.
If the coordinates of the tool center point at time t in coordinate system 1 fixed to the space are denoted (x(t), y(t), z(t)), then the coordinates (PosX(t), PosY(t), PosZ(t)) of the tool center point Pe in coordinate system 2 can be calculated according to the following equations.
PosX=x(t)×cos (c(t))−y(t)×cos (a(t))×sin (c(t))−z(t)×sin (a(t))×sin (c(t))
PosY=x(t)×sin (c(t))+y(t)×cos (a(t))×cos (c(t))+z(t)×sin (a(t))×cos (c(t))
PosZ=−y(t)×sin (a(t))+z(t)×cos (a(t)) (3)
If a point on the central axis of the tool away from the tool center point Pe toward the root of the tool by d is taken as the tool vector start point Ps, then the coordinates (PosX′(t), PosY′(t), PosX′(t)) are calculated according to the following equations.
PosX′=x(t)×cos (c(t))−y(t)×cos (a(t))×sin (c(t))−(z(t)+d)×sin (a(t))×sin (c(t))
PosY′=x(t)×sin (c(t))+y(t)×cos (a(t))×cos (c(t))+(z(t)+d)×sin (a(t))×cos (c(t))
PosZ′=−y(t)×sin (a(t))+z(t)×cos (a(t)) (4)
As described above, the present invention can display tool vectors on the display unit by calculating the coordinates of their start points and end points in the same way as for the five-axis machine tool with a rotating tool head.
Tezuka, Junichi, Iwashita, Yasusuke, Okita, Tadashi, Sugiyama, Kazuyuki
Patent | Priority | Assignee | Title |
8432120, | Jul 12 2010 | Fanuc Corporation | Tool path display apparatus with deceleration factor identification means for machine tool |
8483865, | Feb 18 2010 | Fanuc Corporation | Numerical controller with tool trajectory display function |
9098077, | Aug 25 2010 | Mitsubishi Electric Corporation | Trajectory control device |
9304507, | Aug 25 2011 | Fanuc Corporation | Tool path display apparatus having display unit for acceleration or jerk of tool tip point |
9483042, | Dec 25 2012 | Fanuc Corporation | Load display device for machine tool |
9964939, | Apr 28 2015 | Fanuc Corporation | Trajectory display device for displaying trajectory of tool axis |
Patent | Priority | Assignee | Title |
5396160, | Mar 11 1991 | General Motors Corporation | Method of real-time machine path planning from a math model |
5835693, | Jul 22 1994 | IOWA STATE UNIVERSITY RESEARCH FOUNDATION, INC | Interactive system for simulation and display of multi-body systems in three dimensions |
5995109, | Apr 08 1997 | AVAGO TECHNOLOGIES GENERAL IP SINGAPORE PTE LTD | Method for rendering high order rational surface patches |
6704611, | Aug 21 2001 | TRUEMILL, INC | System and method for rough milling |
6853881, | Apr 05 2001 | Fanuc Ltd. | Robot information processing system |
7853351, | Feb 21 2002 | CNC machine tool and integrated machine tool controller incorporating 3D and up to 8-axes real time interactive tool compensation | |
8010302, | Jul 14 2009 | Fanuc Ltd | Tool path display apparatus for machine tool |
8018192, | Sep 10 2009 | Fanuc Ltd | 3D-trajectory display device for machine tool |
20020002420, | |||
JP772914, | |||
JP9062328, | |||
JP962328, | |||
WO9727521, |
Executed on | Assignor | Assignee | Conveyance | Frame | Reel | Doc |
Apr 22 2010 | IWASHITA, YASUSUKE | Fanuc Ltd | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 024481 | /0267 | |
Apr 22 2010 | OKITA, TADASHI | Fanuc Ltd | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 024481 | /0267 | |
Apr 22 2010 | TEZUKA, JUNICHI | Fanuc Ltd | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 024481 | /0267 | |
Apr 22 2010 | SUGIYAMA, KAZUYUKI | Fanuc Ltd | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 024481 | /0267 | |
Jun 03 2010 | Fanuc Ltd. | (assignment on the face of the patent) | / |
Date | Maintenance Fee Events |
Nov 11 2015 | M1551: Payment of Maintenance Fee, 4th Year, Large Entity. |
Nov 15 2019 | M1552: Payment of Maintenance Fee, 8th Year, Large Entity. |
Nov 15 2023 | M1553: Payment of Maintenance Fee, 12th Year, Large Entity. |
Date | Maintenance Schedule |
May 29 2015 | 4 years fee payment window open |
Nov 29 2015 | 6 months grace period start (w surcharge) |
May 29 2016 | patent expiry (for year 4) |
May 29 2018 | 2 years to revive unintentionally abandoned end. (for year 4) |
May 29 2019 | 8 years fee payment window open |
Nov 29 2019 | 6 months grace period start (w surcharge) |
May 29 2020 | patent expiry (for year 8) |
May 29 2022 | 2 years to revive unintentionally abandoned end. (for year 8) |
May 29 2023 | 12 years fee payment window open |
Nov 29 2023 | 6 months grace period start (w surcharge) |
May 29 2024 | patent expiry (for year 12) |
May 29 2026 | 2 years to revive unintentionally abandoned end. (for year 12) |