[go: up one dir, main page]

CN107192361A - The kinetic control system and its control method of a kind of three coordinate measuring machine - Google Patents

The kinetic control system and its control method of a kind of three coordinate measuring machine Download PDF

Info

Publication number
CN107192361A
CN107192361A CN201710564539.3A CN201710564539A CN107192361A CN 107192361 A CN107192361 A CN 107192361A CN 201710564539 A CN201710564539 A CN 201710564539A CN 107192361 A CN107192361 A CN 107192361A
Authority
CN
China
Prior art keywords
axis servo
measuring machine
coordinate measuring
servo motor
motion
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.)
Pending
Application number
CN201710564539.3A
Other languages
Chinese (zh)
Inventor
黄卫东
詹朝强
黄晓伟
陈广宇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fujian University of Technology
Original Assignee
Fujian University of Technology
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 Fujian University of Technology filed Critical Fujian University of Technology
Priority to CN201710564539.3A priority Critical patent/CN107192361A/en
Publication of CN107192361A publication Critical patent/CN107192361A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/02Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness
    • G01B21/04Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness by measuring coordinates of points
    • G01B21/047Accessories, e.g. for positioning, for tool-setting, for measuring probes
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/04Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/042Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
    • G05B19/0428Safety, monitoring
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/20Pc systems
    • G05B2219/26Pc applications
    • G05B2219/2656Instrumentation

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明提供了一种三坐标测量机的运动控制系统,包括PC机、运动控制器、脉冲转换器、X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器、X轴伺服电机、Y轴伺服电机、Z轴伺服电机、三坐标测量机、传感器、低速光电耦合器及高速光电耦合器,运动控制器与PC机、脉冲转换器、低速光电耦合器及高速光电耦合器连接,脉冲转换器与X轴伺服驱动器、Y轴伺服驱动器及Z轴伺服驱动器连接,三轴伺服驱动器通过三轴伺服电机连接至三坐标测量机,传感器与X轴伺服电机、Y轴伺服电机、Z轴伺服电机、低速光电耦合器及高速光电耦合器连接。本发明还提供一种三坐标测量机的运动控制方法,控制三坐标测量机的各轴运动定位准确。

The invention provides a motion control system of a three-coordinate measuring machine, including a PC, a motion controller, a pulse converter, an X-axis servo driver, a Y-axis servo driver, a Z-axis servo driver, an X-axis servo motor, and a Y-axis servo Motor, Z-axis servo motor, coordinate measuring machine, sensor, low-speed photocoupler and high-speed photocoupler, motion controller and PC, pulse converter, low-speed photocoupler and high-speed photocoupler connected, pulse converter and X-axis servo driver, Y-axis servo driver and Z-axis servo driver are connected, the three-axis servo driver is connected to the three-axis coordinate measuring machine through the three-axis servo motor, and the sensor is connected to the X-axis servo motor, Y-axis servo motor, Z-axis servo motor, low speed Optocoupler and high-speed optocoupler connection. The invention also provides a motion control method of a three-coordinate measuring machine, which can control the movement and positioning of each axis of the three-coordinate measuring machine accurately.

Description

一种三坐标测量机的运动控制系统及其控制方法A motion control system and control method for a three-coordinate measuring machine

技术领域technical field

本发明涉及一种三坐标测量机,具体涉及一种三坐标测量机的运动控制系统及其控制方法。The invention relates to a three-coordinate measuring machine, in particular to a motion control system and a control method of the three-coordinate measuring machine.

背景技术Background technique

运动控制器是通过对以电机驱动的目标装置或设备(如:三坐标测量机)进行协调控制,使其按照预期的作业轨迹进行运动的控制装置。它是电子、机械制造业的核心技术装备。从与主控计算机的数据通信方式来分,目前运动控制器主要分为两类:一是基于计算机标准并行总线(如PCI、ISA总线)的运动控制器,二是基于计算机标准串行总线(如USB、RS-232、Ethernet等)的运动控制器。前者通常做成运动控制卡,通过“金手指”(即内存条的金黄色导电触片,电脑硬件,如:内存条上与内存插槽之间、显卡与显卡插槽等)与主控计算机的主板扩展槽物理连接,并与主控计算机共电源。后者通常做成独立控制器,通过“串行通信电缆”与主控计算机连接,由于它在结构上与主控计算机完全脱离,所以又称独立式运动控制器。实践表明,基于并行总线的运动控制器存在以下不足:(1)运动控制卡不能脱离主控计算机的主板,易受电磁辐射干扰;(2)运动控制卡与主控计算机共电源,易产生电源耦合,特别是影响模拟控制(DAC)输出的控制精度;(3)运动控制卡通过“金手指”与主控计算机并行总线作机械接触连接,易产生接触不良,使控制系统不稳定;(4)运动控制卡(或主控计算机)与伺服驱动器之间需要相对较长的电缆连接,易受环境影响,并存在丢失脉冲,各轴运动定位不准确的现象。上述不足已引起世界各大运动控制器厂商的广泛关注。The motion controller is a control device that coordinates and controls the motor-driven target device or equipment (such as a three-coordinate measuring machine) to make it move according to the expected operating trajectory. It is the core technical equipment of electronics and machinery manufacturing industry. According to the data communication method with the main control computer, the current motion controllers are mainly divided into two categories: one is based on the computer standard parallel bus (such as PCI, ISA bus) motion controller, and the other is based on the computer standard serial bus ( Such as USB, RS-232, Ethernet, etc.) motion controller. The former is usually made into a motion control card, which communicates with the main control computer through the "golden finger" (that is, the golden-yellow conductive contact piece of the memory stick, computer hardware, such as: between the memory stick and the memory slot, the graphics card and the graphics card slot, etc.) It is physically connected to the expansion slot of the motherboard, and shares the power supply with the main control computer. The latter is usually made as an independent controller, which is connected to the main control computer through a "serial communication cable". Because it is completely separated from the main control computer in structure, it is also called an independent motion controller. Practice shows that the motion controller based on the parallel bus has the following disadvantages: (1) The motion control card cannot be separated from the main board of the main control computer, and is susceptible to electromagnetic radiation interference; (2) The motion control card and the main control computer share a power supply, which is easy to generate Coupling, especially affects the control accuracy of the analog control (DAC) output; (3) The motion control card is mechanically connected to the parallel bus of the main control computer through the "golden finger", which is prone to poor contact and makes the control system unstable; (4 ) between the motion control card (or main control computer) and the servo drive requires a relatively long cable connection, which is easily affected by the environment, and there are missing pulses and inaccurate positioning of each axis. The above-mentioned deficiencies have aroused widespread concern of the world's major motion controller manufacturers.

控制三坐标测量机的运动控制器通常是采用并行总线的运动控制卡,并采用开环方式进行运动控制,这种方式只是从PC机到运动控制卡的单向传输,并不能将三坐标测量机的信息反馈给运动控制卡,再到主控计算机,从而主控计算机就不能通过控制该运动控制卡来调整三坐标测量机的位置,就容易存在丢失脉冲、三坐标测量机各轴运动定位不准确的现象。The motion controller that controls the three-coordinate measuring machine is usually a motion control card that uses a parallel bus, and uses an open-loop method for motion control. This method is only a one-way transmission from the PC to the motion control card, and cannot convert the three-coordinate measurement The information of the machine is fed back to the motion control card, and then to the main control computer, so that the main control computer cannot adjust the position of the three-coordinate measuring machine by controlling the motion control card, and it is easy to lose pulses and the movement positioning of each axis of the three-coordinate measuring machine. inaccurate phenomenon.

而基于计算机标准串行总线的运动控制器,USB总线因其具有着即插即用、支持热插拔、性价比高、可扩展多达127个被控设备等诸多ISA和PCI总线所不及的优点而得以迅速发展。As for the motion controller based on the computer standard serial bus, the USB bus has many advantages beyond the ISA and PCI bus because of its plug-and-play, hot-swappable, cost-effective, and expandable up to 127 controlled devices. to develop rapidly.

二十世纪九十年代以来,数控系统进入了基于PC的第六代数控技术阶段,特别是“PC+运动控制器”的开放式数控技术已成为当今主要方向。而基于计算机标准总线的开放式运动控制器仍然是市场发展的主流。因此,研制一种基于计算机标准总线的开放式运动控制器是很有必要的。Since the 1990s, the CNC system has entered the stage of the sixth generation of PC-based CNC technology, especially the open CNC technology of "PC + motion controller" has become the main direction today. The open motion controller based on computer standard bus is still the mainstream of market development. Therefore, it is necessary to develop an open motion controller based on computer standard bus.

中国发明专利申请CN106444535A公开了一种运动控制器及控制方法,具体地,涉及一种运动控制器及控制方法,包括运动控制器本体、1-8个扩展模块和扩展连线,所述的扩展连线包括数据读写连线、数据传递连线和使能连线,数据读写连线一方面连接至运动控制器本体,另一方面分别连接至各个扩展模块;数据传递连线包括数据0-数据7传递连线,数据传递连线为双向信号线,一方面连接至运动控制器本体,另一方面分别连接至各个扩展模块;使能连线用于串联运动控制器本体和各个扩展模块。该发明是采用基于计算机标准并行总线的运动控制器,由于运动控制器本身所带得资源有限,使外接模块与运动控制器匹配性不好、价格昂贵、系统复杂不稳定等问题。同时,在很多的应用场合还需要借助一些额外的模块才能完成系统的应用。Chinese invention patent application CN106444535A discloses a motion controller and a control method, specifically, it relates to a motion controller and a control method, including a motion controller body, 1-8 extension modules and extension cables, the extension The connection includes data read-write connection, data transfer connection and enable connection. On the one hand, the data read-write connection is connected to the motion controller body, and on the other hand, it is respectively connected to each expansion module; - Data 7 transmission connection, the data transmission connection is a bidirectional signal line, which is connected to the motion controller body on the one hand, and connected to each expansion module on the other hand; the enabling connection is used to connect the motion controller body and each expansion module in series . The invention adopts a motion controller based on a computer standard parallel bus. Due to the limited resources of the motion controller itself, the matching between the external module and the motion controller is poor, the price is expensive, and the system is complex and unstable. At the same time, in many applications, some additional modules are needed to complete the application of the system.

中国实用新型专利申请CN201955650U公开了一种三坐标运动控制器,涉及单片机及电子技术应用领域,特别是一种简易定位控制的三坐标运动控制器。包括控制盒、电路板、人机操作界面、手摇脉冲发生器MPG和控制电路,人机操作界面具有LED显示屏和控制按键,人机操作界面和手摇脉冲发生器MPG设置在控制盒上,电路板安装在控制盒内,控制电路装配在电路板上,控制电路包括单片机、输入信号电路部分、输出信号电路部分、手摇脉冲发生器MPG控制电路部分、LED显示及按键电路部分和串行通讯接口电路部分,各部分均为独立的功能模块,单片机电路与其它各部分功能电路模块之间通过系统总线相连。该实用新型是采用基于计算机标准并行总线的运动控制器,只能实现极少数的运动控制功能,在自行运动功能中缺乏圆弧插补的定位,无法达到运动轨迹控制准确要求。Chinese utility model patent application CN201955650U discloses a three-coordinate motion controller, which relates to the application field of single-chip microcomputer and electronic technology, especially a three-coordinate motion controller with simple positioning control. Including control box, circuit board, man-machine operation interface, manual pulse generator MPG and control circuit, the man-machine operation interface has LED display and control buttons, the man-machine operation interface and manual pulse generator MPG are set on the control box , the circuit board is installed in the control box, and the control circuit is assembled on the circuit board. The control circuit includes a single-chip microcomputer, an input signal circuit part, an output signal circuit part, a manual pulse generator MPG control circuit part, an LED display and a key circuit part and a string The line communication interface circuit part, each part is an independent function module, and the single-chip microcomputer circuit is connected with other parts of the function circuit module through the system bus. This utility model adopts a motion controller based on computer standard parallel bus, which can only realize a small number of motion control functions, lacks circular interpolation positioning in self-motion functions, and cannot meet the accurate requirements of motion trajectory control.

中国发明专利申请CN106502143A公开了一种基于计算机的运动控制卡的构建平台系统,包括计算机及与计算机通过ISA总线电连接的运动控制卡,及与运动控制卡电连接的执行单元;所述运动控制卡包括总线接口电路,及与总线接口电路电连接的通信接口电路,及与通信接口电路电连接的DSP,及与DSP电连接的编码器信号处理电路和脉冲发生器;所述执行单元包括多个驱动器,及与驱动器电连接的电机。该发明结构简单、工作可靠、成本低廉,能够针对多轴联动的数控机床、机器人等高性能控制系统的需求。但是由于是采用基于计算机标准并行总线(如PCI、ISA总线)的运动控制卡,运动控制卡不能脱离主控计算机主板,易受电磁辐射干扰;运动控制卡与主控计算机共电源,易产生电源耦合,特别是影响模拟控制(DAC)输出的控制精度。Chinese invention patent application CN106502143A discloses a computer-based motion control card construction platform system, including a computer, a motion control card electrically connected to the computer through an ISA bus, and an execution unit electrically connected to the motion control card; the motion control The card includes a bus interface circuit, a communication interface circuit electrically connected to the bus interface circuit, a DSP electrically connected to the communication interface circuit, and an encoder signal processing circuit and a pulse generator electrically connected to the DSP; the execution unit includes multiple A driver, and a motor electrically connected to the driver. The invention has the advantages of simple structure, reliable operation and low cost, and can meet the requirements of high-performance control systems such as multi-axis linkage numerical control machine tools and robots. However, due to the use of motion control cards based on computer standard parallel buses (such as PCI, ISA bus), the motion control card cannot be separated from the main control computer motherboard, and is susceptible to electromagnetic radiation interference; the motion control card and the main control computer share power, which is easy to generate power Coupling, in particular, affects the control accuracy of the analog control (DAC) output.

发明内容Contents of the invention

本发明要解决的技术问题之一,在于提供一种三坐标测量机的运动控制系统,是采用一种基于USB通信的闭环式运动控制系统来控制三坐标测量机,不仅有着即插即用、支持热插拔、性价比高,而且还具有可扩展多达127个被控设备等诸多ISA和PCI总线所不及的优点,解决了三坐标测量机采用开环运动控制存在丢失脉冲、各轴运动定位不准确的现象;采用“PC+运动控制器”的闭环式数控系统,不仅具有信息处理能力强、开放程度高、运动轨迹控制准确、通用性好等的特点,而且还从很大程度上提高了现有加工制造的精度、柔性和应付市场需求的能力。One of the technical problems to be solved by the present invention is to provide a motion control system for a three-coordinate measuring machine, which uses a closed-loop motion control system based on USB communication to control the three-coordinate measuring machine, which not only has plug-and-play, It supports hot-swapping, high cost performance, and has many advantages beyond the reach of ISA and PCI buses, such as being able to expand up to 127 controlled devices. Inaccurate phenomenon; the closed-loop numerical control system adopting "PC + motion controller" not only has the characteristics of strong information processing ability, high degree of openness, accurate motion trajectory control, and good versatility, but also greatly improves the Existing processing and manufacturing precision, flexibility and ability to meet market demand.

本发明的问题之一,是这样实现的:One of problem of the present invention is realized like this:

一种三坐标测量机的运动控制系统,所述运动控制系统包括PC机、运动控制器、脉冲转换器、X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器、X轴伺服电机、Y轴伺服电机、Z轴伺服电机、三坐标测量机、传感器、低速光电耦合器及高速光电耦合器,所述运动控制器分别与PC机、脉冲转换器、低速光电耦合器及高速光电耦合器连接,所述脉冲转换器分别与X轴伺服驱动器、Y轴伺服驱动器及Z轴伺服驱动器连接,所述X轴伺服驱动器通过X轴伺服电机连接至三坐标测量机,所述Y轴伺服驱动器通过Y轴伺服电机连接至三坐标测量机,所述Z轴伺服驱动器通过Z轴伺服电机连接至三坐标测量机,所述传感器分别与X轴伺服电机、Y轴伺服电机、Z轴伺服电机、低速光电耦合器及高速光电耦合器连接。A motion control system of a three-coordinate measuring machine, the motion control system comprising a PC, a motion controller, a pulse converter, an X-axis servo driver, a Y-axis servo driver, a Z-axis servo driver, an X-axis servo motor, a Y-axis Servo motor, Z-axis servo motor, coordinate measuring machine, sensor, low-speed photocoupler and high-speed photocoupler, the motion controller is connected with PC, pulse converter, low-speed photocoupler and high-speed photocoupler respectively, The pulse converter is respectively connected with the X-axis servo driver, the Y-axis servo driver and the Z-axis servo driver, the X-axis servo driver is connected to the coordinate measuring machine through the X-axis servo motor, and the Y-axis servo driver is connected to the three-coordinate measuring machine through the Y-axis servo driver. The servo motor is connected to the three-coordinate measuring machine, the Z-axis servo driver is connected to the three-coordinate measuring machine through the Z-axis servo motor, and the sensors are respectively connected to the X-axis servo motor, the Y-axis servo motor, the Z-axis servo motor, and the low-speed photoelectric coupling device and high-speed optocoupler connection.

进一步地,所述运动控制系统还包括驱动状态输出电路及状态指示灯,所述状态指示灯通过驱动状态输出电路连接至运动控制器。Further, the motion control system further includes a driving status output circuit and a status indicator light, and the status indicator light is connected to the motion controller through the driving status output circuit.

进一步地,所述运动控制器的型号为APAX-5580。Further, the model of the motion controller is APAX-5580.

进一步地,所述脉冲转换器的型号为SA1400。Further, the model of the pulse converter is SA1400.

进一步地,所述传感器为光栅尺或编码器。Further, the sensor is a grating ruler or an encoder.

本发明要解决的技术问题之二,在于提供一种三坐标测量机的运动控制方法,是采用一种基于USB通信的闭环式运动控制系统来控制三坐标测量机,不仅有着即插即用、支持热插拔、性价比高,而且还具有可扩展多达127个被控设备等诸多ISA和PCI总线所不及的优点,解决了三坐标测量机采用开环运动控制存在丢失脉冲、各轴运动定位不准确的现象;采用“PC+运动控制器”的闭环式数控系统,不仅具有信息处理能力强、开放程度高、运动轨迹控制准确、通用性好等的特点,而且还从很大程度上提高了现有加工制造的精度、柔性和应付市场需求的能力。The second technical problem to be solved by the present invention is to provide a motion control method for a three-coordinate measuring machine, which adopts a closed-loop motion control system based on USB communication to control the three-coordinate measuring machine, which not only has plug-and-play, It supports hot-swapping, high cost performance, and has many advantages beyond the reach of ISA and PCI buses, such as being able to expand up to 127 controlled devices. Inaccurate phenomenon; the closed-loop numerical control system adopting "PC + motion controller" not only has the characteristics of strong information processing ability, high degree of openness, accurate motion trajectory control, and good versatility, but also greatly improves the Existing processing and manufacturing precision, flexibility and ability to meet market demand.

本发明的问题之二,是这样实现的:Two of problem of the present invention is realized like this:

一种三坐标测量机的运动控制方法,所述运动控制方法需提供如权利要求1所述的一种三坐标测量机的运动控制系统,所述运动控制方法具体包括如下步骤:A motion control method for a three-coordinate measuring machine, the motion control method needs to provide a motion control system for a three-coordinate measuring machine as claimed in claim 1, and the motion control method specifically includes the following steps:

步骤1、所述PC机通过串行总线与运动控制器连接进行通信,所述PC机发送控制指令给运动控制器;Step 1, the PC is connected to the motion controller through a serial bus to communicate, and the PC sends a control command to the motion controller;

步骤2、所述运动控制器接收到该控制指令后,产生对应的驱动脉冲信号和方向脉冲信号发送给所述脉冲转换器;Step 2. After receiving the control instruction, the motion controller generates a corresponding drive pulse signal and direction pulse signal and sends them to the pulse converter;

步骤3、所述脉冲转换器接收到驱动脉冲信号和方向脉冲信号后,将其转换成驱动数字信号,并发送给对应的X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器;Step 3. After receiving the driving pulse signal and the direction pulse signal, the pulse converter converts it into a driving digital signal and sends it to the corresponding X-axis servo driver, Y-axis servo driver, and Z-axis servo driver;

步骤4、所述X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器接收到驱动数字信号后,分别驱动X轴伺服电机、Y轴伺服电机、Z轴伺服电机转动,完成相应的机械动作,从而带动所述三坐标测量机三个轴的运动;Step 4. After the X-axis servo driver, Y-axis servo driver, and Z-axis servo driver receive the driving digital signal, they respectively drive the X-axis servo motor, Y-axis servo motor, and Z-axis servo motor to rotate to complete corresponding mechanical actions. Thereby driving the movement of the three axes of the three-coordinate measuring machine;

步骤5、所述传感器采集X轴伺服电机、Y轴伺服电机、Z轴伺服电机的通用输出信号和外部反馈信号,并发送给低速光电耦合器和高速光电耦合器;Step 5, the sensor collects general output signals and external feedback signals of the X-axis servo motor, Y-axis servo motor, and Z-axis servo motor, and sends them to the low-speed photocoupler and the high-speed photocoupler;

步骤6、所述低速光电耦合器接收通用输出信号,并进行滤波后发送给运动控制器;所述高速光电耦合器接收外部反馈信号,并进行电气隔离后发送给运动控制器Step 6. The low-speed photocoupler receives the general output signal and sends it to the motion controller after filtering; the high-speed photocoupler receives the external feedback signal and sends it to the motion controller after electrical isolation

步骤7、所述运动控制器通过通用输出信号和外部反馈信号将三坐标测量机的实时状态反馈给PC机,以便PC机进行调度。Step 7. The motion controller feeds back the real-time status of the CMM to the PC through the general output signal and the external feedback signal, so that the PC can perform scheduling.

进一步地,所述运动控制器输出脉冲有两种模式:定长脉冲输出模式和连续脉冲输出模式,通过设置运动控制器中的寄存器来选择相应的脉冲输出模式。Further, the motion controller has two modes for outputting pulses: a fixed-length pulse output mode and a continuous pulse output mode, and the corresponding pulse output mode is selected by setting a register in the motion controller.

进一步地,所述PC机与运动控制器之间的通讯方式是通过USB总线进行USB通讯。Further, the communication mode between the PC and the motion controller is USB communication through the USB bus.

进一步地,所述通用输出信号包括限位开关信号、到位信号、服警信号和紧急开关信号,所述外部反馈信号包括故障信号、电机运行参数信号和环境温度信号。Further, the general output signal includes limit switch signal, in-position signal, service alarm signal and emergency switch signal, and the external feedback signal includes fault signal, motor operation parameter signal and ambient temperature signal.

本发明的优点在于:The advantages of the present invention are:

(1)通过运动控制器产生驱动脉冲信号和方向脉冲信号,驱动伺服电机完成相应的机械运作,通过运动控制器将三坐标测量机的实时状态反馈给PC机,这样便于PC机进行调度,并且完成PC机下达的动作命令;(1) Generate the drive pulse signal and direction pulse signal through the motion controller, drive the servo motor to complete the corresponding mechanical operation, and feed back the real-time state of the three-coordinate measuring machine to the PC through the motion controller, which is convenient for the PC to schedule, and Complete the action command issued by the PC;

(2)运动控制器与传感器之间用光电耦合器(低速光电耦合器和高速光电耦合器)进行电气隔离,以提高抗干扰能力,低速光电耦合器用于接收通用输出信号,能起到滤波和延时的作用,使控制器工作稳定。同时,高速光电耦合器用于接收反馈的外部反馈信号,并进行电气隔离;(2) The photoelectric coupler (low-speed photocoupler and high-speed photocoupler) is used for electrical isolation between the motion controller and the sensor to improve the anti-interference ability. The low-speed photocoupler is used to receive general output signals, which can filter and The delay function makes the controller work stably. At the same time, the high-speed optocoupler is used to receive the external feedback signal of the feedback and perform electrical isolation;

(3)运动控制器产生的驱动脉冲信号和方向脉冲信号,经过伺服驱动器产生驱动数字信号,控制伺服电机驱动,将外部反馈信号经过高速光电耦合器后输入给运动控制器,将通用输出信号经过低速光电耦合器后输入给运动控制器的通用输入端口。这样不仅非常有效排除了外部电磁干拢(EMI),提高了双向传输信号质量,且也提高信号长距离抗干扰能力;(3) The drive pulse signal and direction pulse signal generated by the motion controller are generated by the servo driver to generate a drive digital signal to control the drive of the servo motor, and the external feedback signal is input to the motion controller after passing through the high-speed photocoupler, and the general output signal is passed through After the low-speed optocoupler is input to the general input port of the motion controller. This not only effectively eliminates external electromagnetic interference (EMI), improves the quality of two-way transmission signals, but also improves the long-distance anti-interference ability of signals;

(4)USB实现PC机与运动控制器通信,通过运动控制器将三坐标测量机的实时状态反馈给PC机,以便于PC机控制,同时PC机控制信号通过USB总线传输给运动控制器。PC机与运动控制器之间还采用单片机进行USB通讯,由于单片机内部配备强大的功能模块大大简化了USB技术的开发,利用USB全速传输,保证了较高的数据传输率,同时无需外加单独的USB电源,且A/D转换器、定时器、USB控制器等器件互相独立工作,对于提高控制器集成度有明显的优势。(4) USB realizes the communication between the PC and the motion controller. The real-time state of the three-coordinate measuring machine is fed back to the PC through the motion controller, so as to facilitate the control of the PC. At the same time, the control signal of the PC is transmitted to the motion controller through the USB bus. The single-chip microcomputer is also used for USB communication between the PC and the motion controller. The powerful functional modules inside the single-chip microcomputer greatly simplify the development of USB technology, and the use of full-speed USB transmission ensures a high data transmission rate. At the same time, there is no need to add a separate USB power supply, and devices such as A/D converter, timer, and USB controller work independently of each other, which has obvious advantages for improving the integration of the controller.

附图说明Description of drawings

下面参照附图结合实施例对本发明作进一步的说明。The present invention will be further described below in conjunction with the embodiments with reference to the accompanying drawings.

图1为本发明一种三坐标测量机的运动控制系统的结构示意图。FIG. 1 is a schematic structural diagram of a motion control system of a three-coordinate measuring machine according to the present invention.

图2为本发明一种三坐标测量机的运动控制方法的执行流程图。FIG. 2 is a flow chart of the execution of a motion control method of a three-coordinate measuring machine according to the present invention.

具体实施方式detailed description

请参阅图1所示,本发明的一种三坐标测量机的运动控制系统,所述运动控制系统包括PC机、运动控制器、脉冲转换器、X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器、X轴伺服电机、Y轴伺服电机、Z轴伺服电机、三坐标测量机、传感器、低速光电耦合器及高速光电耦合器,所述传感器为光栅尺或编码器;Please refer to Fig. 1, a motion control system of a three-coordinate measuring machine according to the present invention, the motion control system includes a PC, a motion controller, a pulse converter, an X-axis servo driver, a Y-axis servo driver, a Z-axis Servo drive, X-axis servo motor, Y-axis servo motor, Z-axis servo motor, three-coordinate measuring machine, sensor, low-speed photocoupler and high-speed photocoupler, the sensor is a grating ruler or an encoder;

所述运动控制器分别与PC机、脉冲转换器、低速光电耦合器及高速光电耦合器连接,所述脉冲转换器分别与X轴伺服驱动器、Y轴伺服驱动器及Z轴伺服驱动器连接,所述X轴伺服驱动器通过X轴伺服电机连接至三坐标测量机,所述Y轴伺服驱动器通过Y轴伺服电机连接至三坐标测量机,所述Z轴伺服驱动器通过Z轴伺服电机连接至三坐标测量机,所述传感器分别与X轴伺服电机、Y轴伺服电机、Z轴伺服电机、低速光电耦合器及高速光电耦合器连接;整个系统构成了闭环控制系统。The motion controller is respectively connected with PC, pulse converter, low-speed photocoupler and high-speed photocoupler, and the pulse converter is connected with X-axis servo driver, Y-axis servo driver and Z-axis servo driver respectively. The X-axis servo driver is connected to the three-coordinate measuring machine through the X-axis servo motor, the Y-axis servo driver is connected to the three-coordinate measuring machine through the Y-axis servo motor, and the Z-axis servo driver is connected to the three-coordinate measuring machine through the Z-axis servo motor machine, the sensors are respectively connected with the X-axis servo motor, Y-axis servo motor, Z-axis servo motor, low-speed photocoupler and high-speed photocoupler; the whole system constitutes a closed-loop control system.

所述运动控制系统还包括驱动状态输出电路及状态指示灯,所述状态指示灯通过驱动状态输出电路连接至运动控制器;通过在PC机与运动控制器之间采用单片机进行USB通讯,可以大大简化了USB技术的开发,利用USB全速传输,保证了较高的数据传输率,同时无需外加单独的USB电源,且A/D转换器、定时器、USB控制器等器件互相独立工作,对于提高控制器集成度有明显的优势。同时在运动控制器接入驱动状态输出电路,单片机接入状态指示灯,可以实现反馈信号的状态显示及添加外部的控制按钮。The motion control system also includes a drive status output circuit and a status indicator light, and the status indicator lamp is connected to the motion controller through the drive status output circuit; by using a single-chip microcomputer to carry out USB communication between the PC and the motion controller, it can be greatly improved. It simplifies the development of USB technology, uses USB full-speed transmission to ensure a high data transmission rate, and does not need to add a separate USB power supply, and A/D converters, timers, USB controllers and other devices work independently of each other. Controller integration has obvious advantages. At the same time, the motion controller is connected to the drive state output circuit, and the single-chip microcomputer is connected to the state indicator light, which can realize the state display of the feedback signal and add an external control button.

所述运动控制器采用的是研华科技型号为APAX-5580的可编程自动化控制器,配备了两个千兆LAN控制器,控制器芯片在这种型号中都使用了完全兼容的Intel 1x i218和1x i210以太网,控制器具有IEEE 802.3u 10/100Base-T CSMA/CD标准和IEEE 802.3ab规范,用于1000Mbps以太网。以太网端口提供标准RJ-45插孔板和LED指示灯,以显示其链路(绿色LED)和活动(黄色LED)状态。该控制器可以同时控制5个轴,实现多轴协调运动。同时,研华APAX-5580控制器还配有专用的Codesys PLC Control软件进行运动控制的开发。Codesys PLC Control为PLC编程提供了一种简便的方法,可以自由地处理功能强大的IEC语言。编辑器和调试功能的使用则基于先进编程语言和已验证的程序开发环境。在本发明中研华APAX-5580控制器控制3台伺服电机分别完成三坐标测量机的X轴运动、Y轴运动和Z轴运动。而X轴、Y轴、Z轴各有4个开关输入信号,即左(上)、右(下),极限位置(MLTP、LMTM),原点(Home)位置和工作位置(INO、INI)。The motion controller used is Advantech's programmable automation controller model APAX-5580, which is equipped with two Gigabit LAN controllers. The controller chips in this model all use fully compatible Intel 1x i218 and 1x i210 Ethernet, the controller has IEEE 802.3u 10/100Base-T CSMA/CD standard and IEEE 802.3ab specification for 1000Mbps Ethernet. The Ethernet port provides a standard RJ-45 jack plate and LED indicators to show its link (green LED) and activity (yellow LED) status. The controller can control 5 axes at the same time to realize multi-axis coordinated motion. At the same time, Advantech APAX-5580 controller is equipped with dedicated Codesys PLC Control software for motion control development. Codesys PLC Control provides an easy way for PLC programming, which can freely handle the powerful IEC language. The use of editors and debugging functions is based on advanced programming languages and proven program development environments. In the present invention, the Advantech APAX-5580 controller controls three servo motors to complete the X-axis movement, Y-axis movement and Z-axis movement of the three-coordinate measuring machine respectively. The X-axis, Y-axis, and Z-axis each have 4 switch input signals, namely left (up), right (down), limit position (MLTP, LMTM), origin (Home) position and working position (INO, INI).

所述脉冲转换器的型号为SA1400。The model of the pulse converter is SA1400.

所述运动控制器与所述传感器之间用光电耦合器进行电气隔离,以提高抗干扰能力,使运动控制器工作稳定。运动控制器分别接入低速光电耦合器、高速光电耦合器实现输出信号的采集,低速光电耦合器,使用Shpar公司PC357芯片,用于接收通用输出信号,包括限位开关信号(LMT+/LMT一),到位信号(INPOS)、服警信号(ALARM)和紧急开关信号(EMGN),能起到滤波和延时的作用;高速光电耦合器,使用AGL公司HCPL-2630芯片,用于接收反馈的编码器、光栅尺信号,并进行电气隔离,其最大通过频率可达10MHz。The motion controller and the sensor are electrically isolated by a photoelectric coupler to improve the anti-interference ability and make the motion controller work stably. The motion controller is respectively connected to a low-speed photocoupler and a high-speed photocoupler to realize the collection of output signals. The low-speed photocoupler uses the PC357 chip of Shpar Company to receive general output signals, including limit switch signals (LMT+/LMT1) , in-position signal (INPOS), service alarm signal (ALARM) and emergency switch signal (EMGN), which can play the role of filtering and delay; high-speed photocoupler, using AGL company HCPL-2630 chip, used to receive feedback coding The signal of the device and the grating ruler are electrically isolated, and its maximum passing frequency can reach 10MHz.

请参阅图2所示,本发明的一种三坐标测量机的运动控制方法,所述运动控制方法需提供上述的一种三坐标测量机的运动控制系统,所述运动控制方法具体包括如下步骤:Please refer to Fig. 2, a motion control method of a three-coordinate measuring machine of the present invention, the motion control method needs to provide the above-mentioned motion control system of a three-coordinate measuring machine, and the motion control method specifically includes the following steps :

步骤1、所述PC机通过串行总线与运动控制器连接进行通信,所述PC机发送控制指令给运动控制器;Step 1, the PC is connected to the motion controller through a serial bus to communicate, and the PC sends a control command to the motion controller;

步骤2、所述运动控制器接收到该控制指令后,产生对应的驱动脉冲信号和方向脉冲信号发送给所述脉冲转换器;Step 2. After receiving the control instruction, the motion controller generates a corresponding drive pulse signal and direction pulse signal and sends them to the pulse converter;

步骤3、所述脉冲转换器接收到驱动脉冲信号和方向脉冲信号后,将其转换成驱动数字信号,并发送给对应的X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器;Step 3. After receiving the driving pulse signal and the direction pulse signal, the pulse converter converts it into a driving digital signal and sends it to the corresponding X-axis servo driver, Y-axis servo driver, and Z-axis servo driver;

步骤4、所述X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器接收到驱动数字信号后,分别驱动X轴伺服电机、Y轴伺服电机、Z轴伺服电机转动,完成相应的机械动作,从而带动所述三坐标测量机三个轴的运动;Step 4. After the X-axis servo driver, Y-axis servo driver, and Z-axis servo driver receive the driving digital signal, they respectively drive the X-axis servo motor, Y-axis servo motor, and Z-axis servo motor to rotate to complete corresponding mechanical actions. Thereby driving the movement of the three axes of the three-coordinate measuring machine;

步骤5、所述传感器采集X轴伺服电机、Y轴伺服电机、Z轴伺服电机的通用输出信号和外部反馈信号,并发送给低速光电耦合器和高速光电耦合器;Step 5, the sensor collects general output signals and external feedback signals of the X-axis servo motor, Y-axis servo motor, and Z-axis servo motor, and sends them to the low-speed photocoupler and the high-speed photocoupler;

步骤6、所述低速光电耦合器接收通用输出信号,所述通用输出信号包括限位开关信号、到位信号、服警信号和紧急开关信号,并进行滤波后发送给运动控制器;所述高速光电耦合器接收外部反馈信号,并进行电气隔离后发送给运动控制器,所述外部反馈信号包括故障信号和电机运行参数信号,故障信号是电机状态信号,由热继电器(或其它保护装置)的辅点提供,这些保护装置因电机故障而动作时,它就发出故障信号;电机运行参数信号是电机运行的环境信号,如运行的电流、温度、振动、速度、润滑油、液位等,这些都是经过变送器转换为模拟信号输入给运动控制器中的PLC等;Step 6, the low-speed photoelectric coupler receives the general output signal, the general output signal includes limit switch signal, in-position signal, service alarm signal and emergency switch signal, and sends it to the motion controller after filtering; the high-speed photoelectric coupler The coupler receives the external feedback signal and sends it to the motion controller after electrical isolation. The external feedback signal includes the fault signal and the motor operation parameter signal. When these protection devices operate due to motor failure, it will send out a fault signal; the motor operating parameter signal is the environmental signal of the motor operation, such as operating current, temperature, vibration, speed, lubricating oil, liquid level, etc. It is converted into an analog signal by a transmitter and input to the PLC in the motion controller, etc.;

步骤7、所述运动控制器通过通用输出信号和外部反馈信号将三坐标测量机的实时状态反馈给PC机,以便PC机进行调度。Step 7. The motion controller feeds back the real-time status of the CMM to the PC through the general output signal and the external feedback signal, so that the PC can perform scheduling.

所述运动控制器输出脉冲有两种模式:定长脉冲输出模式和连续脉冲输出模式,通过设置控制器中的寄存器来选择相应的脉冲输出模式。The motion controller has two modes for outputting pulses: a fixed-length pulse output mode and a continuous pulse output mode, and the corresponding pulse output mode is selected by setting a register in the controller.

所述PC机与运动控制器之间的通讯方式是通过USB总线进行USB通讯,USB实现PC机与运动控制器通信,将运动控制器的实时状态反馈给PC机,以便于PC机控制,同时PC机控制信号通过USB总线传输给运动控制器。USB总线因其具有着即插即用、支持热插拔、性价比高、可扩展多达127个被控设备等诸多SIA和PCI总线所不及的优点而得以迅速发展。The communication mode between the PC and the motion controller is to carry out USB communication through the USB bus, and the USB realizes the communication between the PC and the motion controller, and feeds back the real-time state of the motion controller to the PC, so that the PC can control it, and at the same time The PC control signal is transmitted to the motion controller through the USB bus. The USB bus has developed rapidly because of its many advantages that the SIA and PCI buses cannot match, such as plug-and-play, hot-swappable, cost-effective, and expandable up to 127 controlled devices.

三坐标测量机通过X、Y、Z轴运动,带动了工件在三个方向分别运动,对工件实施测量。基于运动控制系统的硬件选择,本发明采用CoDeSys软件,对整个运动控制系统进行模拟仿真。The three-coordinate measuring machine drives the workpiece to move in three directions through the movement of X, Y, and Z axes, and measures the workpiece. Based on the hardware selection of the motion control system, the present invention uses CoDeSys software to simulate the entire motion control system.

CoDeSys(Controlled Development System)是由德国3S公司开发的控制器平台软件,国内外有很多自动化公司(例如ABB、博世力士乐、雷赛科技等)都采用了CoDeSys软件开发属于自己的控制系统产品。CoDeSys (Controlled Development System) is a controller platform software developed by German 3S company. Many automation companies at home and abroad (such as ABB, Bosch Rexroth, Leisai Technology, etc.) have adopted CoDeSys software to develop their own control system products.

CoDeSys作为一种编程系统,它与设备无关,它是可编程逻辑控制PLC完整开发的环境,程序员在PLC编程时,CoDeSys给强大IEC语言提供了相对便捷的方法,编程系统的调试器和编辑器功能是在高级编程语言基础上。CoDeSys不仅支持IEC61131-3标准的编程语言,还支持C语言和CoDeSys的实时结合,在工程中对多个控制器设备进行相应的配置。As a programming system, CoDeSys has nothing to do with equipment. It is an environment for the complete development of programmable logic control PLC. When programmers program PLC, CoDeSys provides a relatively convenient method for the powerful IEC language. The debugger and editor of the programming system The processor function is based on a high-level programming language. CoDeSys not only supports the IEC61131-3 standard programming language, but also supports the real-time combination of C language and CoDeSys, and configures multiple controllers in the project accordingly.

CoDeSys支持五种编程语言:功能块图(FBD)、结构化文本(ST)、顺序功能图(SFC)、梯形逻辑图(LD)、指令表(IL)。使用时有许多语言可供选择,而且其语言具有通用性,在各种条件下都能适用。除此之外,CoDeSys提供了连续功能图(CFC)的编程方式。CoDeSys supports five programming languages: Function Block Diagram (FBD), Structured Text (ST), Sequential Function Chart (SFC), Ladder Logic Diagram (LD), and Instruction List (IL). There are many languages to choose from when using, and the language is universal and can be used in various conditions. In addition, CoDeSys provides a continuous function chart (CFC) programming method.

本发明的操作过程如下:The operating process of the present invention is as follows:

1、准备工作:1. Preparation:

(1)PC机和APAX-5580运动控制器连接的两个网口设置IP;(1) Set the IP of the two network ports connected to the PC and the APAX-5580 motion controller;

(2)安装SA1400脉冲转换器设备文件;(2) Install the SA1400 pulse converter device file;

菜单--工具--设备库--安装,Menu--Tools--Device Library--Installation,

文件类型一定要选择为“EtherCAT XML设备描述配置文件”The file type must be selected as "EtherCAT XML Device Description Configuration File"

选择SA1400脉冲转换器的设备描述配置文件Select Device Description Profile for SA1400 Pulse Converter

安装后在设备库的现场总线--Ethercat--从站--Smartind...下有SA1400脉冲转换器设备After installation, there is an SA1400 pulse converter device under the fieldbus--Ethercat--slave--Smartind... of the device library

2、新建工程Standard project SoftMotion CFC:2. New project Standard project SoftMotion CFC:

3、设置PLC:3. Set the PLC:

(1)双击Device(1) Double-click Device

(2)通讯设置页,扫描网络,选择扫描到的设备(2) Communication settings page, scan the network, select the scanned device

(3)PLC设置页,PLC settings区域,(3) PLC setting page, PLC settings area,

(4)"Always update variables"选择"Enabel 2(always in bus cycle task)"(4) "Always update variables" select "Enabel 2(always in bus cycle task)"

4、添加背板和IO设备:4. Add backplane and IO devices:

(1)鼠标右键Device,添加专用设备-Backplane(1) Right mouse button Device, add special device-Backplane

(2)登录,扫描Backplane,选择设备(2) Login, scan Backplane, select device

5、添加SA1400脉冲转换器:5. Add SA1400 pulse converter:

(1)鼠标右键点击Device,选择添加设备(1) Right-click Device and select Add Device

(2)现场总线--Ethercat--主站--EhterCAT Master,按钮添加设备(2) Fieldbus--Ethercat--master station--EhterCAT Master, button to add equipment

(3)鼠标双击EhterCAT Master,在"从站"页EtherCAT NIC Setting区域点击按钮Browse(3) Double-click the EtherCAT Master, and click the button Browse in the EtherCAT NIC Setting area of the "Slave" page

选择APAX-5580运动控制器与SA1400脉冲转换器连接的"CoDeSys EtherExpressGBit PCI Ethernet Adapter"Select "CoDeSys EtherExpressGBit PCI Ethernet Adapter" connecting APAX-5580 motion controller and SA1400 pulse converter

在Option区域,勾选"Auto restart slaves"In the Option area, check "Auto restart slaves"

(4)给SA1400脉冲转换器通电(4) Power on the SA1400 pulse converter

菜单--在线--登录到Menu--Online--Login to

鼠标右键点击"EtherCAT_Master(EtherCAT Master)",选择扫描设备Right-click "EtherCAT_Master(EtherCAT Master)" and select Scan Device

(5)菜单--在线--退出(5) Menu - Online - Exit

鼠标右键点击"Smartind_Pluse_Module(SA1400)",Right-click "Smartind_Pluse_Module(SA1400)",

选择"Add SoftMotion CiA402Axis"Select "Add SoftMotion CiA402Axis"

添加3个轴Add 3 axes

(6)鼠标右键点击3个轴,选择属性,重命名为AxisX-AxisZ(6) Right-click on the three axes, select Properties, and rename them to AxisX-AxisZ

(7)鼠标双击3个轴,在"SoftMotion驱动:缩放/映射"(7) Double-click the 3 axes, in "SoftMotion drive: scaling/mapping"

"比例缩放"区域,在"反转方向"检查框下,第一个数据,输入步进电机的每转脉冲数,这里输入400In the "Scaling" area, under the "Reverse direction" check box, the first data, enter the number of pulses per revolution of the stepper motor, here enter 400

6、添加CNC程序:6. Add CNC program:

Application右键--添加对象--CNC程序Din66025SMC_OutQueueRight click on Application--Add Object--CNC Program Din66025SMC_OutQueue

7、编写程序:7. Write the program:

(1)鼠标双击PLC_PRG(1) Double-click PLC_PRG

(2)添加轴3个(2) Add 3 axes

(3)添加MC_Power运算块3个用于对驱动器使能状态进行控制("on"或者"off")(3) Add 3 MC_Power operation blocks to control the enable state of the drive ("on" or "off")

(4)添加SMC_Interpolator运算块1个(4) Add one SMC_Interpolator operation block

SMC_Interpolator用于将连续路径转化为点信息SMC_Interpolator is used to convert continuous paths into point information

(5)添加SMC_TRAFO_Gantry3运算块1个(5) Add one SMC_TRAFO_Gantry3 operation block

(6)添加SMC_ControlAxisByPos运算块3个(6) Add 3 SMC_ControlAxisByPos operation blocks

SMC_ControlAxisByPos用于在驱动器结构中设定目标位置,和SMC_Interpolator功能块的配合使用。SMC_ControlAxisByPos is used to set the target position in the drive structure and is used in conjunction with the SMC_Interpolator function block.

8、运行8. Run

虽然以上描述了本发明的具体实施方式,但是熟悉本技术领域的技术人员应当理解,我们所描述的具体的实施例只是说明性的,而不是用于对本发明的范围的限定,熟悉本领域的技术人员在依照本发明的精神所作的等效的修饰以及变化,都应当涵盖在本发明的权利要求所保护的范围内。Although the specific embodiments of the present invention have been described above, those skilled in the art should understand that the specific embodiments we have described are only illustrative, rather than used to limit the scope of the present invention. Equivalent modifications and changes made by skilled personnel in accordance with the spirit of the present invention shall fall within the protection scope of the claims of the present invention.

Claims (9)

1.一种三坐标测量机的运动控制系统,其特征在于:所述运动控制系统包括PC机、运动控制器、脉冲转换器、X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器、X轴伺服电机、Y轴伺服电机、Z轴伺服电机、三坐标测量机、传感器、低速光电耦合器及高速光电耦合器,所述运动控制器分别与PC机、脉冲转换器、低速光电耦合器及高速光电耦合器连接,所述脉冲转换器分别与X轴伺服驱动器、Y轴伺服驱动器及Z轴伺服驱动器连接,所述X轴伺服驱动器通过X轴伺服电机连接至三坐标测量机,所述Y轴伺服驱动器通过Y轴伺服电机连接至三坐标测量机,所述Z轴伺服驱动器通过Z轴伺服电机连接至三坐标测量机,所述传感器分别与X轴伺服电机、Y轴伺服电机、Z轴伺服电机、低速光电耦合器及高速光电耦合器连接。1. A motion control system of a three-coordinate measuring machine, characterized in that: the motion control system includes a PC, a motion controller, a pulse converter, an X-axis servo driver, a Y-axis servo driver, a Z-axis servo driver, an X Axis servo motor, Y-axis servo motor, Z-axis servo motor, three-coordinate measuring machine, sensor, low-speed photocoupler and high-speed photocoupler, the motion controller is connected with PC, pulse converter, low-speed photocoupler and The high-speed photocoupler is connected, and the pulse converter is respectively connected with the X-axis servo driver, the Y-axis servo driver and the Z-axis servo driver. The X-axis servo driver is connected to the three-coordinate measuring machine through the X-axis servo motor. The Y The axis servo driver is connected to the three-coordinate measuring machine through the Y-axis servo motor, the Z-axis servo driver is connected to the three-coordinate measuring machine through the Z-axis servo motor, and the sensors are respectively connected to the X-axis servo motor, Y-axis servo motor, and Z-axis Servo motor, low-speed photocoupler and high-speed photocoupler connection. 2.如权利要求1所述的一种三坐标测量机的运动控制系统,其特征在于:所述运动控制系统还包括驱动状态输出电路及状态指示灯,所述状态指示灯通过驱动状态输出电路连接至运动控制器。2. The motion control system of a three-coordinate measuring machine as claimed in claim 1, characterized in that: the motion control system also includes a drive state output circuit and a status indicator light, and the state indicator light passes through the drive state output circuit Connect to motion controller. 3.如权利要求1所述的一种三坐标测量机的运动控制系统,其特征在于:所述运动控制器的型号为APAX-5580。3. The motion control system of a three-coordinate measuring machine according to claim 1, wherein the model of the motion controller is APAX-5580. 4.如权利要求1所述的一种三坐标测量机的运动控制系统,其特征在于:所述脉冲转换器的型号为SA1400。4. The motion control system of a three-coordinate measuring machine according to claim 1, wherein the model of the pulse converter is SA1400. 5.如权利要求1所述的一种三坐标测量机的运动控制系统,其特征在于:所述传感器为光栅尺或编码器。5. The motion control system of a three-coordinate measuring machine according to claim 1, wherein the sensor is a grating ruler or an encoder. 6.一种三坐标测量机的运动控制方法,其特征在于:所述运动控制方法需提供如权利要求1所述的一种三坐标测量机的运动控制系统,所述运动控制方法具体包括如下步骤:6. A motion control method for a three-coordinate measuring machine, characterized in that: the motion control method needs to provide a motion control system for a three-coordinate measuring machine as claimed in claim 1, and the motion control method specifically includes the following step: 步骤1、所述PC机通过串行总线与运动控制器连接进行通信,所述PC机发送控制指令给运动控制器;Step 1, the PC is connected to the motion controller through a serial bus to communicate, and the PC sends a control command to the motion controller; 步骤2、所述运动控制器接收到该控制指令后,产生对应的驱动脉冲信号和方向脉冲信号发送给所述脉冲转换器;Step 2. After receiving the control instruction, the motion controller generates a corresponding drive pulse signal and direction pulse signal and sends them to the pulse converter; 步骤3、所述脉冲转换器接收到驱动脉冲信号和方向脉冲信号后,将其转换成驱动数字信号,并发送给对应的X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器;Step 3. After receiving the driving pulse signal and the direction pulse signal, the pulse converter converts it into a driving digital signal and sends it to the corresponding X-axis servo driver, Y-axis servo driver, and Z-axis servo driver; 步骤4、所述X轴伺服驱动器、Y轴伺服驱动器、Z轴伺服驱动器接收到驱动数字信号后,分别驱动X轴伺服电机、Y轴伺服电机、Z轴伺服电机转动,完成相应的机械动作,从而带动所述三坐标测量机三个轴的运动;Step 4. After the X-axis servo driver, Y-axis servo driver, and Z-axis servo driver receive the driving digital signal, they respectively drive the X-axis servo motor, Y-axis servo motor, and Z-axis servo motor to rotate to complete corresponding mechanical actions. Thereby driving the movement of the three axes of the three-coordinate measuring machine; 步骤5、所述传感器采集X轴伺服电机、Y轴伺服电机、Z轴伺服电机的通用输出信号和外部反馈信号,并发送给低速光电耦合器和高速光电耦合器;Step 5, the sensor collects general output signals and external feedback signals of the X-axis servo motor, Y-axis servo motor, and Z-axis servo motor, and sends them to the low-speed photocoupler and the high-speed photocoupler; 步骤6、所述低速光电耦合器接收通用输出信号,并进行滤波后发送给运动控制器;所述高速光电耦合器接收外部反馈信号,并进行电气隔离后发送给运动控制器Step 6. The low-speed photocoupler receives the general output signal and sends it to the motion controller after filtering; the high-speed photocoupler receives the external feedback signal and sends it to the motion controller after electrical isolation 步骤7、所述运动控制器通过通用输出信号和外部反馈信号将三坐标测量机的实时状态反馈给PC机,以便PC机进行调度。Step 7. The motion controller feeds back the real-time status of the CMM to the PC through the general output signal and the external feedback signal, so that the PC can perform scheduling. 7.如权利要求6所述的一种三坐标测量机的运动控制方法,其特征在于:所述运动控制器输出脉冲有两种模式:定长脉冲输出模式和连续脉冲输出模式,通过设置运动控制器中的寄存器来选择相应的脉冲输出模式。7. The motion control method of a three-coordinate measuring machine as claimed in claim 6, characterized in that: the motion controller output pulse has two modes: fixed-length pulse output mode and continuous pulse output mode, by setting the motion Register in the controller to select the corresponding pulse output mode. 8.如权利要求6所述的一种三坐标测量机的运动控制方法,其特征在于:所述PC机与运动控制器之间的通讯方式是通过USB总线进行USB通讯。8 . The motion control method of a three-coordinate measuring machine as claimed in claim 6 , wherein the communication mode between the PC and the motion controller is USB communication through a USB bus. 8 . 9.如权利要求6所述的一种三坐标测量机的运动控制方法,其特征在于:所述通用输出信号包括限位开关信号、到位信号、服警信号和紧急开关信号,所述外部反馈信号包括故障信号、电机运行参数信号和环境温度信号。9. The motion control method of a three-coordinate measuring machine as claimed in claim 6, wherein the general output signal includes a limit switch signal, an in-position signal, a service alarm signal and an emergency switch signal, and the external feedback signal Signals include fault signals, motor operating parameter signals and ambient temperature signals.
CN201710564539.3A 2017-07-12 2017-07-12 The kinetic control system and its control method of a kind of three coordinate measuring machine Pending CN107192361A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710564539.3A CN107192361A (en) 2017-07-12 2017-07-12 The kinetic control system and its control method of a kind of three coordinate measuring machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710564539.3A CN107192361A (en) 2017-07-12 2017-07-12 The kinetic control system and its control method of a kind of three coordinate measuring machine

Publications (1)

Publication Number Publication Date
CN107192361A true CN107192361A (en) 2017-09-22

Family

ID=59883068

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710564539.3A Pending CN107192361A (en) 2017-07-12 2017-07-12 The kinetic control system and its control method of a kind of three coordinate measuring machine

Country Status (1)

Country Link
CN (1) CN107192361A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109491312A (en) * 2018-11-15 2019-03-19 广东水利电力职业技术学院(广东省水利电力技工学校) A kind of CNC Robot motion control core implementation method and control system based on Codesys
CN109507946A (en) * 2018-12-10 2019-03-22 上海维宏电子科技股份有限公司 The system and control method of high real-time PLC control function are realized based on CNC controller
CN109521716A (en) * 2018-12-18 2019-03-26 蒋明光 A kind of driver control system
CN111190383A (en) * 2019-12-30 2020-05-22 无锡信捷电气股份有限公司 Method for instantiating pulse axis by using codesys virtual axis
CN115145205A (en) * 2022-07-27 2022-10-04 西安德普赛科计量设备有限责任公司 Three-coordinate measuring machine control system

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6058618A (en) * 1997-09-09 2000-05-09 Giddings & Lewis, Inc. Coordinate measuring machine
CN101598939A (en) * 2008-06-04 2009-12-09 中国科学院自动化研究所 Multiaxial motion servocontrol and protection system
CN101763071A (en) * 2010-01-25 2010-06-30 深圳信息职业技术学院 Independent multi-axis motion controller
CN201955650U (en) * 2011-03-03 2011-08-31 无锡职业技术学院 Three-coordinate motion controller
CN102608950A (en) * 2012-04-12 2012-07-25 苏州天准精密技术有限公司 Control system for three-coordinate measuring machine with bus structure
CN103336471A (en) * 2013-06-14 2013-10-02 华南理工大学 Servo motion control card based on EtherCAT network communication
CN103901822A (en) * 2014-03-11 2014-07-02 中国矿业大学 Multi-shaft linkage motion control system
CN106502143A (en) * 2015-09-07 2017-03-15 哈尔滨卓晋科技有限公司 A kind of construction platform system of computer based motion control card

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6058618A (en) * 1997-09-09 2000-05-09 Giddings & Lewis, Inc. Coordinate measuring machine
CN101598939A (en) * 2008-06-04 2009-12-09 中国科学院自动化研究所 Multiaxial motion servocontrol and protection system
CN101763071A (en) * 2010-01-25 2010-06-30 深圳信息职业技术学院 Independent multi-axis motion controller
CN201955650U (en) * 2011-03-03 2011-08-31 无锡职业技术学院 Three-coordinate motion controller
CN102608950A (en) * 2012-04-12 2012-07-25 苏州天准精密技术有限公司 Control system for three-coordinate measuring machine with bus structure
CN103336471A (en) * 2013-06-14 2013-10-02 华南理工大学 Servo motion control card based on EtherCAT network communication
CN103901822A (en) * 2014-03-11 2014-07-02 中国矿业大学 Multi-shaft linkage motion control system
CN106502143A (en) * 2015-09-07 2017-03-15 哈尔滨卓晋科技有限公司 A kind of construction platform system of computer based motion control card

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109491312A (en) * 2018-11-15 2019-03-19 广东水利电力职业技术学院(广东省水利电力技工学校) A kind of CNC Robot motion control core implementation method and control system based on Codesys
CN109507946A (en) * 2018-12-10 2019-03-22 上海维宏电子科技股份有限公司 The system and control method of high real-time PLC control function are realized based on CNC controller
CN109521716A (en) * 2018-12-18 2019-03-26 蒋明光 A kind of driver control system
CN111190383A (en) * 2019-12-30 2020-05-22 无锡信捷电气股份有限公司 Method for instantiating pulse axis by using codesys virtual axis
CN115145205A (en) * 2022-07-27 2022-10-04 西安德普赛科计量设备有限责任公司 Three-coordinate measuring machine control system
CN115145205B (en) * 2022-07-27 2024-08-23 西安德普赛科计量设备有限责任公司 Three-coordinate measuring machine control system

Similar Documents

Publication Publication Date Title
CN107192361A (en) The kinetic control system and its control method of a kind of three coordinate measuring machine
CN201869158U (en) Alternating current servo drive being compatible with multiple position feedbacks and supporting multiple bus protocols
CN101916098B (en) Multi-axis motion control card with absolute coded disk reading function
CN101086664A (en) Multiple axle movement controller based on MPC5200 and its operation method
CN107765629A (en) A kind of DELTA2 robot control systems based on Soft- PLC and EtherCAT buses
WO2018192498A1 (en) Process guidance system for industrial process control
CN105242587A (en) Double-drive hybrid direct-current and low-voltage intelligent servo driver circuit
CN102520689A (en) Embedded controller based on Godson processor and FPGA (Field Programmable Gate Array) technology
CN114509985A (en) Virtual axis control system based on motion control
CN105680735A (en) ARM processor-based four-axis servo motor motion control card and method
CN108845543A (en) A kind of four axis punching press feeding robot electric control systems
CN201259629Y (en) Configurable I/O module for multiple bus interface
CN100535812C (en) Drive and connecting apparatus of full digital numerical control system
WO2013013523A1 (en) Movement control port and port controller
CN111816039A (en) An electromechanical transmission control system and control method
CN101329570B (en) Synchronous serial bus type numerical control system
CN111650886A (en) Motion control system
CN202351691U (en) Embedded controller based on loongson processor and field programmable gate array (FPGA) technology
CN203911823U (en) Ethernet-based electromotor controller and control system
CN105965511A (en) A Five-axis Manipulator Control System for Injection Molding Machine
CN201749327U (en) A laser motion controller
CN201654544U (en) An Ethernet-based integrated multi-axis motion controller
CN108062049A (en) A kind of embedded multi-shaft motion control system based on STM32
CN201107641Y (en) Full digital numerical control system
CN206959819U (en) A kind of kinetic control system of three coordinate measuring machine

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20170922

WD01 Invention patent application deemed withdrawn after publication