CN103809507B - There is numerical control system and the numerical control method thereof of coordinate synchronizing function - Google Patents
There is numerical control system and the numerical control method thereof of coordinate synchronizing function Download PDFInfo
- Publication number
- CN103809507B CN103809507B CN201410080486.4A CN201410080486A CN103809507B CN 103809507 B CN103809507 B CN 103809507B CN 201410080486 A CN201410080486 A CN 201410080486A CN 103809507 B CN103809507 B CN 103809507B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- machine
- position coordinate
- processing machine
- robot
- Prior art date
- Legal status (The legal status 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 status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 238000006073 displacement reaction Methods 0.000 claims abstract description 40
- 230000006870 function Effects 0.000 claims description 22
- 239000011159 matrix material Substances 0.000 description 16
- 239000013598 vector Substances 0.000 description 13
- 230000008569 process Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 3
- 241000372285 Isanda Species 0.000 description 2
- 230000009471 action Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000004026 adhesive bonding Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005520 cutting process Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000003801 milling Methods 0.000 description 1
- 238000005498 polishing Methods 0.000 description 1
- 238000005488 sandblasting Methods 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
The present invention relates to have numerical control system and the numerical control method thereof of coordinate synchronizing function, formed by hand-held input device, numerical controller, at least one processing machine and at least one mechanical arm, utilize the arithmetic element calculating processing seat in the plane in numerical controller to put rotation relationship equation and the displacement relation equation between coordinate system and mechanical arm position coordinates system, the coordinate reaching between processing machine and mechanical arm is synchronizeed, write thereby simplify procedure, promote operating efficiency.
Description
Technical Field
The invention relates to a numerical control system with a coordinate synchronization function and a numerical control method thereof.
Background
At present, when the processing machine and the robot are not operated simultaneously in the industry, the processing machine and the robot are operated by using respective independent operating systems, and the coordinates of the processing machine and the robot are not the same, if the tool center point (toolcenter point, TCP) of the processing machine and the robot needs to be moved to the same position point, the processing program belonging to a specific coordinate system needs to be written respectively, and each action of the processing machine or the robot needs to be performed one by using a teaching function, and the position point of each teaching function is different under different coordinate systems due to the difference of the coordinate systems, and when the mutual position coordinates are confirmed, the processing machine and the robot need to be operated by respective operating systems. If the machining conditions are slightly modified, the coordinate determination operation, the programming language, and the teaching point position must be newly performed. In addition, the program languages of the operating systems of the processing machine and the robot arm are different, two operating systems need to be set up in the whole processing process, and the operator needs to be familiar with the two program languages for writing, so that the processing and labor costs are increased, and the whole operation process is more complicated.
Disclosure of Invention
The invention aims to overcome the defects in the prior art and provides a numerical control system with a coordinate synchronization function and a numerical control method thereof.
The purpose of the invention is realized by the following technical scheme:
numerical control system with coordinate synchronization function, including at least a processing machine, at least a robotic arm, a handheld input device and a numerical controller, processing machine and robotic arm are fixed a position along a processing machine position coordinate system and a robotic arm position coordinate system respectively, and processing machine position coordinate system and robotic arm position coordinate system locate in the numerical controller, handheld input device, processing machine and robotic arm electric connection in numerical controller, characteristics: the numerical controller includes:
the user interface is electrically connected with the handheld input device, is used for receiving the positioning instruction of the processing machine and the positioning instruction of the mechanical arm input by the handheld input device, and is used for recording coordinate values obtained by observing at least three selected non-collinear different position points by using a position coordinate system of the processing machine and a position coordinate system of the mechanical arm respectively; and
a core processor electrically connected to the user interface, the core processor being electrically connected to the processing machine and the robot for receiving the positioning command of the processing machine, the positioning command of the robot and the coordinate values obtained by observing the position coordinate system of the processing machine and the position coordinate system of the robot at least three non-collinear different position points through the user interface, calculating a rotation relation equation between the position coordinate system of the processing machine and the position coordinate system of the robot according to the position coordinate system of the processing machine, the position coordinate system of the robot and the coordinate values obtained by observing the position coordinate system of the processing machine and the position coordinate system of the robot at least three non-collinear different position points respectively, calculating a displacement relation equation between the position coordinate system of the processing machine and the position coordinate system of the robot according to the rotation relation equation, the core processor storing the rotation relation equation and the displacement relation equation, controlling the processing machine according to the position coordinate system of the processing machine and the positioning instruction of the processing machine, and controlling the mechanical arm according to the position coordinate system of the mechanical arm, the positioning instruction of the mechanical arm, the rotation relation equation and the displacement relation equation;
wherein the at least three non-collinear different location points are located in a working overlap region of the processing machine and the robot.
Further, in the numerical control system with coordinate synchronization function described above, the core processor includes:
the computing unit is provided with a processing machine position coordinate system and a mechanical arm position coordinate system and used for receiving coordinate values obtained by observing at least three non-collinear different position points respectively by using the processing machine position coordinate system and the mechanical arm position coordinate system and calculating a rotation relation equation and a displacement relation equation of the processing machine position coordinate system and the mechanical arm position coordinate system;
a shared memory electrically connected to the computing unit for receiving and storing the machine position coordinate system, the robot position coordinate system, the rotation relation equation and the displacement relation equation;
the processing machine control module is electrically connected with the handheld input device and the shared memory, receives a positioning instruction of the processing machine, a position coordinate system of the processing machine, a rotation relation equation and a displacement relation equation and is used for controlling the processing machine; and
and the mechanical arm control module is electrically connected with the handheld input device and the shared memory, receives the positioning instruction of the mechanical arm, the position coordinate system of the mechanical arm, the rotation relation equation and the displacement relation equation and controls the mechanical arm.
The invention discloses a numerical control system with a coordinate synchronization function and a numerical control method, which comprises the following steps:
moving a tool center point of a first machine to a first position point, and recording a coordinate value obtained by observing the first position point by using a position coordinate system of the first machine;
moving the tool center point of the second machine to the first position point, and recording the coordinate value obtained by observing the first position point by using the position coordinate system of the second machine;
moving the tool center point of the first machine to a second position point, and recording a coordinate value obtained by observing the second position point by using the position coordinate system of the first machine;
moving the tool center point of the second machine to a second position point, and recording a coordinate value obtained by observing the second position point by using a position coordinate system of the second machine;
moving the tool center point of the first machine to a third position point, and recording a coordinate value obtained by observing the third position point by using the position coordinate system of the first machine;
moving the tool center point of the second machine to a third position point, and recording a coordinate value obtained by observing the third position point by using the position coordinate system of the second machine;
calculating a rotation relation equation of the position coordinate system of the first machine and the position coordinate system of the second machine according to coordinate values obtained by observing the first position point, the second position point and the third position point respectively by using the position coordinate system of the first machine and the position coordinate system of the second machine;
calculating a displacement relation equation of the position coordinate system of the first machine and the position coordinate system of the second machine according to the rotation relation equation; storing the rotation relation equation and the displacement relation equation; and
and controlling the first machine and the second machine according to the position coordinate system of the first machine, the position coordinate system of the second machine, the rotation relation equation and the displacement relation equation.
Furthermore, the step of moving the tool center point of the first machine to the first position point includes: a shallow disc is arranged at the tool center point of the first machine table, the center of the shallow disc is aligned with the tool center point of the first machine table, and the first machine table is moved to enable the center of the shallow disc to be aligned with the first position point.
Still further, the numerical control system with the coordinate synchronization function realizes a numerical control method, and the step of moving the tool center point of the second machine to the first position point comprises: and arranging a round ball at the tool center point of the second machine table, wherein the diameter of the round ball is the same as that of the shallow disc, the center of the round ball is aligned to the tool center point of the second machine table, and the second machine table is moved to enable the round ball to be jointed with the shallow disc and the center of the round ball to be aligned to the first position point.
The outstanding substantive features and remarkable progress of the technical scheme of the invention are mainly reflected in that:
the numerical control system with the coordinate synchronization function can synchronize the coordinates of two different coordinate systems of the processing machine and the mechanical arm, and individual control systems are not required to be respectively erected, so that the processing efficiency can be improved, the processing and labor costs can be reduced, and the operation flow can be simplified.
Drawings
The technical scheme of the invention is further explained by combining the accompanying drawings as follows:
FIG. 1: a schematic diagram of a numerical control system with coordinate synchronization;
FIG. 2: the numerical control system with the coordinate synchronization function executes a coordinate position relative relationship schematic diagram in the coordinate synchronization process;
FIG. 3: a numerical control system having a coordinate synchronization function executes a flowchart of a coordinate synchronization program.
Detailed Description
As shown in fig. 1, the numerical control system 1 with coordinate synchronization function has a handheld input device 11, a numerical controller 12, at least one processing machine 13 and at least one robot 14, wherein the handheld input device 11 is used for changing the operations of the processing machine 13 and the robot 14, such as moving positioning or processing actions, the handheld input device 11 can be a handheld box or a handwheel, the processing machine 13 is a processing machine capable of combining numerical control methods, such as a lathe, a milling machine and a cutting machine, which is positioned along a processing machine position coordinate system and used for placing at least one processing workpiece therein and performing a processing operation on the processing workpiece, the robot 14 is a robot having the functions of picking and placing, welding, gluing, deburring, polishing and sandblasting, which is positioned along a robot position coordinate system, the numerical controller 12 is electrically connected to the hand-held input device 11, the processing machine 13 and the robot 14, and includes a user interface 121 and a core processor 122, the user interface 121 is electrically connected to the hand-held input device 11, the core processor 122 is electrically connected to the user interface 121, the processing machine 13 and the robot 14, the processing machine position coordinate system and the robot position coordinate system are disposed in the core processor 122, and the user can control the movement positioning or the processing operation of the processing machine 13 and the robot 14 through the hand-held input device 11 and the user interface 121.
The core processor 122 includes an arithmetic unit 1221, a shared memory 1222 electrically connected to the arithmetic unit 1221, a machine control module 1223 electrically connected to the hand-held input device 11 and the shared memory 1222, and a robot control module 1224 electrically connected to the hand-held input device 11 and the shared memory 1222, wherein the machine position coordinate system and the robot position coordinate system are provided in the arithmetic unit 1221. First, when the user starts to synchronize the coordinates of the processing machine 13 and the robot 14, a processing machine positioning command is input to the user interface 121 through the handheld input device 11, or the processing machine positioning command is directly transmitted through the user interface 121, the user interface 121 transmits the processing machine positioning command to the processing machine control module 1223, and the processing machine control module 1223 receives and transmits the processing machine positioning command to the processing machine 13, so that the tool center point of the processing machine 13 starts to move and be positioned at a first position point, and the user interface 121 records the coordinates observed in the processing machine position coordinate system when the tool center point of the processing machine 13 is at the first position point. Then, the user inputs a positioning command to the user interface 121 by using the handheld input device 11, or directly transmits the positioning command to the user interface 121, the user interface 121 then transmits the positioning command to the robot control module 1224, and the robot control module 1224 receives and transmits the positioning command to the robot 14, so that the tool center of the robot 14 starts to move and touch the first position point, when the tool center of the robot 14 is at the first position point, the user records the coordinates of the tool center of the robot 14 viewed by the robot position coordinate system through the user interface 121. The touching manner may be a contact type or a non-contact type, where the contact type is, for example, to set a center of a shallow disc in the processing machine as the tool center point of the processing machine 13, and set a center of a sphere having the same diameter as the shallow disc on the robot as the tool center point of the robot 14, and the center of the shallow disc and the center of the sphere are combined to achieve direct contact between the tool center point of the processing machine 13 and the tool center point of the robot 14, and the non-contact type may be one of an optical type and an electromagnetic type.
Then, the handheld input device 11 inputs the positioning command of the processing machine to the user interface 121, or the positioning command of the processing machine is directly transmitted to the processing machine control module 1223 through the user interface 121, and the processing machine control module 1223 receives and transmits the positioning command of the processing machine to the processing machine 13, so that the tool center of the processing machine 13 starts to move and is positioned at a second position point, and the user interface 121 records the coordinates of the tool center of the processing machine 13 in the processing machine position coordinate system when the tool center is at the second position point. Then, the user inputs the robot positioning command to the user interface 121 by using the handheld input device 11, or directly transmits the robot positioning command to the robot control module 1224 through the user interface 121, and the robot control module 1224 receives and transmits the robot positioning command to the robot 14, so that the tool center point of the robot 14 starts to move and touch a second position point, when the tool center point of the robot 14 is at the second position point, the user records the coordinates of the tool center point of the robot 14 viewed by the robot position coordinate system through the user interface 121.
Then, the user inputs the positioning command of the processing machine to the user interface 121 through the handheld input device 11, or directly transmits the positioning command of the processing machine to the processing machine control module 1223 through the user interface 121, and the processing machine control module 1223 receives and transmits the positioning command of the processing machine to the processing machine 13, so that the tool center point of the processing machine 13 starts to move and is positioned at a third position point, and the user interface 121 is used to record the coordinate of the tool center point of the processing machine 13 viewed in the processing machine position coordinate system when the tool center point is at the third position point. Then, the user inputs the robot positioning command to the user interface 121 by using the handheld input device 11, or directly transmits the robot positioning command to the robot control module 1224 through the user interface 121, and the robot control module 1224 receives and transmits the robot positioning command to the robot 14, so that the tool center point of the robot 14 starts to move and touch a third position point, when the tool center point of the robot 14 is at the third position point, the user records the coordinates of the tool center point of the robot 14 viewed by the robot position coordinate system through the user interface 121. The first position point, the second position point and the third position point are any three different position points which are not collinear in the overlapping operation area of the working area of the processing machine and the working area of the mechanical arm.
After the recording of the coordinates of the tool center point of the processing machine 13 and the tool center point of the robot 14 at the first position point, the second position point, and the third position point is completed, the user interface 121 transmits the coordinates of the three position points of the processing machine position coordinate system and the robot position coordinate system to the computing unit 1221, the computing unit 1221 starts to calculate a rotation relation equation of the processing machine position coordinate system and the robot position coordinate system according to the coordinates of the processing machine position coordinate system, the robot coordinate system, and the three position points of the processing machine position coordinate system and the robot position coordinate system, the computing unit 1221 further calculates a displacement relation equation of the processing machine position coordinate system and the robot position coordinate system according to the rotation relation equation, and after the computing unit 1221 finishes calculating the rotation relation equation and the displacement relation equation of the processing machine position coordinate system and the robot position coordinate system, the shared memory 1222 receives and transmits the machine position coordinate system, the robot position coordinate system, the rotational relationship equation, and the displacement relationship equation to the machine control module 1223, and transmits the robot position coordinate system, the rotational relationship equation, and the displacement relationship equation to the robot control module 1224, when the user wants to synchronize the coordinates of the machine 13 and the robot 14, the machine control module 1223 respectively outputs the machine positioning command and the robot positioning command to the machine control module 1223 and the robot control module 1224 through the handheld input device 11 and the user interface 121, the machine control module 1223 receives the machine positioning command, the machine position coordinate system, the rotational relationship equation, and the displacement relationship equation, and controls the machine 13 according to the machine positioning command and the machine position coordinate system, the robot control module 1224 controls the robot 14 by synchronizing the robot positioning command, the robot position coordinate system, the rotational relationship equation, and the displacement relationship equation with the coordinates of the processing machine 13. That is, during the processing operation, the position coordinate systems of the processing machine 13 and the robot 14 can be automatically and directly converted by the rotation relation equation and the displacement relation equation, so that the positioning coordinate of a certain position point is consistent no matter viewed from the position coordinate system of the processing machine 13 or the position coordinate system of the robot 14, and there is no need to separately recalculate the positioning coordinate in the processing machine position coordinate system or the robot position coordinate system, and there is no need to separately provide a numerical control device of the processing machine 13 or the robot 14, which can save the processing cost and the processing time, simplify the whole processing flow, and greatly improve the whole processing efficiency.
In the present invention, the coordinate synchronization may be performed by using the machine position coordinate system as a reference point and then performing coordinate synchronization between the robot position coordinate system and the machine position coordinate system as the reference point, or may be performed by using the robot position coordinate system as the reference point and then performing coordinate synchronization between the machine position coordinate system and the robot position coordinate system as the reference point, or may be performed by using the machine position coordinate system as the reference point and then performing coordinate synchronization between the other machine position coordinate system and the machine position coordinate system as the reference point, or may be performed by using the robot position coordinate system as the reference point and then performing coordinate synchronization between the other robot position coordinate system and the robot position coordinate system as the reference point, as shown in the embodiment.
Referring to fig. 2, a schematic diagram of a coordinate position relative relationship in a coordinate synchronization process performed by the numerical control system with a coordinate synchronization function according to the present invention is shown. The process of the calculation unit 1221 calculating the rotational relation equation and the displacement relation equation of the processing machine 13 and the robot 14 is further described.
First, RCNCAnd RRobotThe orthogonal matrix type composed of coordinate axes respectively representing the position coordinate system of the processing machine and the position coordinate system of the mechanical arm can be defined as a mathematical formula (1):
RCNC=[XCNCYCNCZCNC]
RRobot=[XRobotYRobotZRobot](1)
wherein, XCNC、YCNCAnd ZCNCIs the X, Y, Z coordinate axis of the machine position coordinate system, and XRobot、YRobotAnd ZRobotThe X, Y, Z axes in the coordinate system of the robot are all unit vectors of 3 × 1.
As described above, after the coordinates of the tool center point of the processing machine 13 and the tool center point of the robot 14 at the three position points, i.e., the first position point a1, the second position point a2, and the third position point A3, are recorded, the machine position coordinate system R is determinedCNCWill be formed with first position point a1, second position point a2, and third position point A3, respectivelyAndand the robot arm position coordinate system RRobotWill be formed with first position point a1, second position point a2, and third position point A3, respectivelyAndand due to RCNCAnd RRobotIs orthogonal, so there must be a rotation matrix R, as shown in equation (2):
RCNC=R×RRobot(2)
then, in order to obtain the rotation matrix R, R must be setCNCAnd RRobotConversion to non-orthogonal form matrix MCNCAnd MRobot,MCNCIs expressed by the following mathematical formula (3):
wherein,andexpressed as the following mathematical formula (4):
likewise, MRobotCan also be expressed as shown in the formula (5):
wherein,andexpressed as the following formula (6):
due to MCNCIn the middle, each Column (Column) isAnda matrix of three vectors, andandis three position points A1, A2 and A3 at XCNC、YCNCAnd ZCNCA vector formed in a coordinate system of the positions of the coordinate axes, so MCNCIn each row (Column) ofAndlinear combination of vectors, andandthe vector directions of the subtraction between two vectors are not equal, resulting in MCNCThe rows in the matrix are not equal to each other, so MCNCMust be full rank (FullRank), i.e., MCNCWith an inverse matrix, identically, MRobotIn the matrix of (1), each Column (Column) isAnda matrix of three vectors, andandis three position points A1, A2 and A3 at XRobot、YRobotAnd ZRobotA vector formed in a coordinate system of the positions of the coordinate axes, so MRobotIn each row (Column) ofAndlinear combination of vectors, andandthe vector directions of the subtraction between two vectors are not equal, resulting in MRobotThe rows in the matrix are not equal to each other, so MRobotMust have an inverse matrix, and MCNCAnd MRobotRespectively, the position coordinate system of the processing machine and the position coordinate system of the mechanical arm are calculated at three position points, namely a first position point A1, a second position point A2 and a third position point A3, so that M can be calculatedCNCAnd MRobotExpressed by the following numerical formula (7):
MCNC=R×MRobot(7)
from equation (7), the rotation matrix R can be obtained, as shown in equation (8):
the rotation matrix R is a rotation relation equation of the machine position coordinate system and the robot position coordinate system.
Furthermore, the operation unit 1221 will perform the operation according to the rotation matrix RRotate to andparallel whenAndthe difference between the two vectors is the displacement relation equation, as shown in equation (9):
which represents a vector that moves the origin of the robot position coordinate system to the origin of the machine position coordinate system in the machine position coordinate system.
As shown in fig. 3, the numerical control system having the coordinate synchronization function executes a flowchart of a coordinate synchronization program.
First, in step 31, the center of the machine tool of the first station is moved to a first position A1 on the operation overlapping area of the first station and a second station. For example, as shown in fig. 2, when the user starts to perform the coordinate synchronization of the processing machine 13 and the robot 14, the user first sends a positioning command of the processing machine to the user interface 121 through the handheld input device 11, and then transmits the positioning command of the processing machine to the processing machine control module 1223 through the user interface 121, or directly sends the positioning command of the processing machine to the processing machine control module 1223 through the user interface 121, and the processing machine control module 1223 receives and transmits the positioning command of the processing machine to the processing machine 13, so that the tool center point of the processing machine 13 starts to move and be positioned at the first position point a 1.
Then, in step 32, the coordinate values of the first position point a1 viewed from the position coordinate system of the first machine are recorded. For example, as shown in fig. 2, the coordinates of the tool center point of the processing machine 13 at the first position point a1 in the processing machine position coordinate system are recorded by the user interface 121.
Next, step 33 is performed, in which the tool center point of the second tool is moved to the first position A1. For example, as shown in fig. 1 and fig. 2, the user uses the handheld input device 11 to transmit the robot positioning command to the user interface 121, and then transmits the robot positioning command to the robot control module 1224 through the user interface 121, or directly transmits the robot positioning command to the robot control module 1224 through the user interface 121, and the robot control module 1224 receives and transmits the robot positioning command to the robot 14, so that the tool center point of the robot 14 starts to move and touch the first position point a1, which may be a contact type or a non-contact type. For example, the contact type is to set a center of a shallow disc in the processing machine as the tool center of the processing machine 13, and set a center of a sphere having the same diameter as the shallow disc on the robot as the tool center of the robot 14, and the center of the shallow disc and the center of the sphere are joined to achieve direct contact between the tool center of the processing machine 13 and the tool center of the robot 14, and the non-contact type can be selected from one of optical and electromagnetic methods.
Then, step 34 is performed to record the coordinate values of the first position point a1 viewed from the position coordinate system of the second machine. For example, as shown in fig. 2, when the tool center point of the robot 14 is at the first position point a1, the user records the coordinates of the tool center point of the robot 14 in the robot position coordinate system through the user interface 121. According to the previous steps 31-34, the coordinate value records of the tool center point of the first machine and the tool center point of the second machine at the second position point A2 and the third position point A3 are respectively completed, and then step 35 is executed.
Step 35, transmitting the coordinate values of the first machine and the second machine at the first position point, the second position point, the third position point, and the like to the computing unit in the numerical control system, and the computing unit starts to compute the rotation relation equation of the first machine position coordinate system and the second machine position coordinate system. For example, as shown in FIG. 2, the user interface 121 conveys the machine position coordinate system RCNCAnd a robot position coordinate system RRobotA1, a2 and A3 to an arithmetic unit 1221, the arithmetic unit 1221 being based on a machining center position coordinate system RCNCAnd a robot arm position coordinate system RRobotAnd a machine position coordinate system RCNCAnd a robot position coordinate system RRobotThe coordinates of the three position points A1, A2 and A3 are calculated to start to calculate the machine position coordinate system RCNCAnd a robot position coordinate system RRobotThe rotation matrix R shown in the above equation (8).
Next, step 36 is executed, that is, the computing unit calculates the displacement relation equation of the first machine position coordinate system and the second machine position coordinate system, and transmits the first machine position coordinate system, the second machine position coordinate system, the rotation relation equation and the displacement relation equation to a memory unit, the memory unit receives and transmits the rotation relation equation and the displacement relation equation to the control module of the first machine and the control module of the second machine, and the user transmits the first machine positioning instruction and the second machine positioning instruction through the handheld input device 11 and the user interface 121 respectivelyAnd positioning the command to the control module of the first machine and the control module of the second machine. For example, as shown in FIG. 2, the computing unit 1221 further calculates the machine position coordinate system R according to the calculated rotation matrix RCNCAnd a robot position coordinate system RRobotIs expressed by the equation (9)And coordinate system R of the position of the processing machineCNCAnd a robot arm position coordinate system RRobotEquation of rotation relationship R and equation of displacement relationshipTo a shared memory 1222, the shared memory 1222 stores and transmits a machine position coordinate system RCNCEquation of rotation relationship R and equation of displacement relationshipTo the machine control module 1223 and the shared memory 1222 stores and transfers the robot position coordinate system RRobotEquation of rotation relationship R and equation of displacement relationshipTo the robot control module 1224.
Finally, step 37 is performed, in which the control module of the first machine and the control module of the second machine perform coordinate synchronization of the first machine position coordinate system and the second machine position coordinate system according to the first machine positioning instruction, the second machine positioning instruction, the first machine position coordinate system, the second machine position coordinate system, the rotation relation equation, and the displacement relation equation, and control the first machine and the second machine. For example, as shown in fig. 1 and 2, the machine control module 1223 receives the machine positioning commands transmitted from the handheld input device 11 and the user interface 121, and receives the machine position coordinate system R transmitted from the shared memory 1222CNCEquation of rotation relationship R and equation of displacement relationshipThe robot control module 1224 receives the positioning commands from the hand-held input device 11 and the user interface 121 and receives the robot position coordinate system R from the shared memory 1222RobotEquation of rotation relationship R and equation of displacement relationshipTherefore, the machine control module 1223 and the robot control module 1224 can be selected from the machine positioning command, the robot positioning command, and the machine position coordinate system RCNCAnd a robot arm position coordinate system RRobotEquation of rotation relationship R and equation of displacement relationshipThe machine tool 13 and the robot 14 are controlled by synchronizing the coordinates of the machine tool position coordinate system and the robot position coordinate system.
In summary, the numerical control system with coordinate synchronization function of the present invention can synchronize the coordinates of two different coordinate systems of the processing machine and the robot, and it is not necessary to separately set up separate control systems, so as to improve the processing efficiency, reduce the processing and manpower costs, and simplify the operation process.
It is to be understood that: the foregoing is only a preferred embodiment of the present invention, and it will be apparent to those skilled in the art that various modifications and improvements can be made without departing from the principle of the present invention, and such modifications and improvements should be considered as the protection scope of the present invention.
Claims (5)
1. Numerical control system with coordinate synchronization function, including at least a processing machine, an at least robotic arm, a handheld input device and a numerical controller, processing machine and robotic arm are fixed a position along a processing machine position coordinate system and a robotic arm position coordinate system respectively, and processing machine position coordinate system and robotic arm position coordinate system locate in the numerical controller, handheld input device, processing machine and robotic arm electric connection in numerical controller, its characterized in that: the numerical controller includes:
the user interface is electrically connected with the handheld input device, is used for receiving the positioning instruction of the processing machine and the positioning instruction of the mechanical arm input by the handheld input device, and is used for recording coordinate values obtained by observing at least three selected non-collinear different position points by using a position coordinate system of the processing machine and a position coordinate system of the mechanical arm respectively; and
a core processor electrically connected to the user interface, the core processor being electrically connected to the processing machine and the robot for receiving the positioning command of the processing machine, the positioning command of the robot and the coordinate values obtained by observing the position coordinate system of the processing machine and the position coordinate system of the robot at least three non-collinear different position points through the user interface, calculating a rotation relation equation between the position coordinate system of the processing machine and the position coordinate system of the robot according to the position coordinate system of the processing machine, the position coordinate system of the robot and the coordinate values obtained by observing the position coordinate system of the processing machine and the position coordinate system of the robot at least three non-collinear different position points respectively, calculating a displacement relation equation between the position coordinate system of the processing machine and the position coordinate system of the robot according to the rotation relation equation, the core processor storing the rotation relation equation and the displacement relation equation, controlling the processing machine according to the position coordinate system of the processing machine and the positioning instruction of the processing machine, and controlling the mechanical arm according to the position coordinate system of the mechanical arm, the positioning instruction of the mechanical arm, the rotation relation equation and the displacement relation equation;
wherein the at least three non-collinear different location points are located in a working overlap region of the processing machine and the robot.
2. The numerical control system with a coordinate synchronization function according to claim 1, characterized in that: the core processor includes:
the computing unit is provided with a processing machine position coordinate system and a mechanical arm position coordinate system and used for receiving coordinate values obtained by observing at least three non-collinear different position points respectively by using the processing machine position coordinate system and the mechanical arm position coordinate system and calculating a rotation relation equation and a displacement relation equation of the processing machine position coordinate system and the mechanical arm position coordinate system;
a shared memory electrically connected to the computing unit for receiving and storing the machine position coordinate system, the robot position coordinate system, the rotation relation equation and the displacement relation equation;
the processing machine control module is electrically connected with the handheld input device and the shared memory, receives a positioning instruction of the processing machine, a position coordinate system of the processing machine, a rotation relation equation and a displacement relation equation and is used for controlling the processing machine; and
and the mechanical arm control module is electrically connected with the handheld input device and the shared memory, receives the positioning instruction of the mechanical arm, the position coordinate system of the mechanical arm, the rotation relation equation and the displacement relation equation and controls the mechanical arm.
3. A numerical control system having a coordinate synchronization function according to claim 1, which implements a numerical control method, characterized by comprising the steps of:
moving a tool center point of a first machine to a first position point, and recording a coordinate value obtained by observing the first position point by using a position coordinate system of the first machine;
moving the tool center point of the second machine to the first position point, and recording the coordinate value obtained by observing the first position point by using the position coordinate system of the second machine;
moving the tool center point of the first machine to a second position point, and recording a coordinate value obtained by observing the second position point by using the position coordinate system of the first machine;
moving the tool center point of the second machine to a second position point, and recording a coordinate value obtained by observing the second position point by using a position coordinate system of the second machine;
moving the tool center point of the first machine to a third position point, and recording a coordinate value obtained by observing the third position point by using the position coordinate system of the first machine;
moving the tool center point of the second machine to a third position point, and recording a coordinate value obtained by observing the third position point by using the position coordinate system of the second machine;
calculating a rotation relation equation of the position coordinate system of the first machine and the position coordinate system of the second machine according to coordinate values obtained by observing the first position point, the second position point and the third position point respectively by using the position coordinate system of the first machine and the position coordinate system of the second machine;
calculating a displacement relation equation of the position coordinate system of the first machine and the position coordinate system of the second machine according to the rotation relation equation; storing the rotation relation equation and the displacement relation equation; and
and controlling the first machine and the second machine according to the position coordinate system of the first machine, the position coordinate system of the second machine, the rotation relation equation and the displacement relation equation.
4. The numerical control system with a coordinate synchronization function according to claim 3, wherein the numerical control system includes: the step of moving the tool center point of the first tool to the first location point comprises: a shallow disc is arranged at the tool center point of the first machine table, the center of the shallow disc is aligned with the tool center point of the first machine table, and the first machine table is moved to enable the center of the shallow disc to be aligned with the first position point.
5. The numerical control system with a coordinate synchronization function according to claim 3, wherein the numerical control system includes: the step of moving the tool center point of the second stage to the first position point comprises: and arranging a round ball at the tool center point of the second machine table, wherein the diameter of the round ball is the same as that of the shallow disc, the center of the round ball is aligned to the tool center point of the second machine table, and the second machine table is moved to enable the round ball to be jointed with the shallow disc and the center of the round ball to be aligned to the first position point.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410080486.4A CN103809507B (en) | 2014-03-06 | 2014-03-06 | There is numerical control system and the numerical control method thereof of coordinate synchronizing function |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410080486.4A CN103809507B (en) | 2014-03-06 | 2014-03-06 | There is numerical control system and the numerical control method thereof of coordinate synchronizing function |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103809507A CN103809507A (en) | 2014-05-21 |
CN103809507B true CN103809507B (en) | 2016-05-25 |
Family
ID=50706448
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410080486.4A Active CN103809507B (en) | 2014-03-06 | 2014-03-06 | There is numerical control system and the numerical control method thereof of coordinate synchronizing function |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103809507B (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0509103A1 (en) * | 1990-11-01 | 1992-10-21 | Fanuc Ltd. | Method of transforming coordinates of tridimensional laser |
CN101424935A (en) * | 2007-10-29 | 2009-05-06 | 发那科株式会社 | Controller of work piece-conveying robot |
CN101900787A (en) * | 2009-05-25 | 2010-12-01 | 鸿富锦精密工业(深圳)有限公司 | Test system and method of circuit board |
CN102049703A (en) * | 2010-10-28 | 2011-05-11 | 北京理工大学 | Space coordinate transformation method suitable for turning-milling machining of parts with complex structures |
CN102216860A (en) * | 2008-11-25 | 2011-10-12 | Abb技术有限公司 | A method and an apparatus for calibration of an industrial robot system |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62154110A (en) * | 1985-12-27 | 1987-07-09 | Mitsubishi Electric Corp | Control system for numerical controller |
JP4392533B2 (en) * | 2003-12-11 | 2010-01-06 | 株式会社日立製作所 | Numerically controlled curved surface processing equipment |
JP4503659B2 (en) * | 2008-06-11 | 2010-07-14 | ファナック株式会社 | Numerical controller for coordinate transformation tool phase control |
-
2014
- 2014-03-06 CN CN201410080486.4A patent/CN103809507B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0509103A1 (en) * | 1990-11-01 | 1992-10-21 | Fanuc Ltd. | Method of transforming coordinates of tridimensional laser |
CN101424935A (en) * | 2007-10-29 | 2009-05-06 | 发那科株式会社 | Controller of work piece-conveying robot |
CN102216860A (en) * | 2008-11-25 | 2011-10-12 | Abb技术有限公司 | A method and an apparatus for calibration of an industrial robot system |
CN101900787A (en) * | 2009-05-25 | 2010-12-01 | 鸿富锦精密工业(深圳)有限公司 | Test system and method of circuit board |
CN102049703A (en) * | 2010-10-28 | 2011-05-11 | 北京理工大学 | Space coordinate transformation method suitable for turning-milling machining of parts with complex structures |
Non-Patent Citations (4)
Title |
---|
并联机床的工作空间及其近似表示方法;赵晓明等;《上海交通大学学报》;20040630;第38卷(第6期);1007-1016 * |
激光加工机器人技术及工业应用;杨洗陈;《中国激光》;20091130;第36卷(第11期);2780-2798 * |
空间三维坐标转换原理及实现;柯金朴;《江西测绘》;20081231(第3期);16-20 * |
采伐联合机机械手运动学分析及雅可比矩阵求解;赵志强等;《林业机械与木工设备》;20100228;第38卷(第2期);45-48 * |
Also Published As
Publication number | Publication date |
---|---|
CN103809507A (en) | 2014-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11724388B2 (en) | Robot controller and display device using augmented reality and mixed reality | |
KR102353178B1 (en) | Systems and methods for directing robots | |
CN107717981B (en) | Control device of mechanical arm and teaching system and method thereof | |
Ostanin et al. | Interactive robot programing using mixed reality | |
CN102203685B (en) | Method for allowing a manipulator to cover a predetermined trajectory, and control device for carrying out said method | |
CN103085072B (en) | Method for achieving industrial robot off-line programming based on three-dimensional modeling software | |
JP6114361B1 (en) | Offline robot programming device | |
US20130096719A1 (en) | Method for dynamic optimization of a robot control interface | |
CN203449306U (en) | Master-slave-type double-industrial-robot coordination operation control system | |
JP2011048621A (en) | Robot off-line teaching method | |
CN108340374B (en) | Control system and control method for picking manipulator | |
CN102554407B (en) | Control method for welding starting point of V-shaped workpiece in robot welding | |
JP6469159B2 (en) | Offline programming apparatus and method with work position detection program generation function by contact sensor | |
US10684609B2 (en) | Program code generating method for tilted plane machining by multi-axis machine tool and device thereof | |
Fang et al. | Robot path and end-effector orientation planning using augmented reality | |
Andersen et al. | Task space HRI for cooperative mobile robots in fit-out operations inside ship superstructures | |
CN104750023A (en) | Model based welding robot offline training data acquisition method | |
Hoang et al. | Virtual barriers in augmented reality for safe and effective human-robot cooperation in manufacturing | |
CN112123344A (en) | Drag teaching method based on power-controlled robot polishing and implementation device thereof | |
JP7415037B2 (en) | Robot programming device and robot programming method | |
JP7474681B2 (en) | PROGRAM GENERATION SYSTEM, ROBOT SYSTEM, PROGRAM GENERATION METHOD, AND GENERATION PROGRAM | |
CN103809507B (en) | There is numerical control system and the numerical control method thereof of coordinate synchronizing function | |
JP2013226602A (en) | Industrial machine system | |
TWI494724B (en) | Numerical control system of coordinate synchronization and numerical controlling method thereof | |
Tanzini et al. | A novel human-machine interface for working machines operation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CP03 | Change of name, title or address |
Address after: 215000 Chunhui Road, Suzhou Industrial Park, Jiangsu Province Patentee after: New Generation Science and Technology (Suzhou) Co., Ltd. Address before: 215021 Xinsu Industrial Park, No. 5 Xinghan Street, Suzhou City, Jiangsu Province Patentee before: Suzhou Xindai Numerical Control Equipment Co., Ltd. |
|
CP03 | Change of name, title or address |