A kind of precise flange system and its control method
Technical field
The invention belongs to displacement data acquisition technique field, especially a kind of precise flange system and its method processed.
Background technology
With scientific and technical development, especially the developing rapidly, in the even sub- nano-scale of nanometer of MEMS technology
Motion and location control have become as possibility.This gives human knowledge and utilizes microcosmos, there is provided strong instrument.So-called
Nanometer displacement location technology refers to carry out essence to controlled object (micro Process instrument or micro- survey tool) in nano-precision grade
Close control, to meet its requirement to positioning precision, kinematic accuracy and precision stability, the processing realizing there is function of measuring and
Detection operation.The application of movement control technology mostly motion platform mechanism in a variety of manners or product realizing.Its application neck
Domain is ubiquitous, including almost all of high-tech area.
Control method based on single-chip microcomputer just occurred in the eighties in 20th century, but the occasion of application is mostly right
System operation required precision and the relatively low field of operating cost, the real-time of the calculating speed of service of single-chip microcomputer is poor, in closed loop
The motion of low speed point position is can be only applied to and to running orbit less demanding control occasion in control.
New DSP kinetic control system, using more advanced modular organization, can be with on-chip system (SOC), existing
The high performance process chip such as field programmable gate array (FPGA) and ARM combines, according to different application requirements, by simple
Increase or change module and coupling system programming it is possible to extension or modification system, promptly form a new data
Acquisition system, faster, precision is higher for its arithmetic speed, is widely used in field of precision movement control.
Content of the invention
It is an object of the invention in place of overcoming the deficiencies in the prior art, providing one kind can reach precise control system pair
On the premise of the requirement of control accuracy and speed, save cost and the cycle of early stage research and development, there is extensibility, ease for use simultaneously
Precise flange system and its method processed with stability.
The present invention solves its technical problem and takes technical scheme below to realize:
A kind of precise flange system, including control core module, sensor input module, high drive output mould
Block, multi-channel signal acquiring module, executor module, control target and host computer screen display module;Sensor inputs
The output end of module is connected to the input of control core module by multi-channel data acquisition module;Control core module defeated
Go out end to be connected with the input of high drive output module;Host computer screen display module is bi-directionally connected with control core module;
The output end of high drive output module is connected with the input of executor module;The output end connection of executor module is controlled
The input of object and driving control target;The output end of controlled device is connected with the input of sensor input module.
And, the control core in described control core module is DSP Processor, and it is by data processing module, control
Module and display module are all integrated in one piece of DSP Processor, the multi-channel signal acquiring with DSP Processor as core and process
System design, be divided into following functional module by the schematic diagram completing will be designed:Completed with DSP Processor for core
The collection of data, data processing and data storage, the host interface module being communicated with main frame;The confession of power supply is provided for system
Electric module;Carry out the analog-to-digital conversion module of signals collecting and the D/A converter module changing the data that DSP Processor was processed.
And, the DSP Processor in described control core module and host computer screen display module are transmitted by USB2.0
Agreement is bi-directionally connected;DSP Processor and multi-channel signal acquiring module, high drive output module are all by address bus and control
Bus processed is connected.
And, the external one piece of SDRAM memory of DSP Processor, has also accessed one piece of FLASH memory.
And, described host computer screen display module transmits commands to control core module, and control core module controls quilt
Control object, controlled device is by feedback position information transfer to host computer screen display module.
The step of the control method of above-mentioned precise flange system is:
(1), to electricity in described control system, host computer screen display module and DSP Processor load initialization program, enter
Initial phase;
(2) send initialization success command after the completion of DSP Processor initialization to host computer screen display module, Ran Houjin
Enter wait state;
(3) host computer screen display module sends movement instruction to DSP Processor, after DSP Processor accepts movement instruction,
Enter main circulating program;
(4) the positional information of current three axial directions of x, y, z is passed by sensor input module by multi-channel data acquisition module
It is defeated by DSP Processor, DSP Processor computing draws movement velocity and direction, and result is transferred to host computer screen display mould
Result is converted into analog signal output high drive module by D/A converter module by block simultaneously, drives high drive module
Output port;
(5) high drive module realizes micrometric displacement by driving executor module to control target;
(6) current location information and displacement are passed in real time by sensor input module by multi-channel data acquisition module
It is defeated by DSP Processor, and shows in host computer screen display module, wait the operation of host computer, be finished return main program.
And, step (1) with step (3) in, after system electrification, DSP Processor is to be shown by downloader and host computer screen
Show that module connects, host computer screen display module passes through downloader to DSP Processor transmission signal acquisition instructions, DSP Processor
Obtain signals collecting instruction, enabling signal gathers and the data collecting is stored in pre-assigned space.
And, step (1) in, when Initialize installation is carried out to system, close all of interrupt setting;Starting timer is
Capacitance sensor provides clock pulse signal it is ensured that capacitance sensor normal work;Start I2C program configures D/A converter, protects
Card program can be converted to the execution that analog signal drives actuator below in time after the completion of processing;And open EDMA interruption;Judge
Whether there is interruption, have interruption to enter interrupt service subroutine, complete reception, process and the transmission of data.
And, step (4) in, after program startup optimization, multi-channel data acquisition program is responsible for log-on data collection plate and is sticked into
The collection of row signal, signals collecting program is made up of McASP and EDMA two parts program, is passed through using McASP and EDMA link
EDMA interrupts completing the collection of signal data, and the data collecting is delivered to is analyzed in DSP Processor and processes,
In McASP initialization procedure, the collection of data and transmission are all the McASP serial line interfaces using, and it is each for sending and receiving part
From independent operating.
And, when configuring EDMA, after setting up correct channel link and parameter configuration, meet interrupt condition and enter interruption
Start with EDMA channel transmission data, when a receiving data completes, store data in default space etc. to be analyzed
With calling of processing routine, DSP Processor calls this above-mentioned collection data and data is analyzed, nurses one's health, filtering and be a series of
Algorithm computing after, then by EDMA channel transfer arrive McASP transmission serializer, number is sent to by McASP serial line interface
Weighted-voltage D/A converter PCM3168A carries out D/A converter module and becomes analog signal, enables to drive performer work below.
And, step (4) in, DSP Processor according to the computing mode that the feedback information of sensor input module is carried out is:
In real time result of calculation and objective result are compared tune by the ratio of PID closed loop control algorithm, integration and derivative module
Section, until meeting error requirements, then result is transferred to host computer screen display module.
And, the (5) described executor module of step is the Piezoelectric Driving executor module of nanopositioning stage, and high pressure drives
Dynamic model block realizes nanopositioning stage microbit by the Piezoelectric Driving executor module of this nanopositioning stage to control target
Move.
Advantages of the present invention and good effect are:
1st, the present invention is directed to nanometer displacement and locating platform, designs and develop a set of Signal acquiring and processing based on DSP
System, is capable of data acquisition, real-time processing and the output of multi-channel high-accuracy, and the data of output is converted to analog quantity
Performing module motion is driven to complete motion and the positioning of micro-displacement platform.Adopted for the signal of micro-nano displacement platform by the present invention
Collection and the scheme of processing system one practical feasibility of offer.
2nd, the control core system of the present invention adopts DSP process chip, with DSP+FPGA+ARM tri- core control system phase
Than, have high accuracy, good stability, cost performance high, simple to operate the features such as, disclosure satisfy that what micro-displacement platform proposed leads to more
Road, high-precision data acquisition request.
3rd, the present invention pass through multi-channel data acquisition and processing system micro-displacement platform can realize three-D displacement movement and
Positioning, and one-dimensional, two-dimentional, three-dimensional displacement can be controlled as needed mobile and position, due to this data collecting system energy
Enough realize high-precision data acquisition, low cost, strong interference immunity, can be very good to control cost, micrometric displacement can be applied to
Platform is allowed to realize nano level positioning, is that China develops semiconductor manufacturing facility, flat panel display manufacturing apparatus, big further
Scale memory manufacturing equipment and the advanced manufacturing set industry such as Ultra-precision Turning and measurement, set up an exploitation nanometer displacement
Location technology and the basic platform of product, have important Research Significance.
Brief description
Fig. 1 is the overall structured flowchart of system in the present invention.
Fig. 2 is signal processing module collection and the processing system block diagram of the DSP Processor of the present invention;
Fig. 3 is the data processing structure block diagram with DSP Processor as core of the present invention.
Specific embodiment
The invention will be further described below in conjunction with the accompanying drawings and by specific embodiment, and following examples are descriptive
, it is not determinate it is impossible to protection scope of the present invention is limited with this.
A kind of precise flange system, including control core module, sensor input module, high drive output mould
Block, multi-channel signal acquiring module, executor module, control target and host computer screen display module;Sensor inputs
The output end of module is connected to the input of control core module by multi-channel data acquisition module;Control core module defeated
Go out end to be connected with the input of high drive output module;Host computer screen display module is bi-directionally connected with control core module;
The output end of high drive output module is connected with the input of executor module;The output end connection of executor module is controlled
The input of object and driving control target;The output end of controlled device is connected with the input of sensor input module.
Wherein, the control core in described control core module is DSP Processor, and it is by data processing module, control
Module and display module are all integrated in one piece of DSP Processor, the multi-channel signal acquiring with DSP Processor as core and process
System design, be divided into following functional module by the schematic diagram completing will be designed:Completed with DSP Processor for core
The collection of data, data processing and data storage, the host interface module being communicated with main frame;The confession of power supply is provided for system
Electric module;Carry out the analog-to-digital conversion module of signals collecting and the D/A converter module changing the data that DSP Processor was processed.
DSP Processor in control core module and host computer screen display module pass through the two-way company of USB2.0 host-host protocol
Connect;DSP Processor is all connected with controlling bus by address bus with multi-channel signal acquiring module, high drive output module
Connect.
The external one piece of SDRAM memory of DSP Processor, has also accessed one piece of FLASH memory.
Described host computer screen display module transmits commands to control core module, and it is controlled right that control core module controls
As controlled device is by feedback position information transfer to host computer screen display module.
The step of the control method of above-mentioned precise flange system is:
(1), to electricity in described control system, host computer screen display module and DSP Processor load initialization program, enter
Initial phase, when carrying out Initialize installation to system, closes all of interruption setting;Start timer to carry for capacitance sensor
For clock pulse signal it is ensured that capacitance sensor normal work;Start I2C program configuration D/A converter is it is ensured that program has been processed
Cheng Houneng is converted to the execution that analog signal drives actuator below in time;And open EDMA interruption;Determine whether to interrupt, have
Interrupt entering interrupt service subroutine, complete reception, process and the transmission of data;
(2) send initialization success command after the completion of DSP Processor initialization to host computer screen display module, Ran Houjin
Enter wait state;
(3) host computer screen display module sends movement instruction to DSP Processor, after DSP Processor accepts movement instruction,
Enter main circulating program;
(4) the positional information of current three axial directions of x, y, z is passed by sensor input module by multi-channel data acquisition module
It is defeated by DSP Processor, DSP Processor computing draws movement velocity and direction, and result is transferred to host computer screen display mould
Result is converted into analog signal output high drive module by D/A converter module by block simultaneously, drives high drive module
Output port, after program startup optimization, multi-channel data acquisition program is responsible for log-on data analog input card and is carried out adopting of signal
Collection, signals collecting program is made up of McASP and EDMA two parts program, has been interrupted by EDMA using McASP and EDMA link
Become the collection of signal data, and the data collecting is delivered to be analyzed in DSP Processor and process, DSP Processor according to
The computing mode that the feedback information of sensor input module is carried out is:By the ratio of PID closed loop control algorithm, integration and differential
Result of calculation and objective result are compared regulation by module in real time, until meeting error requirements, then result are transferred to
Position machine screen display module, in McASP initialization procedure, the collection of data and transmission are all the McASP serial line interfaces using,
Sending and receiving part is respective independent operating, when configuring EDMA, after setting up correct channel link and parameter configuration, full
Sufficient interrupt condition enters interruption and starts with EDMA channel transmission data, when a receiving data completes, stores data in pre-
If space in etc. calling with processing routine to be analyzed, DSP Processor call this above-mentioned collection data and data is analyzed,
After conditioning, filtering and a series of algorithm computing, then serializer is sent by EDMA channel transfer to McASP, by McASP
Serial line interface is sent to digital to analog converter PCM3168A to carry out D/A converter module and becomes analog signal, enable to drive after hold
Row device works.
(5) high drive module passes through to drive the Piezoelectric Driving executor module of nanopositioning stage real to control target
Existing nanopositioning stage micrometric displacement;
(6) current location information and displacement are passed in real time by sensor input module by multi-channel data acquisition module
It is defeated by DSP Processor, and shows in host computer screen display module, wait the operation of host computer, be finished return main program.
Below according to accompanying drawing, the detailed operation of this said system and its control method and mentality of designing are described:
As shown in figure 1, the whole design idea of this embodiment is exactly to be come with digital signal processor for core controller
Control microbit shifting movement and the positioning of micro-displacement platform.Set an initial value using host computer and be transferred to Digital Signal Processing
Device, is converted into analog signal by D/A converter module after digital signal processor processes, is transferred to micrometric displacement motion module,
Positioned by driver drives actuator motions, and current positional information is fed back to by Digital Signal Processing by a sensor
Device, forms the control system of a closed loop.Because digital signal processor cannot directly process analog signal, need a modulus
Modular converter converts analog signals into data signal, then by digital signal processor collection and and setting value contrasted until
To the desired value setting, actuator completes micrometric displacement motion positions task stop motion to actuator motions.
After system electrification, Initialize installation can be carried out to system first, and close all of interruption setting;Start timer
There is provided clock pulse signal for capacitance sensor it is ensured that capacitance sensor normal work;Start I2C program configures D/A converter,
Guarantee program can be converted to the execution that analog signal drives actuator below in time after the completion of processing;Start McASP program, open
Transceiver channel;Start EDMA program, set up the link passage of EDMA and McASP, and open EDMA and interrupt;In determining whether
Disconnected, there is interruption to enter interrupt service subroutine, complete reception, process and the transmission of data.
In order to ensure that dsp chip can normally run, initialization should be carried out to chip according to the demand of design first and set
Put.By Initialize installation, dsp chip completes the setting of register initial value, set up interrupt vector table and peripheral components are initial
Change configuration etc..In the present invention, the Initialize installation step of DSP is:
1) initialization of device control register, setting cpu clock is inputted using external clock, timer 1 and McASP0
The pin of multiplexing is set to McASP0 pin, and the pin of timer 0 and McASP0 multiplexing is set to timer 0 pin.
2) initialization interrupt vector setting.
3) initialization timer.
4) close global interrupt.
5) PLL setting and the setting of EMIF interface etc..
After program startup optimization, multi-channel data acquisition program is responsible for the collection that log-on data analog input card carries out signal.
Signals collecting program is made up of McASP and EDMA two parts program, interrupts completing letter by EDMA using McASP and EDMA link
The collection of number, and the data collecting is delivered to be analyzed in DSP and process.
After DSP Processor has carried out analysis, conditioning, filtering and a series of algorithm computing to the data collecting, then
PCM3168A analog-digital converter is sent to by multi channel signals transmission program and carries out analog-to-digital conversion.Transmission program is also simultaneously
PCM3168A analog-digital converter undertakes the tasks such as clock configuration and register configuration.
DSP Processor sends use or McASP serial line interface, and utilizes the clock generator of McASP and frame same
Step generator provides the clock signal of normal work for PCM3168A.The connecing McASP when DSP carries out initial configuration
Receive and tranmitting data register configuration is for asynchronous work mode, receive and transmission can work independently from each other and not interfere with each other.
In order to occur without the phenomenon of loss of data when ensureing and sending, ensureing to meet PCM3168A's during configurable clock generator frequency
In the case of timing requirements, the speed that data transmission rate data receives must also be made to be consistent.And note sending formatting
Unit mask register configuration and send data bit stream data form register configuration it is ensured that receiving data form and send number
According to self-consistentency, in order to avoid making the data of output make a mistake.
When configuring the register of PCM3168A digital to analog converter using DSP Processor as main frame, PCM3168A digital-to-analogue turns
Parallel operation, as slave, after setting register parameters to be configured, detects I2Whether C bus hurries, and sets in slave if not being in a hurry
Need the address of configuration, and produce the condition starting to send data to start data transfer, the value write slave domestic demand setting
Will be in built-in address, in order to ensure that data can be completely written in slave subaddressing, time delay is waited for a period of time, and is sent completely
Produce stop condition afterwards and close I2C bus.
Due to PCM3168A be one eight passages output digital-to-analogue conversion device, and we only employ three therein defeated
Go out passage, in order to reduce chip power consumption reduce chip caloric value, during configuration register close PCM3168A ADC portion and
DAC portion useless.