CN2639938Y

CN2639938Y - Insertion type multiple-shaft motion controller

Info

Publication number: CN2639938Y
Application number: CN 03237265
Authority: CN
Inventors: 黄涛; 周云飞; 邓启辉; 朱显新
Original assignee: Huazhong University of Science and Technology
Current assignee: Huazhong University of Science and Technology
Priority date: 2003-09-02
Filing date: 2003-09-02
Publication date: 2004-09-08
Anticipated expiration: 2013-09-02

Abstract

The utility model discloses an embedded multiple spindle motion controller, the RAM expansion and the ROM expansion are connected with the DSP controller to jointly complete the data storage and data processing; the TCP/IP interface is used for connection between the DSP controller and the upper computer to perform the protocol processing of the data link layer; the D/A conversion card performs the digital-analog conversion after receiving the control data from the DSP controller, then the output driver module performs the separation and magnification output to drive the servo control unit; the frequency multiplication counter performs the reshaping, frequency multiplication and counting according to the received position feedback signals and inputs finally the information to the DSP controller. The utility model enables the system motion control with high speed and high precision through the embedded system supporting the floating point arithmetic DSP (Digital Signal Processing) and the feedback of the high speed frequency multiplication counter by DA channel and enables the system open control and information sharing through the general TCP/IP interface.

Description

Embedded multi-axis motion controller

Technical field

The utility model belongs to automatic technology and advanced manufacturing technology field, is specifically related to a kind of embedded multi-axis motion controller.

Background technology

The architecture of digital control system in open type mainly contains two kinds at present: (1) CNC+PC mainboard: a PC mainboard is inserted in traditional CNC machine, the PC plate mainly moves real time operating system, CNC mainly moves the real-time control based on the coordinate axis motion, the CNC series of products that wherein representational product mainly is a Fanuc company; (2) PC+ motion control board: motion control board is inserted control usefulness when putting into effect in the standard sockets of PC, and PC is mainly done non real-time control.Wherein mainly contain the Related product of PMAC company, University of Science and Technology for National Defence, Ling Hua company.The characteristics of this two series products still be unable to do without the bus connecting mode with PC, and its major advantage is that data transfer rate is fast, integrated degree height, parallel computing maturation.Its major defect is to be not suitable for the complicated distributed control system, and the controllable node number is limited, and the Control Node cost is higher, and is high to the anti-interference requirement of on-the-spot PC system.

Fieldbus (FieldBus) is the communication network between factory's underlying device, is the application of the computer digit communication technology in automatic field, and workshop underlying device information and the integrated communication technology platform that provides of production process information are provided.The SERCOS bus is the openingization network interface between a kind of digital drive equipment and motion controller, unites release by VDW and German power electronics association in 1987, and transfer rate reaches 16Mbit/s, can directly carry out the transmission of kinematic axis servo-information.

Connection between each node of present digital control system is mainly based on Sercos bus or Profibus field bus system.The major advantage of this connected mode is to be fit to on-the-spot the connection, and conflict and priority treatment mechanism are arranged, and antijamming capability is stronger.Its major defect is that data transfer rate is low, and interface generality is poor, needs dedicated network and management software, and transmitting range is limited, networking and operating cost height.

The feedback of motion control is mainly from grating chi and scrambler.Output control has direct PWM output and analog quantity and pulse control.The former is fit to direct drive motor, and what mainly solve is driving method and driving force problem; Both provide control signal to servo-driver the back.Since motion controller mainly should resolution system high speed and super precision motion control problem, therefore the control accuracy of the measuring speed of feedback and output is mainly to need the problem considered.The analog quantity control accuracy of most systems is 12 at present, when the feedback count precision is 0.1-1uM, and counting rate＜2MHz.

Summary of the invention

The purpose of this utility model is to provide a kind of embedded multi-axis motion controller that can overcome above-mentioned defective, it is easy to realize distributed high performance control, be fit to the complicated distributed control system, the controllable node number is not received the system slot restriction, and the Control Node cost is low; Its interface data transfer rate height, interface generality is good, does not need dedicated network and management software, and networking and operating cost are low, help realizing integrated with manufacturing platform and UNIVERSAL MANAGEMENT INFORMATION SYSTEM; Can realize high speed, high-precision motion control algolithm.

Embedded multi-axis motion controller of the present utility model comprises dsp controller, frequency multiplication counter, D/A change-over circuit and output driver module, and it is characterized in that: it also comprises RAM expansion, ROM expansion and TCP/IP interface; Expansion links to each other with dsp controller with ROM in the RAM expansion, finishes data storage and data processing jointly; The TCP/IP interface is used for being connected between dsp controller and the host computer, carries out the protocol processes of data link layer; The D/A transition card receives the laggard line number mould conversion of control data of dsp controller, and driver module is isolated and amplify output to drive servo control unit by exporting then; The frequency multiplication counter carries out shaping, frequency multiplication and counting to the position feed back signal that receives, and inputs to by dsp controller again.

The utility model is by the high speed and super precision motion control of supporting the Implementation of Embedded System system that floating-point operation DSP (Digital Signal Processing) constitutes, realize high speed and super precision control by DA passage and high speed frequency multiplication counter feedback, and Open Control and information sharing by general TCP/IP Interface for System.The utility model has following characteristics compared with the prior art:

(1) is different from the common hard syndeton of IPC+DSP bus, system adopts network interface+DSP flexible connection structure, be easy to realize distributed high performance control, be fit to the complicated distributed control system, the controllable node number is not received the system slot restriction, the Control Node cost is low, and on-the-spot PC system no longer is necessary configuration.

(2) being different from conventional node connects mainly based on Sercos bus or Profibus field bus system, and employing is based on the Internet/Intranet network interface of ICP/IP protocol, this interface data transfer rate height, interface generality is good, do not need dedicated network and management software, in theory transmitting range without limits, networking and operating cost are low, help realizing integrated with manufacturing platform and UNIVERSAL MANAGEMENT INFORMATION SYSTEM.

Existing motion control card is in most of the cases finished system control jointly with servo-control system, and the motion controller that the utility model provides focuses on more that multiaxis is coordinated and at a high speed, the realization of high precision compound movement control algolithm.In order to realize better technique effect, the utility model can adopt the floating-point operation DSP of 32bit, adopted the position feedback of 16 bit parallel D/A output control and 10MHz, 28bit, 32bit floating-point operation DSP realizes at a high speed more effectively to cooperate, the high-precision motion control algolithm.

Description of drawings

Fig. 1 is the structural representation of embedded multi-axis motion controller;

Fig. 2 is the functional structure chart of frequency multiplication counter;

Fig. 3 is the structural representation of a kind of embodiment of the present utility model;

Fig. 4 is the structural representation of a kind of embodiment of TCP/IP interface;

Fig. 5 is the overall control synoptic diagram of embedded multi-axis motion controller;

Fig. 6 is a control flow synoptic diagram of the present utility model.

Embodiment

As shown in Figure 1, the utility model comprises dsp controller 1, RAM expansion 2, ROM expansion 3, TCP/IP interface 4, D/A transition card 5, frequency multiplication counter 6 and output driver module 7.

Dsp controller 1 is finished the network protocol layer protocol processes, the explanation of host computer order and execution, the calculating of feedback data, and according to control require, feedback data is finished transplanting calculating and position closed loop control.

ROM expansion 2 storage dsp operation program and fixing controlled variable.

RAM expands 3 storage networking communication datas, feedback data, dynamic controlled variable and various result of calculation.

TCP/IP interface 4 is finished the protocol processes of data link layer, the acceptance of Frame and transmission, data check and buffering.

D/A transition card 5 is finished the digital-to-analog conversion of control data, is isolated with amplification by output driver module 7 then and exports to drive servo control unit.

Frequency multiplication, the counting of frequency multiplication counter 6 completing place measuring-signals, the differentiation of direction of motion, and address decoding between each parts and data buffering.The function of frequency multiplication counter 6 as shown in Figure 2, it comprises that the processing of signal quadruple, counting and direction signal processing and address and data-interface handle three parallel operational modules.For improving the reliability of high-frequency count, eliminate the synchronous operation of corresponding risk competition and realization and DSP, adopt the trigger pip of the synchronizing clock signals of DSP output as the sequential logic design.

The utility model controller carries out shaping, frequency multiplication and counting by the position feed back signal of 6 pairs of receptions of frequency multiplication counter, input to again by dsp controller 1, RAM expansion 2 and ROM expansion 3 and constitute its main operational system, TCP/IP interface 4 is realized general Ethernet interface, and D/A transition card 5 and output driver module 8 are realized control output.

Fig. 3, Fig. 4 have enumerated a kind of embodiment of the present utility model, are specified below.

In order to satisfy high precision, the high dynamically computing requirement of control algolithm, add the utility model and be not used in direct control driver part, therefore no longer adopt the domestic TMS320C240 that generally uses, and adopt the 32bitDSP controller that can carry out floating-point operation.Present embodiment adopts the TMS320C3X series 32bit float-point DSP of TI company, because embedded system needs the support program guiding, TMS320C32 is comparatively suitable in this series.The soft plug-in unit of DSP/BIOS of TI company (Texas Instruments) and the soft plug-in unit of DSP/BIOS RTA (Real-Time Analysis, real-time analysis) are the good selections of creating DSP embedded software external structure.Especially to high-end DSP, its signal analysis and real-time management function can improve the maintainability of design efficiency and system greatly.Dsp system based on embedded platform provides better Real Time Control Function and information sharing interface, helps improving the stability of system and making up open digital control system.FLASHAM29F400 is selected in ROM expansion 3 for use, and CY7c109 is selected in the RAM expansion for use.FLASHAM29F400 is used for storage control program, the program of back among the FLASHAM29F400 that power on and packs into and bring into operation among the quick RAM storer CY7c109.

The utility model adopts the TCP/IP interface, makes it have the open information interface.Because the utility model is supported general ICP/IP protocol, support the controller of this agreement both can independently use, also can make up the DNC system by Intranet, and can directly constitute open manufacturing platform by Intranet/Internet, make control system no longer be subjected to the restriction of transmitting range and hardware cost, do not need to make up dedicated network, special-purpose local PC also no longer is necessary configuration.Drive employing RTL8019 for its core protocol of embedded system and can meet the demands, initiation parameter adopts the 93LC46 chip to realize 8019 power-up initializing.High-rise ARP agreement, IP agreement, udp protocol and Transmission Control Protocol are finished by the DSP program.Decoding scheme finish 8019 with the interface function of DSP, crystal oscillator provides 8019 required work clock signals.

For satisfying the requirement of high speed and super precision motion control, D/A transition card 5 adopts 16bit, 100K four-way D/A output, and all I/O adopt high speed optoelectronic to isolate to improve the antijamming capability of system.Present embodiment adopts the DAC7744 of four-way, and the switching of four passages is realized by the address wire of DSP output, and realizes that by the 16bit data line data transmit.The output of DAC7744 drives servo motion controller through amplifying.The DC/DC module provides DAC7744 operating voltage and reference voltage.

In order to realize high speed, high precision position feedback, frequency multiplication counter 6 adopts that the FLEX10K10 of A1tera companies constitutes four the tunnel, the above 28bit position feedback counting channel FPGA (FieldProgrammable Gate Array) of 10M, during counting precision 10nm, counting rate can reach the 300m/ branch, and counting step can reach 1m.FPGA can also realize turning to and judge and resetting of zero function.Grating chi feedback signal is through entering the counter that FPGA constitutes after the process of frequency multiplication, FPGA can realize that the above counting of 28 10MHz, rotating are judged and with the data-interface of TMS320C32.

Control general structure of the present utility model such as Fig. 5.Mainly realize computing, feedback signal processing modules implement grating chi feedback count, control signal processing modules implement servo driving with the communicating by letter of host computer, computing and control module realization control algolithm by ICP/IP protocol conversion and command interpretation module.

DSP/BIOS that TI provided and the soft plug-in unit of DSP/BIOS RTA are parts that belongs in CCStudio (Code Composer Studio, the spectrum sign indicating number operating room) development environment.DSP/BIOS is the target merge module of one group of small-sized real time operating system, when being used in the application program executed in real time, and capturing events and statistical information from application program, and upload to main frame by standard physical link (as JTAG).Have configurator to realize that be written into master routine from FLASH moves after system powers on to quick RAM, system program finish start plant after, major cycle has the task of three aspects:

(1) checks that earlier host computer has or not control command and control data to pass down, if having then carry out the protocol processes and the host computer command interpretation of data and the relevant work state is set.

(2 check the feedback request that whether has timer to be provided with, if having, get corresponding feedback count from FPGA, and require to calculate relevant location parameter according to control.

(3 check whether control request is arranged, if having, the control that provides according to host computer requires to carry out the computing of control algolithm and judges whether control reaches requirement, if not then export this control data and control; If reached the control requirement, transition status is set, prepare Control Circulation next time.

The course of work of above-mentioned controller is as follows:

Ethernet control chip (RTL8019) is mainly finished the protocol processes of data link layer, when DSP (TDS320C32) will be to online transmission data, earlier frame data are delivered to transmission buffer area among the RTL8019 by long-range DMA (memory directly transmits) passage, send then to transmit and order.RTL8019 finishes the transmission of this frame again after the transmission of having finished previous frame.The data that RTL8019 receives by microprocessor comparison, cyclic redundancy check (CRC) after, deposit send buffer, receive a full frame after, to interrupt or the mode of register flag is notified primary processor.After DSP receives the data of RTL8019, finish the network address translation and simple network protocol conversion, and finally obtain the control command and the data of top service device.

After DSP obtains control command and data that server via Ethernet sends, obtain the controlled variable and the control target in each step through interpolation operation, the counter that constitutes by FPGA (FLEX10K10) obtains current position feed back signal and velocity amplitude simultaneously, send control signal according to selected control method by D/A (DAC7744) conversion then, finish the closed-loop control in each step.

The feedback signal of FPGA forms A, B phase quadruple signal and direction of motion signal by A, the B phase signals (every) of the input of grating chi by logic gate, then by 28 add subtract counter record current locations, when DSP needs position feed back signal, by DSP output feedback request signal and required processing axle, FPGA returns the current location count value to DSP.

Program flow diagram of the present utility model as shown in Figure 5.

Wherein, the procotol processing module can be divided into network interface layer design (comprise the network interface card initialization, send control and receive control three parts), Internet layer design (being mainly ARP and IP design of protocol), transport layer design (UDP and Transmission Control Protocol design) and application layer design (command interpretation).Realize that ARP to LAN broadcast ARP request, receives arp reply, and response ARP request.For improving the efficient of ARP agreement, reduce the quantity of broadcast packet in the network, agreement is optimized.Require agreement to set up the ARP table dynamically updating of buffer memory and ARP table, i.e. address aging are carried out in the address.IP agreement key is to realize the high and general IP checking routine of an efficient.For adapting to the High-speed Control data transmission, adopt UDP efficient height, system overhead is little, and its reliability adopts the method for calibration of design voluntarily to raise the efficiency.

Claims

1, a kind of embedded multi-axis motion controller comprises dsp controller, frequency multiplication counter, D/A change-over circuit and output driver module, and it is characterized in that: it comprises that also RAM expansion (2), ROM expand (3) and TCP/IP interface (4); RAM expansion (2) and ROM expand (3) and link to each other with dsp controller (1), finish data storage and data processing jointly, and TCP/IP interface (4) is used for being connected between dsp controller (1) and the host computer, carries out the protocol processes of data link layer; The laggard line number mould conversion of the control data of D/A transition card (5) reception dsp controller (1) is isolated with amplification by output driver module (7) then and is exported to drive servo control unit; Frequency multiplication counter (6) carries out shaping, frequency multiplication and counting to the position feed back signal that receives, and inputs to by dsp controller (1) again.

2, embedded multi-axis motion controller according to claim 1 is characterized in that: dsp controller (1) but be the 32bitDSP of floating-point operation; D/A transition card (5) is 16bit, 100K four-way D/A output; The 28bit position feedback counting channel that frequency multiplication counter (6) has four tunnel, 10M is above.