CN107328415A - Push-bench gesture ambiguity control system and method based on MEMS gyroscope - Google Patents
Push-bench gesture ambiguity control system and method based on MEMS gyroscope Download PDFInfo
- Publication number
- CN107328415A CN107328415A CN201710657619.3A CN201710657619A CN107328415A CN 107328415 A CN107328415 A CN 107328415A CN 201710657619 A CN201710657619 A CN 201710657619A CN 107328415 A CN107328415 A CN 107328415A
- Authority
- CN
- China
- Prior art keywords
- controller
- fuzzy
- head
- bench
- push
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000012937 correction Methods 0.000 claims abstract description 60
- 230000008859 change Effects 0.000 claims description 24
- 230000006698 induction Effects 0.000 claims description 13
- 238000012545 processing Methods 0.000 claims description 10
- 206010034719 Personality change Diseases 0.000 claims description 5
- 230000004044 response Effects 0.000 claims description 3
- 241001269238 Data Species 0.000 claims description 2
- 230000015572 biosynthetic process Effects 0.000 claims description 2
- 238000003786 synthesis reaction Methods 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 abstract description 7
- 238000013461 design Methods 0.000 description 9
- 238000010276 construction Methods 0.000 description 7
- 230000006872 improvement Effects 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000004062 sedimentation Methods 0.000 description 2
- 239000002689 soil Substances 0.000 description 2
- 238000009412 basement excavation Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000000686 essence Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000005459 micromachining Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 239000011435 rock Substances 0.000 description 1
- 238000007569 slipcasting Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000005641 tunneling Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
Abstract
The invention discloses the push-bench gesture ambiguity control system based on MEMS gyroscope and method.The system includes:Posture detecting unit, detects that the real-time attitude of the head of push-bench changes using MEMS gyroscope:Obtain actual direction angle information of the head on mutually perpendicular three vertical axises two-by-two;Controller, stores up an object axis of head, three target direction angle informations of the controller by three actual direction angle informations respectively with object axis are contrasted and computing, and the stroke of the correction oil cylinder of control push-bench corrects the deviation of head.When contrast and computing, the input quantity and output quantity of controller are 1. defined;2. the input/output domain of controller is defined;3. the input/output fuzzy set of controller is defined;4. fuzzy control rule is set up;5. fuzzy polling list is set up.The present invention obtains the fuzzy value of correction oil cylinder stroke by fuzzy control technology, and correspondence correction oil cylinder stroke reaches that deviation is minimum.
Description
Technical field
The present invention relates to a kind of control system and its control method, more particularly to a kind of push-bench based on MEMS gyroscope
Gesture ambiguity control system and its control method, using the push-bench of the control system, if being stored with the control method
The storage device and electric terminal of dry instruction.
Background technology
Trenchless technology is the technological means using rock and soil drilling, earth's surface is with minimum excavated volume or need not excavate
Under the conditions of lay, change or repair a kind of construction techniques of various underground utilities.Jacking construction is a kind of for no-dig technique skill
The construction technology of new pipeline is laid in art.The continuous propulsion built with Chinese Urbanization and development, construction by pipeline jacking method with it not
Need excavation ground, floor space is few, traffic impact is small, a rate of advance is fast, economic, environmental protection advantage is in pipe gallery, underground
Constantly played a significant role in the project constructions such as passage.
But it is due to stratum soil property change, jack thrust is uneven, backfill slip casting is uneven, tail shield gap is uneven and has spelled
The factor such as tube coupling axis is inaccurate, push-bench is easy to the phenomenon for occurring lateral deflection, produces attitude misalignment.Existing pipe jacking tunnelling machine
By the control system for controlling deck plate to be operated manually, by detecting system display location difference, work people is fully relied on
Member is poor to manually adjusting hydraulic system, rectifying effect according to change in location, easily causes snakelike deviation, as shown in Figure 1.
The content of the invention
In order to improve rectifying effect, the present invention provides a kind of push-bench gesture ambiguity control system based on MEMS gyroscope
And its control method, using the push-bench of the control system, the storage device of some instructions for the control method that is stored with
With electric terminal.
The present invention solution be:A kind of push-bench gesture ambiguity control system based on MEMS gyroscope, it includes:
Posture detecting unit, detects that the real-time attitude of the head of push-bench changes using MEMS gyroscope:Head is obtained to exist
Actual direction angle information on mutually perpendicular three vertical axises two-by-two, wherein, three vertical axises represent head respectively
Orthogonal horizontal X and longitudinal direction Y, head in the horizontal plane is in the vertical Z on the horizontal plane;
Controller, it stores an object axis of head, and the object axis shows head respectively in horizontal X, longitudinal direction
Target direction angle information on Y, vertical Z, controller by three actual direction angle informations respectively with three target direction angles
Degree information is contrasted and computing, thus controls the stroke of the correction oil cylinder of the push-bench to correct the deviation of head;
Wherein, posture detecting unit and controller constitute the closed-loop control system for correcting head deviation, the contrast of controller
Comprise the following steps with operation method:
1. the input quantity and output quantity of controller are defined:By the change of the position deviation of head, angular deviation and deviation
Rate as controller input variable, using the stroke of correction oil cylinder as controller output variable;
2. the input/output domain of controller is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller is defined:By the position deviation of head, angular deviation, deviation rate of change
And the stroke of correction oil cylinder is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation to language
It is worth in manifold, forms fuzzy set;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is turned
Such a precise volume of stroke of correction oil cylinder is turned to, so that controller will be realized according to the fuzzy control quantity to correction oil
The control of cylinder.
As the further improvement of such scheme, in the input/output domain for defining controller, constructed according to push-bench
Specified in tolerance scope and surface uplift and the maximum permissible value of sedimentation, select the model of each input variable and output variable
Enclose.
As the further improvement of such scheme, in fuzzy control rule is set up, being used according to the fuzzy set has
The single rule of two premises, takes into account stability and response speed, and induction and conclusion goes out a plurality of control rule.
As the further improvement of such scheme, in fuzzy polling list is set up, using " it is maximum --- minimum " close
Into operation method, fuzzy judgment is carried out using " median method ", the fuzzy control inquiry for obtaining controller is calculated using Matlab
Table.
As the further improvement of such scheme, in the input/output domain for defining controller, domain is defined as 13
Individual grade:{ -6, -5, -4, -3, -2, -1,0,1,2,3,4,5,6 };
In input/output fuzzy set is defined, by the position deviation of head, angular deviation, the rate of change of deviation and correction
The stroke of oil cylinder is divided into seven grades of language Value Datas;
In fuzzy control rule is set up, induction and conclusion goes out 49 control rules.
Further, 7 class are expressed as with vocabulary:" negative big (NB) ", " in negative (NM) ", " bearing small (NS) ", " zero
(ZO) ", " just small (PS) ", " center (PM) ", " honest (PB) ";
49 control the rule to be:
The present invention also provides a kind of push-bench gesture ambiguity control method based on MEMS gyroscope, and it includes following step
Suddenly:
The real-time attitude change of the head of push-bench is detected using MEMS gyroscope:Head is obtained mutually perpendicular two-by-two
Actual direction angle information on three vertical axises, wherein, three vertical axises represent the phase of head in the horizontal plane respectively
Mutually vertical horizontal X and longitudinal direction Y, head are in the vertical Z on the horizontal plane;
An object axis of head is stored in the controller of push-bench, the object axis shows head respectively in horizontal stroke
Target direction angle information on X, longitudinal direction Y, vertical Z, controller by three actual direction angle informations respectively with three mesh
Mark orientation angle information is contrasted and computing, thus controls the stroke of the correction oil cylinder of the push-bench to correct head
Deviation;
Wherein, posture detecting unit and controller constitute the closed-loop control system for correcting head deviation, the contrast of controller
Comprise the following steps with operation method:
1. the input quantity and output quantity of controller are defined:By the change of the position deviation of head, angular deviation and deviation
Rate as controller input variable, using the stroke of correction oil cylinder as controller output variable;
2. the input/output domain of controller is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller is defined:By the position deviation of head, angular deviation, deviation rate of change
And the stroke of correction oil cylinder is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation to language
It is worth in manifold, forms fuzzy set;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is turned
Such a precise volume of stroke of correction oil cylinder is turned to, so that controller will be realized according to the fuzzy control quantity to correction oil
The control of cylinder.
The present invention also provides a kind of push-bench, and it includes:
Head;
Correction oil cylinder, the deviation of head is corrected by stroke;
Controller, the operation of error correct oil cylinder;
Any one above-mentioned push-bench gesture ambiguity control system based on MEMS gyroscope.
The present invention also provides a kind of storage device, wherein storing a plurality of instruction, the instruction is loaded and held suitable for controller
OK, a plurality of instruct is:
1. the input quantity and output quantity of controller are defined:The real-time appearance of the head of push-bench is detected by posture detecting unit
State changes:Actual direction angle information of the head on mutually perpendicular three vertical axises two-by-two is obtained, wherein, described three hang down
D-axis represents the orthogonal horizontal X of head in the horizontal plane and longitudinal direction Y, head on the horizontal plane respectively
Vertical Z;Using the rate of change of the position deviation of the head of push-bench, angular deviation and deviation as controller input variable,
Using the stroke of the correction oil cylinder of push-bench as controller output variable;
2. the input/output domain of controller is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller is defined:By the position deviation of head, angular deviation, deviation rate of change
And the stroke of correction oil cylinder is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation to language
It is worth in manifold, forms fuzzy set;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is turned
Such a precise volume of stroke of correction oil cylinder is turned to, so that controller will be realized according to the fuzzy control quantity to correction oil
The control of cylinder.
The present invention also carries a kind of electric terminal, and it includes:
Controller, is adapted for carrying out various instructions;And
Storage device, suitable for storing a plurality of instruction, the instruction is loaded and performed suitable for controller;
It is described it is a plurality of instruction be:
1. the input quantity and output quantity of controller are defined:The real-time appearance of the head of push-bench is detected by posture detecting unit
State changes:Actual direction angle information of the head on mutually perpendicular three vertical axises two-by-two is obtained, wherein, described three hang down
D-axis represents the orthogonal horizontal X of head in the horizontal plane and longitudinal direction Y, head on the horizontal plane respectively
Vertical Z;Using the rate of change of the position deviation of the head of push-bench, angular deviation and deviation as controller input variable,
Using the stroke of the correction oil cylinder of push-bench as controller output variable;
2. the input/output domain of controller is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller is defined:By the position deviation of head, angular deviation, deviation rate of change
And the stroke of correction oil cylinder is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation to language
It is worth in manifold, forms fuzzy set;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is turned
Such a precise volume of stroke of correction oil cylinder is turned to, so that controller will be realized according to the fuzzy control quantity to correction oil
The control of cylinder.
The present invention proposes that using MEMS gyroscope be posture detecting unit, and push-bench appearance is corrected by fuzzy control method
State, so as to measure three angle directions of push-bench, and realizes the automatic deviation rectifying function of push-bench.MEMS gyroscope will be surveyed
The three orientation angle information obtained pass to PLC, and PLC believes the angle information read with design axis angle
Breath is contrasted and computing, the fuzzy value of correction oil cylinder stroke is obtained by fuzzy control technology, PLC is according to fuzzy
Value control respective direction valve commutation, and correspondence correction oil cylinder are stretched, and reach that deviation is minimum;Cause MEMS gyro after attitudes vibration
Instrument is measured to the angle information after correction again, and so circulation forms closed-loop system, finally realizes the automatic deviation correction of push-bench.
Brief description of the drawings
Fig. 1 is the bending situation map that current conduit axis is present.
Fig. 2 is the push-bench gesture ambiguity control system block diagram based on MEMS gyroscope of the present invention.
Fig. 3 is the schematic flow sheet of the push-bench gesture ambiguity control method based on MEMS gyroscope of the present invention.
Embodiment
In order to make the purpose , technical scheme and advantage of the present invention be clearer, it is right below in conjunction with drawings and Examples
The present invention is further elaborated.It should be appreciated that the specific embodiments described herein are merely illustrative of the present invention, and
It is not used in the restriction present invention.
The push-bench gesture ambiguity control system based on MEMS gyroscope of the present invention is R & D design for push-bench
, it is posture detecting unit using MEMS gyroscope, three angle directions of the head of push-bench can be measured, pass through Fuzzy Control
Method processed corrects the posture of head, and realizes the automatic deviation rectifying function of head.
Referring to Fig. 2, the push-bench gesture ambiguity control system based on MEMS gyroscope of the present invention includes attitude detection
Unit 1, controller 3.
Posture detecting unit 1 detects the real-time attitude change of the head 2 of push-bench using MEMS gyroscope, is in particular,
Actual direction angle information of the head 2 on mutually perpendicular three vertical axises two-by-two is obtained, wherein, three vertical axises point
The orthogonal horizontal X of head 2 in the horizontal plane and longitudinal direction Y, head 2 are not represented vertical on the horizontal plane
Z。
MEMS gyroscope is a kind of inertial angular rate sensors based on Coriolis effect.With tradition machinery gyroscope not
Together, its internal no-rotary part, it is not necessary to bearing, all solid state device, with price is low, small volume, lightweight, reliability it is high,
The features such as being easy to digitlization, intelligent, anti-big overload impact, long working life, low-power consumption, wide range.Have been demonstrated to use
Micromachining technology is produced in enormous quantities.
The data of MEMS gyroscope collection are exported by RS232/RS485/TTL, are output as 8 16 system numbers, access computer
It is shown as angle information.Static accuracy:0.3 °, dynamic accuracy:2 °, resolution ratio:0.01 °, maximum output frequency 50Hz.Transmit number
According to common cable is only used, without shielding.
Controller 3 stores an object axis of head 2, and the object axis shows head 2 respectively in horizontal X, longitudinal direction
Target direction angle information on Y, vertical Z, controller 3 by three actual direction angle informations respectively with three target direction angles
Degree information is contrasted and computing, thus controls the stroke of the correction oil cylinder 4 of the push-bench to correct the deviation of head 2.
Posture detecting unit 1 and controller 3 constitute the closed-loop control system for correcting the deviation of head 2, the contrast of controller 3 and operation method
It is the emphasis of the present invention, can solves the smart blur control method of present invention problem using fuzzy control theory design, connect
Go down and this is described in detail.
Incorporated by reference to Fig. 3, the contrast of controller 3 and operation method (namely fuzzy control method of controller 3) are including following
Step:
1. the input quantity and output quantity of controller 3 are defined:By the change of the position deviation of head 2, angular deviation and deviation
Rate as controller 3 input variable, using the stroke of correction oil cylinder 4 as controller 3 output variable;
2. the input/output domain of controller 3 is defined:The scope of each input variable and output variable is selected, according to this model
Enclose the input/output domain for defining multiple grades;
3. the input/output fuzzy set of controller 3 is defined:By the position deviation of head 2, angular deviation, the change of deviation
The stroke of rate and correction oil cylinder 4 is divided into multi gear language Value Data, and input variable and output variable discretization and obfuscation are arrived
In Linguistic Value manifold, fuzzy set is formed;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is turned
Such a precise volume of stroke of correction oil cylinder 4 is turned to, so that controller 3 will be realized to correction according to the fuzzy control quantity
The control of oil cylinder 4.
Because the factor for the driving attitude for influenceing push-bench is a lot, and intercouple, non-linear, time variation, mould is presented
The characteristics of pasting randomness, it is difficult to set up accurate mathematical modeling to describe attitudes vibration mechanism during push-bench driving.Therefore, adopt
With the method for fuzzy control, fuzzy control rule, reasonable selection are determined according to the experience of expertise and skilled operation personnel
The membership function of input variable and output variable, sets up knowledge base (including database and knowledge base), carry out compositional rule of inference and
Control decision, so that posture when effectively control push-bench is tunneled.
In push-bench tunneling process, gesture ambiguity controller (i.e. controller 3 or PLC fuzzy controls are utilized
Device), intelligent amendment is constantly carried out to the driving attitude of push-bench according to attitude misalignment and geological condition, so as to realize push-bench
The intellectuality of gesture stability.
When carrying out the gesture ambiguity controller design of push-bench, it is necessary to which the problem of solving emphatically includes:The group of controller 3
Into and structure, and specific design step design;The determination of the input variable and output variable of controller 3;Realize the work(of controller 3
Can control algolithm program write.
Embodiment 1
Gesture ambiguity controller is that the design of controller 3 is comprised the following steps that.
1. input quantity and output quantity are defined:By horizontal direction and the position deviation of vertical direction, angular deviation and deviation
Rate of change as the input variable of controller 3, regard the controlled quentity controlled variable of correction oil cylinder 4 as output variable.
2. input/output domain is defined:According to specified in the construction of push-bench tolerance scope and surface uplift and
The maximum permissible value of sedimentation selects the domain of each input variable and output variable;Domain is defined as 13 grades:- 6, -5, -
4, -3, -2, -1,0,1,2,3,4,5,6 }.
3. input/output fuzzy set is defined:Error, error rate and correction oil cylinder controlled quentity controlled variable are divided into seven grades of Linguistic Values
Data, are expressed as with vocabulary:" negative big (NB) ", " in negative (NM) ", " bear small (NS) ", " zero (ZO) ", " just small (PS) ", " center
(PM) ", " honest (PB) " 7 class.By input quantity and output quantity discretization and obfuscation into Linguistic Value manifold, form fuzzy
Collection.
4. fuzzy control rule is set up:Using the single rule with two premises, stability and response speed are taken into account, is returned
Receive and sum up 49 control rules.
5. fuzzy polling list is set up:Using " maximum one is minimum " synthesis operation method, carried out using " median method "
Fuzzy judgment, the fuzzy polling list for obtaining controller 3 is calculated using Matlab.
6. the output quantity to fuzzy control makees sharpening processing, and fuzzy control quantity is converted into precise volume.Controller 3 is by root
Controlled quentity controlled variable realizes the control to controlled device (correction oil cylinder 4) accordingly.
In summary, it is core with controller 3 that the present invention, which proposes one kind, using MEMS gyro as the push pipe of detection unit 1
Machine gesture ambiguity control method.Can realize simultaneously in real time three shaft angle degree of collection, calculate in real time misalignment of axe and deviation variation rate,
The functions such as the real-time motion of error correct oil cylinder 4.Push-bench axis automatic deviation correction can be completed, push-bench construction quality is improved.
Measure three orientation angle information are passed to PLC by MEMS gyroscope, and PLC is by the angle read
Degree information is contrasted and computing with design axis angle information, and the stroke of correction oil cylinder 4 is obtained by fuzzy control technology
Fuzzy value, PLC controls respective direction valve to commutate according to fuzzy value, and corresponds to the flexible of correction oil cylinder 4, reaches deviation
It is minimum.MEMS gyroscope after attitudes vibration is caused to be measured again to the angle information after correction, so circulation forms closed loop system
System, finally realizes the automatic deviation correction of push-bench.
The method of the present invention, suitable for being performed in computer equipment, can make software installation bag in actual applications
Form, can also make APP form, such as mobile phone A PP.The method of the present invention is in the specific implementation, various meters can be used
Calculation machine language design is loaded and performed suitable for controller 3, can deposited using storage device into corresponding a plurality of instruction, the instruction
Store up these instructions.Therefore it can also be freely applied on electric terminal, as long as electric terminal, which exists, is adapted for carrying out various instructions
Controller 3, controller 3 load and perform these instruction.Electric terminal can also set the storage suitable for storing these instructions
Equipment.
The foregoing is merely illustrative of the preferred embodiments of the present invention, is not intended to limit the invention, all essences in the present invention
Any modifications, equivalent substitutions and improvements made within refreshing and principle etc., should be included in the scope of the protection.
Claims (10)
1. a kind of push-bench gesture ambiguity control system based on MEMS gyroscope, it is characterised in that:It includes:
Posture detecting unit (1), detects that the real-time attitude of the head (2) of push-bench changes using MEMS gyroscope:Obtain head
(2) the actual direction angle information on mutually perpendicular three vertical axises two-by-two, wherein, three vertical axises are represented respectively
The orthogonal horizontal X of head (2) in the horizontal plane and longitudinal direction Y, head (2) are in the vertical Z on the horizontal plane;
Controller (3), it stores an object axis of head (2), the object axis show head (2) respectively horizontal X,
Target direction angle information on longitudinal Y, vertical Z, controller (3) by three actual direction angle informations respectively with three targets
Orientation angle information is contrasted and computing, thus controls the stroke of the correction oil cylinder (4) of the push-bench to correct head
(2) deviation;
Wherein, posture detecting unit (1) and controller (3) constitute the closed-loop control system for correcting head (2) deviation, controller
(3) contrast and operation method comprises the following steps:
1. the input quantity and output quantity of controller (3) are defined:By the change of the position deviation of head (2), angular deviation and deviation
Rate as controller (3) input variable, using the stroke of correction oil cylinder (4) as controller (3) output variable;
2. the input/output domain of controller (3) is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller (3) is defined:By the position deviation of head (2), angular deviation, the change of deviation
The stroke of rate and correction oil cylinder (4) is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation
Into Linguistic Value manifold, fuzzy set is formed;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is converted into
Such a precise volume of stroke of correction oil cylinder (4), so that controller (3) will be realized to correction according to the fuzzy control quantity
The control of oil cylinder (4).
2. the push-bench gesture ambiguity control system as claimed in claim 1 based on MEMS gyroscope, it is characterised in that:Fixed
In the input/output domain of adopted controller (3), tolerance scope and surface uplift and heavy according to specified in constructing push-bench
The maximum permissible value of drop, selects the scope of each input variable and output variable.
3. the push-bench gesture ambiguity control system as claimed in claim 1 based on MEMS gyroscope, it is characterised in that:Building
In vertical fuzzy control rule, the single rule with two premises is used according to the fuzzy set, stability and response speed is taken into account
Degree, induction and conclusion goes out a plurality of control rule.
4. the push-bench gesture ambiguity control system as claimed in claim 1 based on MEMS gyroscope, it is characterised in that:Building
In vertical fuzzy polling list, using " it is maximum --- minimum " synthesis operation method, fuzzy judgment is carried out using " median method ",
The fuzzy polling list for obtaining controller (3) is calculated using Matlab.
5. the push-bench gesture ambiguity control system as claimed in claim 1 based on MEMS gyroscope, it is characterised in that:Fixed
In the input/output domain of adopted controller (3), domain is defined as 13 grades:- 6, -5, -4, -3, -2, -1,0,1,2,3,
4,5,6 };
In input/output fuzzy set is defined, by the position deviation of head (2), angular deviation, the rate of change of deviation and correction oil
The stroke of cylinder (4) is divided into seven grades of language Value Datas;
In fuzzy control rule is set up, induction and conclusion goes out 49 control rules.
6. the push-bench gesture ambiguity control system as claimed in claim 5 based on MEMS gyroscope, it is characterised in that:7
Class is expressed as with vocabulary:" negative big (NB) ", " in negative (NM) ", " bear small (NS) ", " zero (ZO) ", " just small (PS) ", " center
(PM) ", " honest (PB) ";
49 control the rule to be:
Rl:if Ey=PB andthen△PH1=NB;
R2:if Ey=PB andthen△PH1=NB;
R3:if Ey=PB andthen△PH1=NB;
……
R47:if Ey=NB andthenΔPH1=PB;
R48:if Ey=NB andthen△PH1=PB;
R49:if Ey=NB andthen△PH1=PB.
7. a kind of push-bench gesture ambiguity control method based on MEMS gyroscope, it is characterised in that:It comprises the following steps:
The real-time attitude change of the head (2) of push-bench is detected using MEMS gyroscope:Head (2) is obtained orthogonal two-by-two
Three vertical axises on actual direction angle information, wherein, three vertical axises represent head (2) in the horizontal plane respectively
Orthogonal horizontal X and longitudinal direction Y, head (2) in the vertical Z on the horizontal plane;
An object axis of storage head (2) in the controller (3) of push-bench, the object axis shows head (2) point
Target direction angle information not on horizontal X, longitudinal direction Y, vertical Z, controller (3) distinguishes three actual direction angle informations
Contrasted and computing with three target direction angle informations, thus control the stroke of the correction oil cylinder (4) of the push-bench
To correct the deviation of head (2);
Wherein, posture detecting unit (1) and controller (3) constitute the closed-loop control system for correcting head (2) deviation, controller
(3) contrast and operation method comprises the following steps:
1. the input quantity and output quantity of controller (3) are defined:By the change of the position deviation of head (2), angular deviation and deviation
Rate as controller (3) input variable, using the stroke of correction oil cylinder (4) as controller (3) output variable;
2. the input/output domain of controller (3) is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller (3) is defined:By the position deviation of head (2), angular deviation, the change of deviation
The stroke of rate and correction oil cylinder (4) is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation
Into Linguistic Value manifold, fuzzy set is formed;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is converted into
Such a precise volume of stroke of correction oil cylinder (4), so that controller (3) will be realized to correction according to the fuzzy control quantity
The control of oil cylinder (4).
8. a kind of push-bench, it includes:
Head (2);
Correction oil cylinder (4), the deviation of head (2) is corrected by stroke;
Controller (3), the operation of error correct oil cylinder (4);
It is characterized in that:The push-bench also includes as claimed in any of claims 1 to 7 in one of claims based on MEMS gyroscope
Push-bench gesture ambiguity control system.
9. a kind of storage device, wherein storing a plurality of instruction, the instruction is suitable to controller (3) and loads and perform, and its feature exists
In:It is described it is a plurality of instruction be:
1. the input quantity and output quantity of controller (3) are defined:The head (2) of push-bench is detected by posture detecting unit (1)
Real-time attitude changes:Actual direction angle information of the head (2) on mutually perpendicular three vertical axises two-by-two is obtained, wherein,
Three vertical axises represent the orthogonal horizontal X of head (2) in the horizontal plane and longitudinal direction Y, head (2) vertical respectively
In the vertical Z on the horizontal plane;The rate of change of the position deviation of the head (2) of push-bench, angular deviation and deviation is made
For the input variable of controller (3), using the stroke of the correction oil cylinder (4) of push-bench as controller (3) output variable;
2. the input/output domain of controller (3) is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller (3) is defined:By the position deviation of head (2), angular deviation, the change of deviation
The stroke of rate and correction oil cylinder (4) is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation
Into Linguistic Value manifold, fuzzy set is formed;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is converted into
Such a precise volume of stroke of correction oil cylinder (4), so that controller (3) will be realized to correction according to the fuzzy control quantity
The control of oil cylinder (4).
10. a kind of electric terminal, it includes:
Controller (3), is adapted for carrying out various instructions;And
Storage device, suitable for storing a plurality of instruction, the instruction is suitable to controller (3) and loads and perform;
It is characterized in that:It is described it is a plurality of instruction be:
1. the input quantity and output quantity of controller (3) are defined:The head (2) of push-bench is detected by posture detecting unit (1)
Real-time attitude changes:Actual direction angle information of the head (2) on mutually perpendicular three vertical axises two-by-two is obtained, wherein,
Three vertical axises represent the orthogonal horizontal X of head (2) in the horizontal plane and longitudinal direction Y, head (2) vertical respectively
In the vertical Z on the horizontal plane;The rate of change of the position deviation of the head (2) of push-bench, angular deviation and deviation is made
For the input variable of controller (3), using the stroke of the correction oil cylinder (4) of push-bench as controller (3) output variable;
2. the input/output domain of controller (3) is defined:The scope of each input variable and output variable is selected, according to this scope
Define the input/output domain of multiple grades;
3. the input/output fuzzy set of controller (3) is defined:By the position deviation of head (2), angular deviation, the change of deviation
The stroke of rate and correction oil cylinder (4) is divided into multi gear language Value Data, by input variable and output variable discretization and obfuscation
Into Linguistic Value manifold, fuzzy set is formed;
4. fuzzy control rule is set up:A plurality of control rule is gone out according to the fuzzy set induction and conclusion;
5. fuzzy polling list is set up:Fuzzy polling list is set up according to the fuzzy control rule;
6. the output quantity to fuzzy control makees sharpening processing:Fuzzy control quantity in the fuzzy polling list is converted into
Such a precise volume of stroke of correction oil cylinder (4), so that controller (3) will be realized to correction according to the fuzzy control quantity
The control of oil cylinder (4).
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710399011 | 2017-05-31 | ||
CN2017103990115 | 2017-05-31 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107328415A true CN107328415A (en) | 2017-11-07 |
Family
ID=60225972
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710657619.3A Pending CN107328415A (en) | 2017-05-31 | 2017-08-03 | Push-bench gesture ambiguity control system and method based on MEMS gyroscope |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107328415A (en) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110081904A (en) * | 2019-05-15 | 2019-08-02 | 合肥工业大学 | Biplane photosensor arrays push-bench attitude measuring and measurement method |
CN110130916A (en) * | 2019-05-21 | 2019-08-16 | 上海市市政工程建设发展有限公司 | A kind of big cross section rectangular top pipe attitude control method |
CN111456748A (en) * | 2020-04-20 | 2020-07-28 | 中国铁建重工集团股份有限公司 | Deviation correction control method for automatic guiding of hard rock tunneling machine |
CN113586075A (en) * | 2021-07-19 | 2021-11-02 | 上海隧道工程有限公司 | System and method for automatically correcting attitude of shield tunneling machine relative to tunnel axis |
CN114578713A (en) * | 2022-03-17 | 2022-06-03 | 山东拓新电气有限公司 | Attitude control method and device for push bench |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1877080A (en) * | 2006-06-28 | 2006-12-13 | 上海隧道工程股份有限公司 | Method for autocontrolling excavation direction of underground excavator using virtual track |
JP2008014738A (en) * | 2006-07-05 | 2008-01-24 | San Shield Kk | Angle measuring device used for position measurement of excavator, and jacking method of excavator |
CN201535666U (en) * | 2009-12-11 | 2010-07-28 | 北京市市政工程研究院 | Automatic measuring device for pose of machine head of tube push bench |
CN103322989A (en) * | 2013-06-06 | 2013-09-25 | 上海米度测量技术有限公司 | Measuring device and method of dynamic real-time measurement of position and posture of pipe pushing jack |
CN103603671A (en) * | 2013-12-06 | 2014-02-26 | 湖南大学 | Tunneling posture adjustment control system of miniature shield tunneling machine and adjustment method thereof |
CN104110252A (en) * | 2014-04-21 | 2014-10-22 | 中铁西北科学研究院有限公司西南分院 | Expansion anchor cable drilled hole measuring system on basis of inertia sensor |
CN105102762A (en) * | 2013-03-29 | 2015-11-25 | 普拉德研究及开发股份有限公司 | Closed loop control of drilling toolface |
CN106285711A (en) * | 2016-08-22 | 2017-01-04 | 安徽唐兴机械装备有限公司 | A kind of top pipe deviation correcting control system based on optical fibre gyro and method thereof |
CN106956023A (en) * | 2017-04-19 | 2017-07-18 | 德阳鑫晶科技有限公司 | It is easy to correct the operating method of deep hole machining perpendicularity |
-
2017
- 2017-08-03 CN CN201710657619.3A patent/CN107328415A/en active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1877080A (en) * | 2006-06-28 | 2006-12-13 | 上海隧道工程股份有限公司 | Method for autocontrolling excavation direction of underground excavator using virtual track |
JP2008014738A (en) * | 2006-07-05 | 2008-01-24 | San Shield Kk | Angle measuring device used for position measurement of excavator, and jacking method of excavator |
CN201535666U (en) * | 2009-12-11 | 2010-07-28 | 北京市市政工程研究院 | Automatic measuring device for pose of machine head of tube push bench |
CN105102762A (en) * | 2013-03-29 | 2015-11-25 | 普拉德研究及开发股份有限公司 | Closed loop control of drilling toolface |
CN103322989A (en) * | 2013-06-06 | 2013-09-25 | 上海米度测量技术有限公司 | Measuring device and method of dynamic real-time measurement of position and posture of pipe pushing jack |
CN103603671A (en) * | 2013-12-06 | 2014-02-26 | 湖南大学 | Tunneling posture adjustment control system of miniature shield tunneling machine and adjustment method thereof |
CN104110252A (en) * | 2014-04-21 | 2014-10-22 | 中铁西北科学研究院有限公司西南分院 | Expansion anchor cable drilled hole measuring system on basis of inertia sensor |
CN106285711A (en) * | 2016-08-22 | 2017-01-04 | 安徽唐兴机械装备有限公司 | A kind of top pipe deviation correcting control system based on optical fibre gyro and method thereof |
CN106956023A (en) * | 2017-04-19 | 2017-07-18 | 德阳鑫晶科技有限公司 | It is easy to correct the operating method of deep hole machining perpendicularity |
Non-Patent Citations (2)
Title |
---|
于睿坤 等: "基于Labview的盾构姿态模糊控制器研究", 《机械与电子》 * |
董建: "基于图像识别和模糊控制技术的顶管掘进机纠偏控制系统试验研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110081904A (en) * | 2019-05-15 | 2019-08-02 | 合肥工业大学 | Biplane photosensor arrays push-bench attitude measuring and measurement method |
CN110130916A (en) * | 2019-05-21 | 2019-08-16 | 上海市市政工程建设发展有限公司 | A kind of big cross section rectangular top pipe attitude control method |
CN111456748A (en) * | 2020-04-20 | 2020-07-28 | 中国铁建重工集团股份有限公司 | Deviation correction control method for automatic guiding of hard rock tunneling machine |
CN111456748B (en) * | 2020-04-20 | 2021-11-05 | 中国铁建重工集团股份有限公司 | Deviation correction control method for automatic guiding of hard rock tunneling machine |
CN113586075A (en) * | 2021-07-19 | 2021-11-02 | 上海隧道工程有限公司 | System and method for automatically correcting attitude of shield tunneling machine relative to tunnel axis |
CN114578713A (en) * | 2022-03-17 | 2022-06-03 | 山东拓新电气有限公司 | Attitude control method and device for push bench |
CN114578713B (en) * | 2022-03-17 | 2022-09-13 | 山东拓新电气有限公司 | Attitude control method and device for push bench |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107328415A (en) | Push-bench gesture ambiguity control system and method based on MEMS gyroscope | |
CN113239439B (en) | Shield construction ground surface settlement prediction system and method | |
CN106123776B (en) | A kind of push pipe intelligence jacking measuring system and measurement method | |
CN105917074A (en) | Managing wellbore operations using uncertainty calculations | |
CN109891049B (en) | Systems, media, and methods for incremental trajectory estimation of a tool | |
CN107392348A (en) | The method optimized using BIM technology to cut-fill transition scheme | |
CN105849363A (en) | Controlling a bottom hole assembly in a wellbore | |
CN110130347A (en) | Intelligent positioning guiding device, method, project management method for pile foundation construction | |
CN103104251A (en) | Method used for improving accuracy of azimuthal angle and tool face angle of small well inclined downward fiber-optic gyroscope inclinometer | |
CN109972688A (en) | Excavate control method, device and controller for excavators | |
Fan et al. | Integrated positioning for coal mining machinery in enclosed underground mine based on SINS/WSN | |
CN206223091U (en) | A kind of push pipe intelligence jacking measuring system | |
Manrique et al. | Constructing a complex precast tilt-up-panel structure utilizing an optimization model, 3D CAD, and animation | |
CN106989745A (en) | The fusion method of inclinator and fibre optic gyroscope in push pipe attitude measurement system | |
JPH05187873A (en) | Hole curve measurement device and its measuring method | |
Wang et al. | Multi-objective optimization design and control of deviation-correction trajectory with undetermined target | |
Shen et al. | Tunnel boring machine positioning automation in tunnel construction | |
Liu et al. | A calculation method for safety distance between the confined karst cave and the shield tunnel based on upper bound theorem | |
CN104729786B (en) | A kind of dynamic measurement method of in the hole grouting pressure | |
Liu et al. | Mechanics analysis of pipe lifting in horizontal directional drilling | |
Rao et al. | Analysis of deformation of adjacent buried pipeline under rockfall impact load | |
CN108592949A (en) | A kind of azimuth drilling tool magnetic disturbance bearing calibration and correction system | |
Zhou et al. | Parameter Optimization on FNN/PID Compound Controller for a Three‐Axis Inertially Stabilized Platform for Aerial Remote Sensing Applications | |
CN107576319A (en) | Without pipe omnidirectional self-correction real-time displacement measurement pipe | |
Maleki et al. | A Rapid Design Procedure for Tied-Back Soil Walls Using Multivariate Adaptive Regression Splines (MARS) Method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20171107 |
|
RJ01 | Rejection of invention patent application after publication |