CN109445419A - A kind of the opto-electric stabilization holder and its test method of teaching-oriented - Google Patents
A kind of the opto-electric stabilization holder and its test method of teaching-oriented Download PDFInfo
- Publication number
- CN109445419A CN109445419A CN201811491673.6A CN201811491673A CN109445419A CN 109445419 A CN109445419 A CN 109445419A CN 201811491673 A CN201811491673 A CN 201811491673A CN 109445419 A CN109445419 A CN 109445419A
- Authority
- CN
- China
- Prior art keywords
- axis
- motor
- electric
- teaching
- opto
- 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
Classifications
-
- 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
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
-
- G—PHYSICS
- G09—EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
- G09B—EDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
- G09B19/00—Teaching not covered by other main groups of this subclass
-
- G—PHYSICS
- G09—EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
- G09B—EDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
- G09B25/00—Models for purposes not provided for in G09B23/00, e.g. full-sized devices for demonstration purposes
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Business, Economics & Management (AREA)
- Educational Administration (AREA)
- Educational Technology (AREA)
- Theoretical Computer Science (AREA)
- Automation & Control Theory (AREA)
- Entrepreneurship & Innovation (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
The opto-electric stabilization holder and its test method of teaching-oriented provided by the invention, it can impart knowledge to students for the stability of holder and required hardware foundation is provided, and the independently-powered design of 3-phase plug, it can carry out the teaching demonstration of the servo control algorithms such as Field orientable control, stable inertia control, speed and position control, after algorithm development is fixed on built-in industrial control machine, it may migrate to further deisgn product in embedded chip, facilitate teaching demonstration, improve demonstration efficiency.
Description
Technical field
The present invention relates to holder steady testing field, in particular to the opto-electric stabilization holder of a kind of teaching-oriented and its test
Method.
Background technique
Opto-electric stabilization holder is the optoelectronic device being mounted on the mobile vehicles such as aircraft, naval vessel, vehicle, can compensate for carrier
The optical axis caused by attitudes vibration shakes in motion process, guarantees the quality and observation effect of movement imaging.Existing opto-electric stabilization
Holder is usually all the design of embedded IC plate, and function solidification externally only has image output, operating mode control interface
Equal input/output interfaces, only can satisfy the use demand of user.On the other hand, opto-electric stabilization holder is SERVO CONTROL profession neck
The very typical research object in domain, but many undergraduate courses or postgraduate only have relevant books that can refer in course, practice
In lack a kind of instruments used for education that can be tested.
For the development for promoting photovoltaic industry, meet the actual demand of higher education practical teaching, there is an urgent need to one kind can
Realize the new product of teaching experiment.It as instructional device, needs to have: working principle can be demonstrated, kinds of experiments and survey can be carried out
Examination, small in size, light-weight, degree of opening is high, simple experiment, it is at low cost the features such as, be also used as the platform of new product development,
For research and development of products.It is more difficult for meeting these demands simultaneously.Chinese patent (application number 201710245898.2) is open
A kind of device for testing stable platform and test method towards experimental teaching needs to generate using the inclined base of process control
Attitude disturbance, system complexity are high, at high cost.It is used that Chinese patent (application number 201610545741.7) discloses a kind of microminiature
Property stabilized platform experiment teaching instrument, but system in view of transducer calibration, generate disturbing source etc., and devise scalable exhibition
The wing, two dimension disturbance base unit etc., and using three axle speed rate rotation table devices as stabilized platform, volume weight is difficult to control, and
And the electrical composition of control system is not addressed, without photoelectric imaging device, the teaching experiment that can be carried out is limited.
Summary of the invention
In view of this, the embodiment of the invention provides the opto-electric stabilization holder and its test method of a kind of teaching-oriented, it can
To provide required hardware foundation for the teaching of the stability of holder, and a variety of servo control algorithms are demonstrated by embedded chip,
Facilitate teaching demonstration.
In a first aspect, the present invention provides a kind of test method of the opto-electric stabilization holder of teaching-oriented, the teaching-oriented
Opto-electric stabilization holder include: alidade, built-in industrial control machine, the alidade includes at least one set of frame, is arranged described
Servo motor, motor drive module on frame, the current sampling circuit being arranged on the motor drive module and with institute
State the corresponding shaft-position encoder of servo motor quantity, which comprises
The phase current that the servo motor is measured using the current sampling circuit passes through the coding of the shaft-position encoder
Device measured value;
The phase current and the encoder measurement are sent to the built-in industrial control machine;
The built-in industrial control machine determines motor control amount according to the encoder measurement, and the motor control amount is sent out
Give the motor drive module;
The motor drive module according to sended over by built-in industrial control machine α axis, β axis control amount, sweared according to space
It measures pulse width modulation algorithm SVPWM and generates pwm control signal driving brushless motor rotation.
As one kind, optionally scheme, the built-in industrial control machine determine motor control according to the encoder measurement
Amount, is sent to the motor drive module for the motor control amount, comprising:
The built-in industrial control machine calculates the electrical angle of the servo motor according to the encoder measurement, to the electricity
Angle carries out Clarke transformation for the electric current (I under 120 ° of phase shift three-axis referencesa,Ib,Ic) it is converted into two axis rectangular coordinate system electricity
Flow (Iα,Iβ);Park transformation is carried out again, by the electric current (I under two axis rectangular coordinate systemsα,Iβ) it is converted into two axis relevant to rotor
Rotating coordinate system electric current (Id,Iq), sinusoidal or constant value current-order is generated, for current value IdAnd IqEstablish current loop control
Device, obtains comprising d axis, q axis control amount, will revert to two axis rectangular co-ordinates comprising d axis, q axis control amount using Park inverse transformation
System obtains the motor control amount comprising α axis, β axis, and the motor control amount comprising α axis, β axis is sent to the motor driven mould
Block.
As a kind of optionally scheme, whether the current controller runs well for testing brushless motor, electric power is anti-
Feedback.
Second aspect, the present invention provide a kind of opto-electric stabilization holder of teaching-oriented, are applied to appoint in claims 1 to 3
The opto-electric stabilization holder of the test method of the opto-electric stabilization holder of one teaching-oriented, the teaching-oriented includes: to sight
Frame, integrated control electronic box and built-in industrial control machine, the alidade include at least one set of frame, are arranged on said frame
Servo motor, motor drive module, shaft-position encoder corresponding with the servo motor quantity, the figure of installation on said frame
Inertia measuring module as acquisition module and for measuring described image acquisition module exercise data, the built-in industrial control machine
With communication card and image pick-up card, the built-in industrial control machine by the communication card and the integrated control electronic box,
The motor drive module, described image acquisition module and inertia measuring module communication connection, the embedded industry control
The picture signal that described image acquisition module is shot is acquired processing using described image capture card by machine.
As a kind of optionally scheme, the frame includes holding bracket, the appearance for holding bracket and frame being arranged in
Face.
As a kind of optionally scheme, the frame is equipped with the first electric interfaces, the motor drive module, described used
Property measurement module and described image acquisition module be electrically connected respectively with first electric interfaces, first electric interfaces with
The integrated control electronic box electrical connection.
As a kind of optionally scheme, the integrated control electronic box mass commercial power interface, fuse, proof and electric leakage-proof safety mould
Block, AC-DC analog-to-digital conversion module, control stick, band button, embedded controller and the second electric interfaces, second electricity
Gas interface is electrically connected with first electric interfaces.
As a kind of optionally scheme, the servo motor uses brushless motor, the shaft-position encoder with it is described brushless
The coaxial installation of motor.
As a kind of optionally scheme, the alidade is four gimbaled using three axis, three frame, two axis, two frame or two axis
Structure.
As one kind, optionally scheme, the motor drive module include power circuit, embedded chip minimum system, patrol
Collect circuit, PWM motor-drive circuit, current sampling circuit and operational amplification circuit, the output end of the motor drive module
It is electrically connected with the servo motor, the output end of the motor drive module is electrically connected with the shaft-position encoder.
As can be seen from the above technical solutions, the embodiment of the present invention has the advantage that
The opto-electric stabilization holder and its test method of teaching-oriented provided by the invention can impart knowledge to students for the stability of holder
Hardware foundation needed for providing, and the independently-powered design of 3-phase plug, can carry out Field orientable control, stable inertia control,
The teaching demonstration of the servo control algorithms such as speed and position control, after algorithm development is fixed on built-in industrial control machine, portable
The further deisgn product into embedded chip facilitates teaching demonstration, improves demonstration efficiency.
Detailed description of the invention
A kind of flow chart of embodiment of test method of the stabilization holder of teaching-oriented provided by the invention when Fig. 1;
Fig. 2 is a kind of composition schematic diagram of embodiment of the stabilization holder of teaching-oriented provided by the invention;
Fig. 3 is that three axis, three frame alidade example structure is shown in the opto-electric stabilization holder of teaching-oriented provided by the invention
It is intended to;
Fig. 4 is that two axis, two frame alidade example structure is shown in the opto-electric stabilization holder of teaching-oriented provided by the invention
It is intended to;
Fig. 5 is that two axis, four frame alidade example structure is shown in the opto-electric stabilization holder of teaching-oriented provided by the invention
It is intended to;
Fig. 6 is data content composition schematic diagram in the opto-electric stabilization holder of teaching-oriented provided by the invention;
Fig. 7 is motor drive module composition block diagram in the opto-electric stabilization holder of teaching-oriented provided by the invention;
Fig. 8 is motor drive module program flow diagram in the opto-electric stabilization holder of teaching-oriented provided by the invention;
Fig. 9 is integrated control electronic box composition schematic diagram in the opto-electric stabilization holder of teaching-oriented provided by the invention;
Figure 10 is the embedded Control in the opto-electric stabilization holder of teaching-oriented provided by the invention in integrated control electronic box
The program flow diagram of device;
Figure 11 is built-in industrial control machine real-time program flow chart in the opto-electric stabilization holder of teaching-oriented provided by the invention.
Specific embodiment
In order to enable those skilled in the art to better understand the solution of the present invention, below in conjunction in the embodiment of the present invention
Attached drawing, technical scheme in the embodiment of the invention is clearly and completely described, it is clear that described embodiment is only
The embodiment of a part of the invention, instead of all the embodiments.Based on the embodiments of the present invention, ordinary skill people
The model that the present invention protects all should belong in member's every other embodiment obtained without making creative work
It encloses.
Description and claims of this specification and term " first ", " second ", " third ", " in above-mentioned attached drawing
Four " etc. be to be used to distinguish similar objects, without being used to describe a particular order or precedence order.It should be understood that using in this way
Data be interchangeable under appropriate circumstances, so that the embodiments described herein can be in addition to illustrating herein or describing
Sequence other than appearance is implemented.In addition, term " includes " and " having " and their any deformation, it is intended that covering is non-exclusive
Include, for example, the process, method, system, product or equipment for containing a series of steps or units are not necessarily limited to clearly arrange
Those of out step or unit, but may include be not clearly listed or it is solid for these process, methods, product or equipment
The other step or units having.
As shown in connection with fig. 1, a kind of test method of the opto-electric stabilization holder of teaching-oriented, institute are provided in the embodiment of the present invention
The opto-electric stabilization holder for stating teaching-oriented includes: alidade, built-in industrial control machine, the alidade include at least one set of frame,
Servo motor, motor drive module, the current sample electricity being arranged on the motor drive module on said frame is set
Road and shaft-position encoder corresponding with the servo motor quantity, which comprises
S101, the phase current that the servo motor is measured using the current sampling circuit, pass through the shaft-position encoder
Encoder measurement.
Servo motor phase current is measured using the ADC sample circuit on the motor drive module on alidade, by described
The encoder measurement of shaft-position encoder.
S102, the phase current and the encoder measurement are sent to the built-in industrial control machine.
S103, the built-in industrial control machine determine motor control amount according to the encoder measurement, by the motor control
Amount processed is sent to the motor drive module.
According to Field orientable control algorithm, in built-in industrial control machine program, built-in industrial control machine is according to the encoder
Measured value calculates the electrical angle of the servo motor, carries out Clarke transformation for 120 ° of phase shift three-axis references to the electrical angle
Under electric current (Ia,Ib,Ic) it is converted into two axis rectangular coordinate system electric current (Iα,Iβ);Park transformation is carried out again, by two axis rectangular co-ordinates
Electric current (I under systemα,Iβ) it is converted into two axis rotating coordinate system electric current (I relevant to rotord,Iq), generate sinusoidal or constant value
Current-order, for current value IdAnd IqCurrent loop controller is established, obtains utilizing Park inverse transformation comprising d axis, q axis control amount
By comprising d axis, q axis control amount revert to two axis rectangular coordinate systems obtain comprising α axis, β axis motor control amount, will comprising α axis,
The motor control amount of β axis is sent to the motor drive module.
S104, the motor drive module according to sended over by built-in industrial control machine α axis, β axis control amount, according to sky
Between Vector Pulse Width Modulation algorithm SVPWM generate pwm control signal driving brushless motor rotation.
It is programmed in built-in industrial control machine, for the current controller in different control algolithm change S103, tests nothing
Whether brush motor run well, electric power feedback is as how, verificating current algorithm effect.
The test method of the opto-electric stabilization holder of teaching-oriented provided by the invention can mention for the stability teaching of holder
For required hardware foundation, and the independently-powered design of 3-phase plug, Field orientable control, stable inertia control, speed can be carried out
The teaching demonstration of the servo control algorithms such as degree and position control may migrate to after algorithm development is fixed on built-in industrial control machine
Further deisgn product in embedded chip facilitates teaching demonstration, improves demonstration efficiency.
As shown in connection with fig. 2, correspondingly, the present invention provides a kind of opto-electric stabilization holder 100 of teaching-oriented, for executing
The photoelectricity opto-electric stabilization holder of the test method of the opto-electric stabilization holder for the teaching-oriented stated, the teaching-oriented includes: to sight
Frame 101, integrated control electronic box and built-in industrial control machine, the alidade include at least one set of frame, are arranged in the frame
On servo motor, motor drive module, shaft-position encoder corresponding with the servo motor quantity, installation on said frame
Image capture module and inertia measuring module for measuring described image acquisition module exercise data, the embedded work
Control machine has communication card and image pick-up card, and the built-in industrial control machine passes through the communication card and integrated control electricity
Case, the motor drive module, described image acquisition module and inertia measuring module communication connection, the embedded work
The picture signal that described image acquisition module is shot is acquired processing using described image capture card by control machine.
Frame includes holding bracket, and the outer surface for holding bracket and frame being arranged in holds bracket for experimenter
Hand-held to be shaken, so that frame generates attitude disturbance, the image and data inside holder are connected with built-in industrial control machine.It is integrated
There are the operating devices such as control stick, button for experimenter's operation on control electronic box, controls and stablize holder work.Experimenter exists
Program is write on built-in industrial control machine carries out the courses of instruction such as teaching demonstration or control theory practice.
Optionally, the frame be equipped with the first electric interfaces, the motor drive module, the inertia measuring module with
And described image acquisition module is electrically connected with first electric interfaces respectively, first electric interfaces and the integrated control
Electronic box electrical connection.
Optionally, the servo motor uses brushless motor, shaft-position encoder installation coaxial with the brushless motor.
In conjunction with shown in Fig. 2,3 or 4, the alidade 101 is four gimbaled using three axis, three frame, two axis, two frame or two axis
Structure, three axis, three frame includes that azimuth axis, orientation driving brushless motor, orientation frame, inertia measuring module, image are adopted in Fig. 2
Collect module, pitching drives brushless motor, pitch axis, pitching frame.Roll frame, roll driving brushless motor and roll axis,
Two axis, two frame includes inertia measuring module, image capture module, azimuth axis, alidade and pitch axis in Fig. 3, two in Fig. 4
Four frame of axis includes exterior orientation driving brushless motor, inner orientation axis, exterior orientation axis, alidade, inner orientation driving brushless motor, is used to
Property measurement module, image capture module, outer pitch axis, outer pitching driving brushless motor, interior pitch axis and interior pitching drive nothing
Which kind of structure no matter brush motor use for selecting which kind of frame that can flexibly carry out according to experiment demand, turns in each frame
There are a brushless motor, a motor drive module and a shaft-position encoder on moving axis.Inertial Measurement Unit and video camera
Module is all mounted in inner frame, acquires inertial attitude information and image information respectively.
Several frame structures no matter are used, a brushless motor is respectively arranged on each rotation frame, the frame is driven to rotate.Institute
Shaft-position encoder is stated with the brushless motor using coaxial mounting means, the corner of brushless motor is directly measured, using absolute type
Shaft-position encoder detects rotational travel.The motor drive module can pass through host computer procedure using DSP or ARM as core
Work is set in open current loop or current closed-loop mode, drives brushless motor rotation.The Inertial Measurement Unit real-time measurement is taken the photograph
The inertia angular speed and angle posture of camera module.The camara module is mounted on inside the alidade, has SDI high definition figure
As output interface, image can be shot and receive extraneous instruction progress zoom.
As shown in connection with fig. 9, the integrated control electronic box mass commercial power interface 801, fuse 802, proof and electric leakage-proof safety module
803, AC-DC module 804, control stick 805, band button 806, embedded controller 807 and the second electric interfaces 808, institute
The second electric interfaces 808 are stated to be electrically connected with first electric interfaces, integrated control electronic box using overcurrent and it is earth leakage protective solely
Verticalization power-supply service, it is only necessary to which an external three-phase alternating current plug facilitates teaching demonstration.Integrated control electronic box is on the one hand negative
Entire opto-electric stabilization holder 100 and the power supply task of itself are blamed, control stick instruction on the other hand can be acquired, it is anti-by electric interfaces
It is fed in built-in industrial control machine 809.Each described can individually be responsible for the power supply task an of gimbal axis with button.
Communication card is housed inside the built-in industrial control machine 809, the spindle motor drive module, described used can be received
Property the data that issue of measuring unit, the camara module and the integrated control electronic box, and motion control amount and control are referred to
Order is sent to the motor drive module.Described image capture card is also mounted inside the built-in industrial control machine, is used for institute
The picture signal that camara module takes is stated to acquire and show.
Optionally, the motor drive module includes power circuit, embedded chip minimum system, logic circuit, PWM electricity
Drive circuit, current sampling circuit and operational amplification circuit, the output end of the motor drive module and servo electricity
Mechatronics, the output end of the motor drive module are electrically connected with the shaft-position encoder.
As shown in fig. 6, the data for stablizing holder to built-in industrial control machine mainly include inertia measuring module and motor driven
Module, wherein the data content of Inertial Measurement Unit is according to its protocol analysis, motor drive module to built-in industrial control machine
Data mainly include shaft-position encoder coded data and current feedback amount, can be respectively as speed, position control and magnetic field
The feedback quantity of oriented control.The data content of built-in industrial control machine to brushless motor driver module mainly includes current-order, electricity
Open-closed-loop mark is flowed, α, β voltage of motor enabler flags and PARK inverse transformation output, such Field orientable control algorithm can be with
It is write on built-in industrial control machine, after program Solidification, this partial content can be cured to the embedding of brushless motor driver module
Enter in formula chip.The data content of integrated control electronic box to built-in industrial control machine is mainly the control instruction of control stick, for pair
Stablize holder and carries out speed and position control.
Optionally, the motor drive module program includes that the main interruption of ADC sampling and PERCOM peripheral communication are received and interrupted, and outside is logical
Letter receives the voltage value of the current-order from built-in industrial control machine and PARK inverse transformation, and ADC sampling is main to be interrupted by reading electricity
Stream feedback measured value and shaft-position encoder data, while sending data to built-in industrial control machine, when the built-in industrial control machine just
Field orientable control algorithm is being write, then is receiving the voltage value of PARK inverse transformation output, PWM instruction is being generated and controls the servo electricity
Machine rotation then receives current-order closed-loop control driving when the motor drive module is currently running Field orientable control algorithm
The servo motor rotation.
After Field orientable control algorithm development is mature, this step can be cured to the embedded of brushless motor driver module
In chip, current-order, Open-closed-loop mark and motor enabler flags are only received.
It is measured with the coaxial mounted shaft-position encoder of brushless motor and relatively rotates angle, is fed back by electric interfaces to embedding
Enter in formula industrial personal computer, the control for speed ring and position ring.
As shown in figure 8, the motor drive module program includes that the main interruption of ADC sampling and PERCOM peripheral communication are received and interrupted,
PERCOM peripheral communication receives the voltage value of the current-order from built-in industrial control machine and PARK inverse transformation, and main interrupt reads electricity by AD
Stream feedback measured value reads shaft-position encoder data by communication interface, while sending data to built-in industrial control machine.If
Field orientable control algorithm is write on built-in industrial control machine, then receives the voltage value of PARK inverse transformation output, generates PWM control electricity
Machine rotation;If running Field orientable control algorithm in the embedded chip of drive module, current-order closed loop control is received
System driving brushless motor rotation, the working method of open loop or closed loop can be arranged by program, may also set up whether motor enables.
The integrated control electronic box program reads simulation in master timer interruption after initialization as shown in Figure 10
The voltage value of control stick sends data to built-in industrial control machine.
The built-in industrial control machine is clamped by image acquisition board receives the image information for stablizing holder, passes through data communication
Board and stablizes holder and integrated control electronic box and carry out data exchange.Real-time control journey can be write on built-in industrial control machine
Sequence realizes the motion control for stablizing holder, the task that the monitoring of operation data and image are shown.If production will be developed further
Algorithm in built-in industrial control machine can be then transplanted in embedded chip by product.
As shown in figure 11, built-in industrial control machine real-time program process mainly includes the main interruption of timer, with integrated control electricity
Case communication disruption, the communication disruption of the communication disruption of Inertial Measurement Unit and multiple motor drive modules.It is received in main interruption
The control instruction that host computer and integrated control electronic box are sent, plans the operating mode for stablizing holder, for the motor of each frame
Drive module plans speed and position command, in conjunction with stablizing each sensing data in holder, operation closed loop control algorithm and
Field orientable control algorithm transmits data to each motor drive module, recycles and executes by above-mentioned process, may be implemented to stablize
The different operating mode such as holder stable inertia, speed control, position control.
The opto-electric stabilization holder of teaching-oriented provided by the invention, can imparting knowledge to students for the stability of holder, it is required hard to provide
Part basis, and the independently-powered design of 3-phase plug can carry out Field orientable control, stable inertia control, speed and position control
The teaching demonstration of the servo control algorithms such as system may migrate to embedded chip after algorithm development is fixed on built-in industrial control machine
In further deisgn product, facilitate teaching demonstration, improve demonstration efficiency.
It is apparent to those skilled in the art that for convenience and simplicity of description, the system of foregoing description,
The specific work process of device and unit, can refer to corresponding processes in the foregoing method embodiment, and details are not described herein.
In several embodiments provided herein, it should be understood that disclosed system, device and method can be with
It realizes by another way.For example, the apparatus embodiments described above are merely exemplary, for example, the unit
It divides, only a kind of logical function partition, there may be another division manner in actual implementation, such as multiple units or components
It can be combined or can be integrated into another system, or some features can be ignored or not executed.Another point, it is shown or
The mutual coupling, direct-coupling or communication connection discussed can be through some interfaces, the indirect coupling of device or unit
It closes or communicates to connect, can be electrical property, mechanical or other forms.
The unit as illustrated by the separation member may or may not be physically separated, aobvious as unit
The component shown may or may not be physical unit, it can and it is in one place, or may be distributed over multiple
In network unit.It can select some or all of unit therein according to the actual needs to realize the mesh of this embodiment scheme
's.
It, can also be in addition, the functional units in various embodiments of the present invention may be integrated into one processing unit
It is that each unit physically exists alone, can also be integrated in one unit with two or more units.Above-mentioned integrated list
Member both can take the form of hardware realization, can also realize in the form of software functional units.
Those of ordinary skill in the art will appreciate that all or part of the steps in the various methods of above-described embodiment is can
It is completed with instructing relevant hardware by program, which can be stored in a computer readable storage medium, storage
Medium may include: read-only memory (ROM, Read Only Memory), random access memory (RAM, Random
Access Memory), disk or CD etc..
The opto-electric stabilization holder and its test method of a kind of teaching-oriented provided by the present invention have been carried out in detail above
It introduces, for those of ordinary skill in the art, thought according to an embodiment of the present invention, in specific embodiment and application range
Upper there will be changes, in conclusion the contents of this specification are not to be construed as limiting the invention.
Claims (10)
1. a kind of test method of the opto-electric stabilization holder of teaching-oriented, which is characterized in that the opto-electric stabilization of the teaching-oriented
Holder includes: alidade, built-in industrial control machine, and the alidade includes at least one set of frame, setting watching on said frame
Take motor, motor drive module, the current sampling circuit being arranged on the motor drive module and with the servo motor
The corresponding shaft-position encoder of quantity, which comprises
The phase current that the servo motor is measured using the current sampling circuit is surveyed by the encoder of the shaft-position encoder
Magnitude;
The phase current and the encoder measurement are sent to the built-in industrial control machine;
The built-in industrial control machine determines motor control amount according to the encoder measurement, and the motor control amount is sent to
The motor drive module;
The motor drive module according to sended over by built-in industrial control machine α axis, β axis control amount, according to space vector arteries and veins
Wide modulation algorithm SVPWM generates pwm control signal driving brushless motor rotation.
2. the test method of the opto-electric stabilization holder of teaching-oriented according to claim 1, which is characterized in that the insertion
Formula industrial personal computer determines motor control amount according to the encoder measurement, and the motor control amount is sent to the motor driven
Module, comprising:
The built-in industrial control machine calculates the electrical angle of the servo motor according to the encoder measurement, to the electrical angle
Clarke transformation is carried out by the electric current (I under 120 ° of phase shift three-axis referencesa,Ib,Ic) it is converted into two axis rectangular coordinate system electric currents
(Iα,Iβ);Park transformation is carried out again, by the electric current (I under two axis rectangular coordinate systemsα,Iβ) it is converted into two axis rotation relevant to rotor
Turn coordinate system electric current (Id,Iq), sinusoidal or constant value current-order is generated, for current value IdAnd IqCurrent loop controller is established,
It obtains to revert to two axis rectangular coordinate systems comprising d axis, q axis control amount using Park inverse transformation comprising d axis, q axis control amount and obtaining
To the motor control amount comprising α axis, β axis, the motor control amount comprising α axis, β axis is sent to the motor drive module.
3. the test method of the opto-electric stabilization holder of teaching-oriented according to claim 2, which is characterized in that the electric current
Whether controller runs well for testing brushless motor, electric power is fed back.
4. a kind of opto-electric stabilization holder of teaching-oriented, which is characterized in that be applied to face described in any one of claims 1 to 3
To the test method of the opto-electric stabilization holder of teaching, the opto-electric stabilization holder of the teaching-oriented includes: alidade, integrated control
Electronic box and built-in industrial control machine, the alidade include at least one set of frame, servo motor, the electricity of setting on said frame
Machine drive module, shaft-position encoder corresponding with the servo motor quantity, the image capture module of installation on said frame
And the inertia measuring module for measuring described image acquisition module exercise data, the built-in industrial control machine have communication board
Card and image pick-up card, the built-in industrial control machine are driven by the communication card and the integrated control electronic box, the motor
Dynamic model block, described image acquisition module and the inertia measuring module communicate to connect, described in the built-in industrial control machine utilization
The picture signal that described image acquisition module is shot is acquired processing by image pick-up card.
5. the opto-electric stabilization holder of teaching-oriented according to claim 4, which is characterized in that the frame includes holding branch
Frame, the outer surface for holding bracket and frame being set.
6. the opto-electric stabilization holder of teaching-oriented according to claim 4, which is characterized in that the frame is equipped with first
Electric interfaces, the motor drive module, the inertia measuring module and described image acquisition module are respectively with described first
Electric interfaces electrical connection, first electric interfaces are electrically connected with the integrated control electronic box.
7. the opto-electric stabilization holder of teaching-oriented according to claim 4, which is characterized in that the integrated control electronic box packet
Block commercial power interface, fuse, proof and electric leakage-proof safety module, AC-DC analog-to-digital conversion module, control stick, band button, embedded Control
Device and the second electric interfaces, second electric interfaces are electrically connected with first electric interfaces.
8. the opto-electric stabilization holder of teaching-oriented according to claim 4, which is characterized in that the servo motor uses nothing
Brush motor, shaft-position encoder installation coaxial with the brushless motor.
9. the opto-electric stabilization holder of teaching-oriented according to claim 4, which is characterized in that the alidade uses three axis
Three frames, two axis, two frame or the four gimbaled structure of two axis.
10. the opto-electric stabilization holder of teaching-oriented according to claim 4, which is characterized in that the motor drive module
Including power circuit, embedded chip minimum system, logic circuit, PWM motor-drive circuit, current sampling circuit and operation
Amplifying circuit, the output end of the motor drive module are electrically connected with the servo motor, the output of the motor drive module
End is electrically connected with the shaft-position encoder.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811491673.6A CN109445419A (en) | 2018-12-07 | 2018-12-07 | A kind of the opto-electric stabilization holder and its test method of teaching-oriented |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811491673.6A CN109445419A (en) | 2018-12-07 | 2018-12-07 | A kind of the opto-electric stabilization holder and its test method of teaching-oriented |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109445419A true CN109445419A (en) | 2019-03-08 |
Family
ID=65556366
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811491673.6A Pending CN109445419A (en) | 2018-12-07 | 2018-12-07 | A kind of the opto-electric stabilization holder and its test method of teaching-oriented |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109445419A (en) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010075009A (en) * | 2008-09-22 | 2010-04-02 | Canon Inc | Driver and method for controlling same, and electronic equipment |
CN102122916A (en) * | 2011-04-18 | 2011-07-13 | 苏州秉立电动汽车科技有限公司 | Compound control method based on vector control system of permanent magnet synchronous motor |
CN104394316A (en) * | 2014-11-16 | 2015-03-04 | 南京理工大学 | Camera cloud deck posture testing system |
CN205249351U (en) * | 2015-08-20 | 2016-05-18 | 天津中翔腾航科技有限公司 | Cloud platform controller is stabilized to vision |
CN106847005A (en) * | 2016-07-13 | 2017-06-13 | 中北大学 | A kind of microminiature inertial stabilized platform experiment teaching instrument |
CN107121151A (en) * | 2017-04-14 | 2017-09-01 | 中北大学 | A kind of device for testing stable platform and method of testing towards experimental teaching |
CN107147341A (en) * | 2017-06-16 | 2017-09-08 | 中国科学院长春光学精密机械与物理研究所 | The vector control method and control system and stable head rotated for controlled motor |
CN108736779A (en) * | 2017-11-30 | 2018-11-02 | 深圳市科卫泰实业发展有限公司 | A kind of horizontal stage electric machine control method |
-
2018
- 2018-12-07 CN CN201811491673.6A patent/CN109445419A/en active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010075009A (en) * | 2008-09-22 | 2010-04-02 | Canon Inc | Driver and method for controlling same, and electronic equipment |
CN102122916A (en) * | 2011-04-18 | 2011-07-13 | 苏州秉立电动汽车科技有限公司 | Compound control method based on vector control system of permanent magnet synchronous motor |
CN104394316A (en) * | 2014-11-16 | 2015-03-04 | 南京理工大学 | Camera cloud deck posture testing system |
CN205249351U (en) * | 2015-08-20 | 2016-05-18 | 天津中翔腾航科技有限公司 | Cloud platform controller is stabilized to vision |
CN106847005A (en) * | 2016-07-13 | 2017-06-13 | 中北大学 | A kind of microminiature inertial stabilized platform experiment teaching instrument |
CN107121151A (en) * | 2017-04-14 | 2017-09-01 | 中北大学 | A kind of device for testing stable platform and method of testing towards experimental teaching |
CN107147341A (en) * | 2017-06-16 | 2017-09-08 | 中国科学院长春光学精密机械与物理研究所 | The vector control method and control system and stable head rotated for controlled motor |
CN108736779A (en) * | 2017-11-30 | 2018-11-02 | 深圳市科卫泰实业发展有限公司 | A kind of horizontal stage electric machine control method |
Non-Patent Citations (2)
Title |
---|
徐钰蕾等: "机载光电平台内框架结构预测 ", 《仪器仪表学报》 * |
车鑫等: "机载光电载荷视轴指向控制技术综述 ", 《光学精密工程》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN204831330U (en) | Three -axle table's attitude sensor test system | |
CN106643809B (en) | MEMS gyroscope testing device, system and method | |
CN105136036B (en) | The 3 D scanning system of portable image and laser fusion | |
CN103792957B (en) | A kind of light-duty two degrees of freedom camera stable platform apparatus | |
CN207634925U (en) | A kind of holder and the camera assembly with this holder | |
CN109375654A (en) | A kind of the opto-electric stabilization holder and its test method of teaching-oriented | |
CN101660966B (en) | Device for simulating dynamic imaging of TDI CCD camera | |
US11409291B2 (en) | Modular autonomous drone | |
CN104503473B (en) | Inertial stabilization controller | |
CN103984193A (en) | Shooting equipment stabilizer and control method thereof | |
US8983792B2 (en) | Indoor testing device for a plurality of rotor-containing flying objects | |
CN105045293B (en) | Cloud platform control method, outer carrier control method and holder | |
CN104638562B (en) | Helicopter in electric inspection process system and method | |
CN203950109U (en) | Capture apparatus stabilizator | |
CN208299634U (en) | A kind of motor, holder and unmanned vehicle | |
CN111694376B (en) | Flight simulation method and device, electronic equipment and unmanned aerial vehicle | |
CN104571124A (en) | Three-degree-of-freedom attitude simulation device for underwater vehicle | |
CN103395496A (en) | Triaxial orthographic nacelle of unmanned aerial vehicle | |
CN104811641A (en) | Head wearing camera system with cloud deck and control method thereof | |
CN206639050U (en) | The miniature head of three axles | |
CN107145167A (en) | A kind of video target tracking method based on digital image processing techniques | |
CN204347614U (en) | A kind of for submarine navigation device Three Degree Of Freedom attitude-simulating device | |
CN109373976A (en) | Unmanned plane plotting board | |
CN104949691A (en) | MEMS inertial component rotation-modulation testing system based on ultrasonic motor | |
CN204258162U (en) | Helicopter in electric inspection process system |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190308 |