CN104614002A - Subdivided signal error compensation method for photoelectric encoder of tracking control platform - Google Patents
Subdivided signal error compensation method for photoelectric encoder of tracking control platform Download PDFInfo
- Publication number
- CN104614002A CN104614002A CN201510000536.8A CN201510000536A CN104614002A CN 104614002 A CN104614002 A CN 104614002A CN 201510000536 A CN201510000536 A CN 201510000536A CN 104614002 A CN104614002 A CN 104614002A
- Authority
- CN
- China
- Prior art keywords
- subdivision
- control platform
- error
- module
- photoelectric encoder
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 77
- 238000005259 measurement Methods 0.000 claims abstract description 26
- 230000011218 segmentation Effects 0.000 claims description 45
- 230000003993 interaction Effects 0.000 claims description 10
- 238000012937 correction Methods 0.000 claims description 8
- 238000004891 communication Methods 0.000 claims description 7
- 238000005516 engineering process Methods 0.000 claims description 7
- 238000004458 analytical method Methods 0.000 claims description 5
- 230000000694 effects Effects 0.000 claims description 5
- 230000008569 process Effects 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 5
- 230000006399 behavior Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 238000013139 quantization Methods 0.000 claims description 3
- 239000007787 solid Substances 0.000 claims description 3
- 238000001514 detection method Methods 0.000 abstract description 4
- 238000012360 testing method Methods 0.000 description 14
- 238000013459 approach Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000003287 optical effect Effects 0.000 description 4
- 230000003044 adaptive effect Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000001629 suppression Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 239000000654 additive Substances 0.000 description 1
- 230000000996 additive effect Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000007405 data analysis Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Landscapes
- Optical Transform (AREA)
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
The invention provides a subdivided signal error compensation method for a photoelectric encoder of a tracking control platform, which is suitable for the tracking control platform. The invention compensates the error of the subdivision signal of the encoder measuring module by tracking the position quantity of the controlled object of the control platform. The method has strong practicability and outfield adaptability, and does not need expensive error detection equipment and complex algorithm which causes large delay to the platform. Meanwhile, only shafting position information needs to be acquired, the tracking control platform, the encoder angle measurement module and a software and hardware structure of the lower layer of the platform do not need to be known, the transportability and the operability are strong, time and labor are saved, and a good solution idea is provided for solving the common encoder subdivision signal error problem of the photoelectric tracking control platform.
Description
Technical field
The invention belongs to precision tracking and control technology field, be specifically related to a kind of tracing control platform photoelectric encoder subdivision's signal error compensating method.
Background technology
Tracing control platform requires harsh to catching, following the tracks of and aim at, and precision to rad magnitude, even need want Ultra-Low Speed work, to the axis angle measurement precision of photoelectric encoder and the very high requirement of accuracy proposition.Grating signal cycle size, the consistance of grating and marginal sharpness, optical filter quality, stability in subsequent treatment of optical detection device characteristic and outputting analog signal and dynamic property are the principal elements affecting photoelectric encoder measuring accuracy.Also alignment error will be considered, measured axis bearing error, the impact on measuring accuracy such as the additive error that read head alignment error causes for the angular encoder without built-in bearing.For built-in bearing angular encoder and internal stator shaft coupling angular encoder, also need the error considering that shaft coupling brings.What these factors were measured scrambler affects in the present subdivision's signal error of final body, and improving scrambler precision need revise subdivision's signal error or compensate.For the impact that subdivision's signal error causes scrambler angle measurement accuracy, usually remedy from error-detecting and error compensation two aspects.Subdivision's signal error measure aspect, if detect the origin cause of formation of subdivision error, value or dynamic law, just can evade the factor that produces error as far as possible or directly compensate subdivision error, to improve scrambler precision.Subdivision error measuring method Problems existing is that encoder errors pick-up unit is complicated, and testing process is loaded down with trivial details, strict to environmental requirement, mostly can only detect in laboratory conditions, not be adapted at working site and detect scrambler.In addition, pick-up unit can only realize detecting the static error of scrambler mostly, can not well realize detecting the dynamic error of scrambler.Expensive price is also limit its key factor applied in Practical Project.Subdivision error compensation aspect, stresses based on BP neural network and the research based on the intelligence such as radial primary function network and adaptive algorithm more.Scrambler subdivision error compensation method Problems existing is that error correction needs to carry out under the comparatively ideal environment such as laboratory, action is only carried out revising or compensating for the subdivision error of scrambler angle measurement module, do not consider that scrambler angle measurement module application is when complicated large platform axle system, the impact that subdivision error causes whole platform.Therefore, these subdivision error compensation methodes are difficult to the situations such as the change of adaptation photoelectric encoder working site and working environment.For the above-mentioned shortcoming that current encoder device subdivision's signal error compensating method exists, the present invention proposes a kind of tracing control platform photoelectric encoder subdivision's signal error compensating method.The method practicality and outfield adaptable, without the need to expensive error detecting facility and the complicated algorithm bringing the larger time delay of platform.Simultaneously, the method only needs to obtain axle system positional information, without the need to understanding photoelectric control platform and scrambler angle measurement module and platform lower floor software and hardware structure, portable can functipnal capability strong, time saving and energy saving, for the scrambler subdivision's signal error problem solving photoelectric control platform common provides a good resolving ideas.This approach reduce the impact of subdivision's signal error on tracing control platform, improve tracing control platform angle measuring precision of photoelectric encoder, make platform have wider bandwidth, higher rigidity, faster response speed, stronger load capacity and better stability.
Chinese patent literature storehouse discloses the application for a patent for invention technology that a kind of name is called " detection method of high-precision encoder photosignal subdivision error " (number of patent application 201210488003.5), this application for a patent for invention technology discloses a kind of method measuring super-long guiding rail linearity, relates to a kind of method measuring guide rail especially super-long guiding rail linearity.The present invention solves that existing measuring method measuring accuracy is low, error is large, and there is the problem of data processing and computing more complicated.The method of the invention is measured by laser tracker, gather some data points on super-long guiding rail, space line matching is carried out to these data points, adopt the data message of least square fitting algorithm to the N number of test sample point gathered to carry out linearity calculating, the linearity of guide rail can be obtained.Method data analysis of the present invention and experimental implementation is easy, the test duration is short, data processing is simple, testing cost is low and testing efficiency is very high.Its weak point is that this patent of invention laser tracker device is only suitable for linear encoder, be not suitable for angular encoder, its error detecting facility is expensive, practicality and outfield adaptive faculty not strong, require high to photoelectric control platform and coder module and platform lower floor software and hardware structure familiarity, portable can functipnal capability poor, be difficult to adapt to the situations such as the change of photoelectric encoder working site and working environment.
Summary of the invention
For solving scrambler subdivision's signal error, more serious impact is caused on tracing control platform stabilization and tracing control precision, and subdivision's signal error compensating method conventional is at present in practicality, outfield adaptive faculty, price, portable can functipnal capability and the real-time aspect problem that cannot satisfy the demands, and the invention provides a kind of tracing control platform photoelectric encoder subdivision's signal error compensating method.
The technical solution used in the present invention is: a kind of tracing control platform photoelectric encoder subdivision's signal error compensating method, tracing control platform comprises main processor modules, memory module, display module, power module, execution module, controlled module, photoelectric encoder measurement module, communication interface modules and human-computer interaction module.Tracing control platform is centered by main processor modules, controlled module is tracing control platform courses object, photoelectric encoder measurement module is for measuring the displacement of controlled module, execution module is used for driving and controlling controlled module, memory module is connected with main processor modules for storing real-time processing data and program curing etc., the display module be connected in main processor modules is mainly used to display controlled module dynamically and behavior, communication module is used for the information interaction of intermodule, human-computer interaction module main convenient operation person's usage track control system, power module is then for whole hardware platform provides power supply supply.
This tracing control platform photoelectric encoder subdivision's signal error compensating method realizes according to the following steps:
Step (1), parametric controller photoelectric encoder export the two-way orthogonal signal obtained by Moire fringe technology, and waveform is quasi-sine-wave, and sinusoidal wave and cosine wave (CW) is expressed as follows:
Wherein, subdivision's signal A and B is made up of four parts, A
0and B
0representing signal DC component, is DC error source; A
mand B
mrepresenting fundamental signal amplitude, is signal amplitude error source;
representing higher hamonic wave sum, is harmonic component source of error; δ
erepresenting electrical noise, is noise source; In addition, be converted to quantization error source between the photoelectric encoder segmentation analog quantity of angle and digital quantity, the phase differential of A and B two paths of signals is phase error source;
There is the encoder applies platform of requirements for high precision, high segmentation multiple be reached, arc tangent divided method need be adopted.Divided method and subdivision error are shown below.
Wherein, θ
rrepresent true theoretical segmentation angle, θ
dfor measuring gained segmentation angle, △ θ is subdivision's signal error.
Judge that subdivision error is to parametric controller Accuracy degree, if faint to ignoring, then algorithm terminates.Otherwise by the above-mentioned mathematical analysis error in judgement Source Type to subdivision's signal error;
Step (2), calculating parametric controller subdivision error compensation method initial parameter:
A) encoder system resolution:
B) scrambler grating angular resolution:
C) subdivision's signal segmentation resolution:
AllBit, CoarseBit, FineBit represent photoelectric encoder figure place respectively, thick code bit number and smart code bit number.Wherein, the individual pen raster count that thick representation photoelectric encoder code-disc physics is portrayed, smart representation slender sub-signal cyclical electrical segmentation number;
Step (3), to ask the thick representation of actual measurement axle system position
then use the position quantity θ of thick representation
p_Coarsefor: θ
p_Coarse=CoarseCode*Q
c.Be θ by smart representation for the position quantity segmented
p_Fine=θ
p-θ
p_Coarse;
Step (4), reality of looking for the truth segment angle value
Step (5), judge whether segmentation angular phasing offsets zero point, if offset, asking by now segmenting angle zero point is the segmentation angular metric θ that starting point measures
dRfor: θ
dR=θ
d-InitialAngle.θ
drepresent the actual segmentation angle measured, its expression formula according to different subdivision error types by θ
rand the expression formula of A and B is tried to achieve, InitialAngle represents the side-play amount of segmentation angle null position.If segmentation angular phasing is without offseting zero point, θ
dR=θ
d;
Step (6), ask corresponding θ
dRsmart code
then the total code of absolute fix is CodeAll=CoarseCode2
fineBit+ FineCode;
Step (7), by formula CodeAll=CoarseCode2
fineBit+ FineCode and ACoarseCode=CoarseCode, release step (6) obtains the thick code in total code
(ACoarseCode and CoarseCode difference is that aspect, source is different, and the former is separated by the total code value inputting this module, and the latter is obtained by axle system absolute fix amount, and both are equivalence in theory).This step effect to be further purified thick code value, makes it more accurate;
Step (8), ask and do not revise smart code NCFineCode=CodeAll-ACoarseCode;
Step (9), ask the segmentation angle of the smart representation of uncorrected segmentation
(FinePhaseOrigin and θ
dRsource is different, and the former is from not revising smart code, and the latter derives from axle system position measurements.Owing to rounding, the former is worth generally can be less than the latter);
Step (10), if there is zero point drift, segments angle measurement θ
d=FinePhaseOrigin+InitialAngle, otherwise θ
d=FinePhaseOrigin;
Step (11), according to different subdivision error types, elaborate division by calculation signal errors amount △ θ, i.e. correction;
Step (12), ask revised segmentation angle θ
dc=θ
d+ △ θ;
Step (13), ask revised smart code
then revised total code is obtained by following formula:
CodeAllCorrected=ACoarseCode+FineCodeCorrected
Step (14), calculate revised axle system positional value θ
pC: θ
pC=CodeAllCorrectedQ
Step (15), by revised position quantity θ
pCbe brought in this tracing control platform by feedback.
Wherein, the main processor modules of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention can be one or more in PC, FPGA, PowerPC and DSP.
Wherein, the memory module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention can be electronic solid state hard disk, one or more in TF, CF or SD card.
Wherein, the display module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention can be OLED or LCD.
Wherein, the power module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention adopts specific power management chip, comprises battery and battery charger simultaneously.
Wherein, the execution module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention is that the proprietary power level of controlled device drives.
Wherein, the controlled module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention is tracing control platform courses end and control object.
Wherein, the photoelectric encoder measurement module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention be the code used device of platform and with scrambler by the supporting segmentation of special interface and digitizing electronics equipment.
The present invention's advantage is compared with prior art:
The present invention is by carrying out theoretical analysis to photoelectric encoder subdivision's signal error, by tracing control platform, contrast existing subdivision's signal error compensating method, can not change photoelectric encoder angle measuring system, do not adopt complicated impact to follow the tracks of the intelligent algorithm of rapidity simultaneously, but utilize photoelectric encoder place tracking control system absolute fix amount correction photoelectric encoder subdivision's signal error.It is high that the present invention can be applicable to precision, real-time, and the scrambler of the high main equipment of complexity exports subdivision's signal error compensation.Meanwhile, practicality of the present invention and outfield adaptable, without the need to expensive error detecting facility and the complicated algorithm bringing the larger time delay of system.In addition, the present invention only needs to obtain axle system positional information, without the need to understanding Light Electronic Control System and encoder angle measuring system and system lower floor software and hardware structure, portable can functipnal capability strong, time saving and energy saving, for the scrambler subdivision's signal error problem solving Light Electronic Control System common provides a good solution.This approach reduce the impact of subdivision's signal error on tracing control platform, improve tracing control platform angle measuring precision of photoelectric encoder, make platform have wider bandwidth, higher rigidity, faster response speed, stronger load capacity and better stability.
After method of the present invention is applied to tracing control platform, platform low-speed performance obviously strengthens, illustrate that subdivision's signal error compensating method that the present invention proposes is to suppression platform tracing control error, improves platform courses precision effective, is particularly guaranteeing in parametric controller low-speed stability.Contrast tracing control platform is the test result all revised of speed loop subdivision error compensating approach and speed and position loop only, and the latter's control method effect is better excellent, especially comparatively even running stage after platform 0.05-0.3s starting stage and 0.8s.Meanwhile, the test result of the latter is more close to the reference platform test result that Performance comparision is excellent.Consider that the subdivision error compensation method that the present invention proposes is simple, the burden brought to platform and integrally computing is less.So the subdivision error backoff algorithm that the present invention proposes by tracing control platform selecting applies to speed loop and the position loop of parametric controller simultaneously.Test shows, contrast tracing control platform property, after the correction of subdivision's signal error compensation, tracing control site error maximal value is by 1.42 " being reduced to 0.74 ", and reduce 47.9%, low-speed performance obviously promotes, and parametric controller overall performance is enhanced.
Accompanying drawing explanation
Fig. 1 is tracing control platform architecture block diagram;
Fig. 2 is the tracing control platform photoelectric encoder subdivision's signal error compensating method process flow diagram that the present invention proposes;
Fig. 3 is the design sketch that in embodiment, photoelectric encoder subdivision's signal error compensating method is applied to tracing control platform; Wherein,
represent with reference to tracing control platform low speed tracking performance,
represent tracing control platform low speed tracking performance before non-subdivision's signal error compensation,
represent that the error compensating method by the present invention proposes only is applied to the tracing control platform low speed tracking performance after tracing control platform speed loop,
represent and follow the tracks of parametric controller low speed tracking performance after the error compensating method that the present invention proposes is applied to tracing control platform control system speed loop and position loop simultaneously;
In Fig. 1: 1. main processor modules, 2. memory module, 3. display module, 4. power module, 5. execution module, 6. controlled module, 7. photoelectric encoder measurement module, 8. communication interface modules, 9. human-computer interaction module.
Embodiment
In order to better understand subdivision's signal error compensating method proposed by the invention, below in conjunction with accompanying drawing and case study on implementation, the invention will be further described.
Fig. 1 is tracing control platform architecture block diagram, and tracing control platform comprises main processor modules 1, memory module 2, display module 3, power module 4, execution module 5, controlled module 6, photoelectric encoder measurement module 7, communication interface modules 8, human-computer interaction module 9.Tracing control platform is process core with main processor modules 1, controlled module 6 is tracing control platform courses object, photoelectric encoder measurement module 7 provides control mainly to execution module 5 and drives the displacement the position quantity measuring controlled module 6 of measuring controlled module 6, memory module 2 is connected for storing real-time processing data and program curing etc. with main processor modules 1, the display module 3 be connected in main processor modules 1 is mainly used to display controlled module dynamically and behavior, communication module 8 is for the information interaction of intermodule, the main convenient operation person's usage track control system of human-computer interaction module 9, power module 4 is for whole hardware platform provides power supply supply.
The main processor modules of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention can be one or more in PC, FPGA, PowerPC and DSP.
The memory module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention can be electronic solid state hard disk, one or more in TF, CF or SD card.
The display module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention can be OLED or LCD.
The power module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention adopts specific power management chip, comprises battery and battery charger simultaneously.
The execution module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention is that the proprietary power level of controlled device drives.
The controlled module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention is tracing control platform courses end and control object.
The photoelectric encoder measurement module of tracing control platform photoelectric encoder subdivision's signal error compensating method of the present invention be the code used device of platform and with scrambler by the supporting segmentation of special interface and digitizing electronics equipment.
Fig. 2 is the tracing control platform photoelectric encoder subdivision's signal error compensating method process flow diagram that the present invention proposes, and realizes according to the following steps:
Step (1), parametric controller photoelectric encoder export the two-way orthogonal signal obtained by Moire fringe technology, and waveform is quasi-sine-wave, and sinusoidal wave and cosine wave (CW) is expressed as follows:
Wherein, subdivision's signal A and B is made up of four parts, A
0and B
0representing signal DC component, is DC error source; A
mand B
mrepresenting fundamental signal amplitude, is signal amplitude error source;
with
representing higher hamonic wave sum, is harmonic component source of error; δ
erepresenting electrical noise, is noise source.In addition, be converted to quantization error source between the photoelectric encoder segmentation analog quantity of angle and digital quantity, the phase differential of A and B two paths of signals is phase error source.
There is the encoder applies platform of requirements for high precision, high segmentation multiple be reached, arc tangent divided method need be adopted.Divided method and subdivision error principle are shown below.
Wherein, θ
rrepresent true theoretical segmentation angle, θ
dfor measuring gained segmentation angle, △ θ is subdivision's signal error.
Judge that subdivision error is to parametric controller Accuracy degree, if faint to ignoring, then algorithm terminates.Otherwise by the above-mentioned mathematical analysis error in judgement Source Type to subdivision's signal error;
Step (2), calculating parametric controller subdivision error compensation method initial parameter:
A) encoder system resolution:
B) scrambler grating angular resolution:
C) subdivision's signal segmentation resolution:
AllBit, CoarseBit, FineBit represent photoelectric encoder figure place respectively, thick code bit number and smart code bit number.Wherein, the individual pen raster count that thick representation photoelectric encoder code-disc physics is portrayed, smart representation slender sub-signal cyclical electrical segmentation number;
Step (3), to ask the thick representation of actual measurement axle system position
then use the position quantity θ of thick representation
p_Coarsefor: θ
p_Coarse=CoarseCode*Q
c.Be θ by smart representation for the position quantity segmented
p_Fine=θ
p-θ
p_Coarse;
Step (4), reality of looking for the truth segment angle value
Step (5), judge whether segmentation angular phasing offsets zero point, if offset, asking by now segmenting angle zero point is the segmentation angular metric θ that starting point measures
dRfor: θ
dR=θ
d-InitialAngle.θ
drepresent the actual segmentation angle measured, its expression formula according to different subdivision error types by θ
rand the expression formula of A and B is tried to achieve, InitialAngle represents the side-play amount of segmentation angle null position.If segmentation angular phasing is without offseting zero point, θ
dR=θ
d;
Step (6), ask corresponding θ
dRsmart code
then the total code of absolute fix is CodeAll=CoarseCode2
fineBit+ FineCode;
Step (7), by formula CodeAll=CoarseCode2
fineBit+ FineCode and ACoarseCode=CoarseCode, release step 6 obtains the thick code in total code
(ACoarseCode and CoarseCode difference is that aspect, source is different, and the former is separated by the total code value inputting this module, and the latter is obtained by axle system absolute fix amount, and both are equivalence in theory).This step effect to be further purified thick code value, makes it more accurate;
Step (8), ask and do not revise smart code NCFineCode=CodeAll-ACoarseCode;
Step (9), ask the segmentation angle of the smart representation of uncorrected segmentation
(FinePhaseOrigin and θ
dRsource is different, and the former is from not revising smart code, and the latter derives from axle system position measurements.Owing to rounding, the former is worth generally can be less than the latter);
Step (10), if there is zero point drift, segments angle measurement θ
d=FinePhaseOrigin+InitialAngle, otherwise θ
d=FinePhaseOrigin;
Step (11), according to different subdivision error types, elaborate division by calculation signal errors amount △ θ, i.e. correction;
Step (12), ask revised segmentation angle θ
dc=θ
d+ △ θ;
Step (13), ask revised smart code
then revised total code is obtained by following formula:
CodeAllCorrected=ACoarseCode+FineCodeCorrected
Step (14), calculate revised axle system positional value θ
pC: θ
pC=CodeAllCorrectedQ
Step (15), by revised position quantity θ
pCbe brought in parametric controller by feedback.
Fig. 3 is the design sketch that in embodiment, photoelectric encoder subdivision's signal error compensating method is applied to tracing control platform.In Practical Project, measure former tracing control platform and the tracing control performance with reference to tracing control platform of good performance.The tracking platform photoelectric encoder subdivision's signal error compensating method that the present invention proposes is applied to tracing control platform speed ring and subdivision's signal error compensating method is applied to tracing control platform speed ring and position ring simultaneously, tests the tracing control performance of tracing control platform respectively.Only speed loop compensates and speed loop and position loop compensate rear platform low-speed performance platform low-speed performance simultaneously and all obviously strengthen, illustrate that subdivision's signal error compensating method that the present invention proposes is to suppression platform tracing control error, improves platform courses precision effective.Contrast tracing control platform is the test result all revised of speed loop subdivision error compensating approach and speed and position loop only, and the latter's control method effect is better excellent, especially comparatively even running stage after platform 0.05-0.3s starting stage and 0.8s.Meanwhile, the test result of the latter is more close to the reference platform test result that Performance comparision is excellent.Consider that the subdivision error compensation method that the present invention proposes is simple, the burden brought to platform and integrally computing is less.So the subdivision error backoff algorithm that the present invention proposes by tracing control platform selecting applies to speed loop and the position loop of parametric controller simultaneously.Test shows, contrast tracing control platform property, after the correction of subdivision's signal error compensation, tracing control site error maximal value is by 1.42 " being reduced to 0.74 ", and reduce 47.9%, low-speed performance obviously promotes, and parametric controller overall performance is enhanced.
High precision photoelectric tracking control system requires harshness to catching, following the tracks of and aim at, precision to rad magnitude, meanwhile, often need work in lower-speed state, tracking velocity is even less than 1, and "/s proposes very high requirement to the axis angle measurement precision of photoelectric encoder and accuracy.Grating signal cycle size, the consistance of grating and marginal sharpness, optical filter quality, stability in subsequent treatment of optical detection device characteristic and outputting analog signal and dynamic property are the principal elements affecting photoelectric encoder measuring accuracy.What these factors were measured scrambler affects in the present subdivision's signal error of final body, and improving scrambler precision need revise subdivision's signal error or compensate.
For the impact that subdivision's signal error causes scrambler measuring accuracy, usually remedy from error-detecting and error compensation two aspects.In subdivision's signal error measure, if detect the origin cause of formation of subdivision error, value or dynamic law, just can evade the factor that produces error as far as possible or directly subdivision error be compensated, to improve scrambler precision.In the research of subdivision error compensation technique, more advanced intelligent algorithm at present is usually adopted to realize the compensation of the photoelectric encoder angle error comprising subdivision error.The present invention is by carrying out mathematical analysis to scrambler subdivision error, by the positional value of the tracing control platform that scrambler place tracing control platform records, scrambler subdivision's signal error is compensated, algorithm is simply effective, without the need to as modifying to encoder angle measuring system to subdivision's signal error correction or compensation method now.
Claims (8)
1. a tracing control platform photoelectric encoder subdivision's signal error compensating method, is characterized in that: this tracing control platform comprises main processor modules (1), memory module (2), display module (3), power module (4), execution module (5), controlled module (6), photoelectric encoder measurement module (7), communication interface modules (8) and human-computer interaction module (9), this tracing control platform is process core with main processor modules (1), controlled module (6) is tracing control platform courses object, photoelectric encoder measurement module (7) provides control mainly to execution module (5) and drives the displacement the position quantity measuring controlled module (6) of measuring controlled module (6), memory module (2) is connected for storing real-time processing data and program curing etc. with main processor modules (1), the display module (3) be connected in main processor modules (1) is mainly used to display controlled module dynamically and behavior, communication module (8) is for the information interaction of intermodule, the main convenient operation person's usage track control system of human-computer interaction module (9), power module (4) is then for whole hardware platform provides power supply supply,
This tracing control platform photoelectric encoder subdivision's signal error compensating method realizes according to the following steps:
Step (1), parametric controller photoelectric encoder export the two-way orthogonal signal obtained by Moire fringe technology, and waveform is quasi-sine-wave, and sinusoidal wave and cosine wave (CW) is expressed as follows:
Wherein, subdivision's signal A and B is made up of four parts, A
0and B
0representing signal DC component, is DC error source; A
mand B
mrepresenting fundamental signal amplitude, is signal amplitude error source;
representing higher hamonic wave sum, is harmonic component source of error; δ
erepresenting electrical noise, is noise source; In addition, be converted to quantization error source between the photoelectric encoder segmentation analog quantity of angle and digital quantity, the phase differential of A and B two paths of signals is phase error source;
There is the encoder applies platform of requirements for high precision, high segmentation multiple be reached, arc tangent divided method need be adopted; Divided method and subdivision error are shown below:
Wherein, θ
rrepresent true theoretical segmentation angle, θ
dfor measuring gained segmentation angle, △ θ is subdivision's signal error;
Judge that subdivision error is to parametric controller Accuracy degree, if faint to ignoring, then algorithm terminates; Otherwise by the above-mentioned mathematical analysis error in judgement Source Type to subdivision's signal error;
Step (2), calculating parametric controller subdivision error compensation method initial parameter:
A) encoder system resolution:
B) scrambler grating angular resolution:
C) subdivision's signal segmentation resolution:
AllBit, CoarseBit, FineBit represent photoelectric encoder figure place respectively, thick code bit number and smart code bit number, wherein, and the individual pen raster count that thick representation photoelectric encoder code-disc physics is portrayed, smart representation slender sub-signal cyclical electrical segmentation number;
Step (3), to ask the thick representation of actual measurement axle system position
then use the position quantity θ of thick representation
p_Coarsefor: θ
p_Coarse=CoarseCode*Q
c.Be θ by smart representation for the position quantity segmented
p_Fine=θ
p-θ
p_Coarse;
Step (4), reality of looking for the truth segment angle value
Step (5), judge whether segmentation angular phasing offsets zero point, if offset, asking by now segmenting angle zero point is the segmentation angular metric θ that starting point measures
dRfor: θ
dR=θ
d-InitialAngle, θ
drepresent the actual segmentation angle measured, its expression formula according to different subdivision error types by θ
rand the expression formula of A and B is tried to achieve, InitialAngle represents the side-play amount of segmentation angle null position, if segmentation angular phasing is without offseting zero point, and θ
dR=θ
d;
Step (6), ask corresponding θ
dRsmart code
then the total code of absolute fix is CodeAll=CoarseCode2
fineBit+ FineCode;
Step (7), by formula CodeAll=CoarseCode2
fineBit+ FineCode and ACoarseCode=CoarseCode, release step (6) obtains the thick code in total code
aCoarseCode and CoarseCode difference is that aspect, source is different, and the former is separated by the total code value inputting this module, and the latter is by the absolute fix amount acquisition of axle system, and both are equivalent in theory; This step effect to be further purified thick code value, makes it more accurate;
Step (8), ask and do not revise smart code NCFineCode=CodeAll-ACoarseCode;
Step (9), ask the segmentation angle of the smart representation of uncorrected segmentation
finePhaseOrigin and θ
dRsource is different, and the former is from not revising smart code, and the latter derives from axle system position measurements, and owing to rounding, the former is worth generally can be less than the latter;
Step (10), if there is zero point drift, segments angle measurement θ
d=FinePhaseOrigin+InitialAngle, otherwise θ
d=FinePhaseOrigin;
Step (11), according to different subdivision error types, elaborate division by calculation signal errors amount △ θ, i.e. correction;
Step (12), ask revised segmentation angle θ
dc=θ
d+ △ θ;
Step (13), ask revised smart code
then revised total code is obtained by following formula:
CodeAllCorrected=ACoarseCode+FineCodeCorrected
Step (14), calculate revised axle system positional value θ
pC: θ
pC=CodeAllCorrectedQ;
Step (15), by revised position quantity θ
pCbe brought in tracing control platform by feedback.
2. tracing control platform photoelectric encoder subdivision's signal error compensating method according to claim 1, is characterized in that: described main processor modules can be one or more in PC, FPGA, PowerPC and DSP.
3. tracing control platform photoelectric encoder subdivision's signal error compensating method according to claim 1, is characterized in that: described memory module can be electronic solid state hard disk, one or more in TF, CF or SD card.
4. tracing control platform photoelectric encoder subdivision's signal error compensating method according to claim 1, is characterized in that: described display module can be OLED or LCD.
5. tracing control platform photoelectric encoder subdivision's signal error compensating method according to claim 1, is characterized in that: described power module adopts specific power management chip, comprises battery and battery charger simultaneously.
6. tracing control platform photoelectric encoder subdivision's signal error compensating method according to claim 1, is characterized in that: described execution module is that the proprietary power level of controlled device drives.
7. tracing control platform photoelectric encoder subdivision's signal error compensating method according to claim 1, is characterized in that: described controlled module is tracing control platform courses end and control object.
8. tracing control platform photoelectric encoder subdivision's signal error compensating method according to claim 1, is characterized in that: described photoelectric encoder measurement module be the code used device of platform and with scrambler by the supporting segmentation of special interface and digitizing electronics equipment.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510000536.8A CN104614002B (en) | 2015-01-04 | 2015-01-04 | Subdivided signal error compensation method for photoelectric encoder of tracking control platform |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510000536.8A CN104614002B (en) | 2015-01-04 | 2015-01-04 | Subdivided signal error compensation method for photoelectric encoder of tracking control platform |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104614002A true CN104614002A (en) | 2015-05-13 |
CN104614002B CN104614002B (en) | 2017-02-22 |
Family
ID=53148553
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510000536.8A Active CN104614002B (en) | 2015-01-04 | 2015-01-04 | Subdivided signal error compensation method for photoelectric encoder of tracking control platform |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104614002B (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107796419A (en) * | 2016-08-31 | 2018-03-13 | 青岛农业大学 | Low-cost and high-precision digital composite shaft angle detector |
CN108151653A (en) * | 2017-11-13 | 2018-06-12 | 昆明理工大学 | A kind of moire frange signal of grating error-detecting and modification method |
CN108871382A (en) * | 2018-05-09 | 2018-11-23 | 中国科学院长春光学精密机械与物理研究所 | A kind of error correcting method and system of the photoelectric encoder based on error fit |
CN108919841A (en) * | 2018-08-24 | 2018-11-30 | 湖北三江航天红峰控制有限公司 | A kind of compound heavy metal method and system of photoelectric follow-up |
CN110530407A (en) * | 2019-08-06 | 2019-12-03 | 杭州电子科技大学 | A kind of photosignal quality error separation method of photoelectric encoder |
CN111256735A (en) * | 2020-02-24 | 2020-06-09 | 中国科学院长春光学精密机械与物理研究所 | Photoelectric encoder data processing method and device and photoelectric encoder |
CN112399223A (en) * | 2019-08-18 | 2021-02-23 | 海信视像科技股份有限公司 | Method for improving moire fringe phenomenon and display device |
CN112697190A (en) * | 2020-12-18 | 2021-04-23 | 中国计量大学 | Dynamic calibration method for grating moire signal phase-locked subdivision errors |
CN113587963A (en) * | 2021-07-06 | 2021-11-02 | 吉林建筑大学 | Method for subdividing Moire fringe signal |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008052377A2 (en) * | 2006-11-02 | 2008-05-08 | Hsr Hochschule Für Technik Rapperswil | Method and measuring system for measuring a physical quantity |
CN101936754A (en) * | 2010-09-01 | 2011-01-05 | 南京卡尔胜水电科技有限公司 | On-line self-correcting method of measuring data of dam safety monitoring automated data acquisition device |
CN201795812U (en) * | 2009-10-30 | 2011-04-13 | 大连光洋科技工程有限公司 | Compensation system for online actual errors of sin-cos encoder |
CN102680016A (en) * | 2012-05-14 | 2012-09-19 | 北京理工大学 | Error compensating method of photoelectric encoder |
-
2015
- 2015-01-04 CN CN201510000536.8A patent/CN104614002B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008052377A2 (en) * | 2006-11-02 | 2008-05-08 | Hsr Hochschule Für Technik Rapperswil | Method and measuring system for measuring a physical quantity |
CN201795812U (en) * | 2009-10-30 | 2011-04-13 | 大连光洋科技工程有限公司 | Compensation system for online actual errors of sin-cos encoder |
CN101936754A (en) * | 2010-09-01 | 2011-01-05 | 南京卡尔胜水电科技有限公司 | On-line self-correcting method of measuring data of dam safety monitoring automated data acquisition device |
CN102680016A (en) * | 2012-05-14 | 2012-09-19 | 北京理工大学 | Error compensating method of photoelectric encoder |
Non-Patent Citations (3)
Title |
---|
王显军: "《光电轴角编码器细分信号误差及精度分析》", 《光学精密工程》 * |
黄永梅等: "《卡尔曼预测滤波对跟踪传感器延迟补偿的算法研究》", 《光电工程》 * |
黄永梅等: "《目标速度预测在光电跟踪控制***中的应用》", 《红外与激光工程》 * |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107796419A (en) * | 2016-08-31 | 2018-03-13 | 青岛农业大学 | Low-cost and high-precision digital composite shaft angle detector |
CN108151653A (en) * | 2017-11-13 | 2018-06-12 | 昆明理工大学 | A kind of moire frange signal of grating error-detecting and modification method |
CN108871382B (en) * | 2018-05-09 | 2019-11-15 | 中国科学院长春光学精密机械与物理研究所 | A kind of error correcting method and system of the photoelectric encoder based on error fit |
CN108871382A (en) * | 2018-05-09 | 2018-11-23 | 中国科学院长春光学精密机械与物理研究所 | A kind of error correcting method and system of the photoelectric encoder based on error fit |
CN108919841B (en) * | 2018-08-24 | 2022-03-08 | 湖北三江航天红峰控制有限公司 | Composite shaft control method and system of photoelectric tracking system |
CN108919841A (en) * | 2018-08-24 | 2018-11-30 | 湖北三江航天红峰控制有限公司 | A kind of compound heavy metal method and system of photoelectric follow-up |
CN110530407A (en) * | 2019-08-06 | 2019-12-03 | 杭州电子科技大学 | A kind of photosignal quality error separation method of photoelectric encoder |
CN110530407B (en) * | 2019-08-06 | 2021-06-15 | 杭州电子科技大学 | Photoelectric signal quality error separation method of photoelectric encoder |
CN112399223A (en) * | 2019-08-18 | 2021-02-23 | 海信视像科技股份有限公司 | Method for improving moire fringe phenomenon and display device |
CN112399223B (en) * | 2019-08-18 | 2022-11-29 | 海信视像科技股份有限公司 | Method for improving moire fringe phenomenon and display device |
CN111256735A (en) * | 2020-02-24 | 2020-06-09 | 中国科学院长春光学精密机械与物理研究所 | Photoelectric encoder data processing method and device and photoelectric encoder |
CN111256735B (en) * | 2020-02-24 | 2021-06-01 | 中国科学院长春光学精密机械与物理研究所 | Photoelectric encoder data processing method and device and photoelectric encoder |
CN112697190A (en) * | 2020-12-18 | 2021-04-23 | 中国计量大学 | Dynamic calibration method for grating moire signal phase-locked subdivision errors |
CN112697190B (en) * | 2020-12-18 | 2023-09-15 | 中国计量大学 | Dynamic calibration method for phase-locked subdivision error of grating moire signal |
CN113587963A (en) * | 2021-07-06 | 2021-11-02 | 吉林建筑大学 | Method for subdividing Moire fringe signal |
CN113587963B (en) * | 2021-07-06 | 2024-04-19 | 吉林建筑大学 | Subdivision method of Moire fringe signal |
Also Published As
Publication number | Publication date |
---|---|
CN104614002B (en) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104614002A (en) | Subdivided signal error compensation method for photoelectric encoder of tracking control platform | |
CN101521480B (en) | Resolution method and resolver for signals of rotating transformer | |
CN103516279B (en) | A kind of permagnetic synchronous motor control chip based on FPGA | |
CN107084662A (en) | Orthogonal signalling real-time processing method based on FPGA | |
CN104808056A (en) | Frequency characteristic testing method and device based on comparator conversion | |
CN108844556B (en) | Absolute value encoder compensation parameter obtaining method and system | |
CN104796051A (en) | Rotating transformer conversion method and converter based on FPGA (field programmable gate array) | |
CN101813725A (en) | Method for measuring phase difference of low-frequency signals | |
CN112066863A (en) | Moving-coil linear motor position calibration device and method | |
CN106326608A (en) | Sine and cosine modulating signal model for simulating rotary transformation motor | |
CN108151653A (en) | A kind of moire frange signal of grating error-detecting and modification method | |
WO2024139067A1 (en) | Encoder line compensation method and device, absolute encoder and storage medium | |
Gao et al. | Subdivided error correction method for photoelectric axis angular displacement encoder based on particle swarm optimization | |
CN208751603U (en) | Encoder corrects system | |
CN102735937A (en) | Method for measuring signal phase difference | |
KR101335162B1 (en) | Position aberration correction device and method for resolver | |
CN105842537A (en) | Method and circuit for measuring phase difference based on integrated phase frequency discriminator | |
Zhang et al. | Absolute position acquisition for linear synchronous motor with passive mover | |
Datlinger et al. | Investigations of rotor shaft position sensor signal processing in electric drive train systems | |
CN205388624U (en) | Phase difference measurement circuit based on integrated phase detection discriminator | |
CN110160577A (en) | A kind of angle displacement measurement method of incremental rotary encoder, device and equipment | |
CN206989977U (en) | Subdivision and sensing the pretreatment circuit of Moire fringe formula grating signal | |
CN212543593U (en) | Encoder for linear motor and linear motor | |
CN201876464U (en) | Intelligent multifunctional speed and displacement calibrating system | |
CN203502449U (en) | Waveform synthesizer |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
CB03 | Change of inventor or designer information |
Inventor after: Wang Qiang Inventor after: Su Yanrui Inventor after: Huang Yongmei Inventor after: Yan Fabao Inventor after: Liu Xiang Inventor before: Su Yanrui Inventor before: Wang Qiang Inventor before: Huang Yongmei Inventor before: Yan Fabao Inventor before: Liu Xiang |
|
COR | Change of bibliographic data | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |