CN102426432A - Three-dimensional imaging security gate servo control device - Google Patents
Three-dimensional imaging security gate servo control device Download PDFInfo
- Publication number
- CN102426432A CN102426432A CN2011104575019A CN201110457501A CN102426432A CN 102426432 A CN102426432 A CN 102426432A CN 2011104575019 A CN2011104575019 A CN 2011104575019A CN 201110457501 A CN201110457501 A CN 201110457501A CN 102426432 A CN102426432 A CN 102426432A
- Authority
- CN
- China
- Prior art keywords
- servo
- scanning
- loading frame
- motor
- servo controller
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Abstract
The invention relates to a three-dimensional imaging security gate servo control device. The device comprises a servo mechanism, a measuring feedback mechanism and a servo controller, wherein the the servo mechanism comprises an alternating current servo motor (1), a motor driver (2), a power supply adapter (3), a speed reducer (4), a belt wheel (5) and a load frame (6); the measuring feedback mechanism comprises a grating ruler (7) and a photoelectric switch (8); the servo controller comprises an interactive communication module, a signal collecting module, a self-checking correction control module and a scanning curve control module of the servo mechanism; according to the invention, the self-checking correction and working scanning function are realized through coordination control of the servo controller; the zero position can be calculated by using the load frame under a self-checking correction instruction and the load frame can be accurately set to zero at a stable speed; and the load frame can move along a set curve track and operate stably under the working scanning instruction so that the imaging index requirements of the three-dimensional security gate system can be assured.
Description
Technical field
The application relates to the servocontrol field, particularly relates to a kind of three-dimensional imaging detector gate Servocontrol device.
Background technology
The three-dimensional imaging detector gate is fit to be applied in the safe protection engineering of special occasions such as airport, subway, bank, large-scale activity; It utilizes three-dimensional imaging figure that the microwave Imaging Technique of different angles constitutes objective body whether to detect dangerous article, therefore needs to be equipped with servo-control system the loading frame movement locus that the microwave antenna transceiver module is housed is controlled.Be to guarantee detector gate system imaging quality and detection speed, travelling speed, operation curve and the stationarity of servo-control system load proposed higher requirement.
The public reported relevant with the present invention has: " design and the realization of novel booth formula metal detecting system " (" security protection science and technology "; 2008 the 4th phases) introduced the control method of utilizing the servomotor that CPLD realizes in the literary composition; Its major control object is the bullet proof glass door in the two-door booth formula structure; Only need control its folding, travelling speed and running orbit are not had specific (special) requirements, so the servo controller of prior art can't realize that self check is proofreaied and correct and the work scan function; Can't satisfy in the course of work loading frame speed stabilizing and precisely return zero, also can't satisfy the index request of three-dimensional detector gate system imaging.
Summary of the invention
The present invention aims to provide a kind of three-dimensional imaging detector gate Servocontrol device.Servocontrol device is used for carrying out the control signal that servo controller sends, and the drive load framework is according to setting regular movement.Wherein, Servo controller is accomplished signal acquisition process, self calibration orthofunction and work scan function with the interactive communication between host computer signal Processing and motor driver, feedback measuring mechanism as the maincenter of whole servo-control system, and the system of assurance operates steadily and possesses failure protection function.
Technical scheme of the present invention is:
The present invention relates to a kind of three-dimensional imaging detector gate Servocontrol device, this device comprises servo control mechanism, measures feedback mechanism and servo controller, wherein:
Servo control mechanism comprises AC servo motor, motor driver, power supply adaptor, speed reduction unit, belt pulley and loading frame; The AC servo motor main shaft is through the ring flange connection reducer; The motion of speed reduction unit drive pulley; Belt pulley links to each other with loading frame; Drive the detector gate loading frame and accomplish various FMs, AC servo motor is directly controlled by motor driver, and motor driver connects power supply adaptor and realizes that AC-DC conversion is that electric system provides power supply and realizes defencive function;
Measure feedback mechanism and comprise grating chi, optoelectronic switch; The grating chi is installed on the loading frame main shaft; Thereby grating ruler reading head is fixed in loading frame and rotates the angle information that generation coded signal pulse sensing lead framework rotates with framework; Optoelectronic switch is installed on the loading frame top and contacts with angle indication disk, can realize the indication of center zero-bit and extreme position;
Servo controller comprises: the scanning curve control module of interactive communication module, signal acquisition module, self check correcting control module and servo control mechanism; The interactive communication module is divided into two parts: a part is accomplished the communication with host computer signal Processing extension set, receives its command signal that issues and feeds back current servo-drive system status information; Another part completion is communicated by letter with motor driver, and servo actuator is implemented control; Wherein, signal acquisition module is handled the quadrature coding pulse signal and the photoelectric switching signal of grating; The self check correcting control module is accomplished the self calibration positive order that the signal Processing extension set issues; The scanning worker that scanning curve control module completion signal Processing extension set issues organizes instruction.
Further, servo controller carries out work according to following pattern:
Servo controller carries out work according to following mode of operation:
First pattern: accomplish self check and proofread and correct; Self check is proofreaied and correct in the course of work and to be gathered the grating ruler reading head calculated signals by servo controller and go out load situation and control motor and return zero and move; After accomplishing correction, servo condition information reporting signal Processing extension set is waited for that issuing scanning work instructs;
Second pattern: accomplish scanning work, in the scanning work process by servo controller according to the scanning motion curve calculation parameter of setting and control motor driver and make the servo-drive system loading frame carry out scanning motion.
Beneficial effect of the present invention:
Coordination control through servo controller has in the present invention realized that self check is proofreaied and correct and the work scan function, and loading frame can under the self calibration positive order, calculate zero-bit and speed stabilizing precisely returns zero; Under the work scan instruction, according to the setting curve orbiting motion and operate steadily, can guarantee the index request of three-dimensional detector gate system imaging.
Description of drawings
Fig. 1 is the Servocontrol device structural representation;
Fig. 2 is the servo controller module frame chart;
Fig. 3 is the servocontrol process flow diagram.
Wherein: 1-AC servo motor, 2-motor driver, 3-power supply adaptor, 4-speed reduction unit; The 5-belt pulley, 6-loading frame, 7-grating chi, 8-optoelectronic switch; The 9-servo controller, 10-signal acquisition module, 11-self check correcting control module; 12-scanning curve control module, 13-interactive communication module, 14-signal Processing extension set.
Embodiment
Below in conjunction with accompanying drawing 1-4 embodiment of the present invention is further described:
The structural representation of three-dimensional imaging detector gate Servocontrol device is as shown in Figure 1, and comprise servo control mechanism and measure feedback mechanism and servo controller, wherein:
Servo control mechanism is made up of AC servo motor 1, motor driver 2, power supply adaptor 3, speed reduction unit 4, belt pulley 5 and loading frame 6.AC servo motor 1 drives the motion of gear train and loading frame as the source of control power.The movement instruction signal of motor driver 2 reception servo controllers and the code device signal that is converted into the gating pulse of AC servo motor 1 and combines AC servo motor 1 axle head to dispose are directly controlled the speed and the position of motor movement.Used in the present invention is GV6 driver and the supporting serial AC servo motor 1 of N0 thereof, has characteristics such as controlled variable scalable, the easy planning of velocity location.Power supply adaptor 3 converts AC power direct supply into and possesses rectification function, and realize power supply for motor and driver and supply with and can realize over-voltage protecting function, its continuous power output 300W, peak power output is 9KW.The output shaft of motor is through the gear train drive load frame movement of speed reduction unit and belt pulley formation, and the total reduction gear ratio of system is 86.2367.
Measuring feedback mechanism is made up of grating chi 7, optoelectronic switch 8.Grating chi 7 is installed on loading frame 6 main shafts, and its absolute zero position is in the center of loading frame 6 ranges of operation, and grating chi 7 read heads are fixed in loading frame 6 and rotate generation quadrature coding pulse signal with framework and resolve angle information.The grating chi 7 that the present invention uses is the increment type circle grating of RESD series; Increment type grating chi 7 is few than absolute type grating chi 7 system's lines, interface is simple; Its groove number is 32768, and system accuracy can reach 1.08 rads, fits High Speed System and the very high measurement occasion of accuracy requirement.This Servocontrol device is equipped with two optoelectronic switches 8, and the spacing and operational centre indication disk use of fit angle is installed on loading frame 6 tops, can indicate the center of extreme position and rough grade.That optoelectronic switch 8 has is contactless, do not have machinery collision, the fast characteristics of response speed, can satisfy the limit function that designs among the present invention and use.
The self calibration positive order that servo-drive system self check correcting control module 11 completion signal Processing extension sets issue realizes that loading frame precisely returns zero, and prepares for scanning work instructs.
Scanning curve control module 12 is accomplished the scanning work instruction that the signal Processing extension set issues, and realizes that finally loading frame moves according to scanning curve.
Servo controller carries out according to two kinds of patterns:
First pattern: accomplish self check and proofread and correct; Self check is proofreaied and correct in the course of work and to be gathered grating chis 7 read head calculated signals by servo controller 9 and go out load situation and control motor and return zero and move; After accomplishing correction; The wait of servo condition information reporting signal Processing extension set is issued work order, concrete work as follows:
After controller was received the self calibration positive order, drive motor motion 15 degree stopped the number of buses of process in the system acquisition motion process, and the line numerical value of adjacent two Z pulses place.Absolute line number according to first Z pulse place of process in the above-mentioned algorithm computation motion process can calculate the current absolute line number of load thus.Make loading frame 6 move to the zero-bit place according to absolute position conversion control motor and accomplish back the odd-job work.For preparing to carry out scanning work, control load framework 6 moves to+55 degree positions, and uploads the signal Processing extension set and accomplish the self check correction.
Second pattern: accomplish scanning work, in the scanning work process by servo controller 9 according to predetermined scanning motion curve calculation parameter and bind motor driver 2 and make servo-drive system loading frame 6 carry out scanning motion.Its course of work is:
Through the direction of center pilot light electric switch 8 signals judgement loading frame 6 current relative zero-bits, and control load framework 6 carries out scanning motion, transmission scanning completion status word behind the end of run.Because finishing rear motor, self calibration positive order or each scanning work moved to work preparation angle place; And the angle of scanning work each run and planning curve immobilize; Therefore only need judge that the zero-bit direction confirms the direction of next scanning motion, and control load framework 6 is pressed predetermined curve and is moved.
The servo-control system overall workflow is as shown in Figure 3, and concrete steps are:
(1) waits for and receive the command signal that signal Processing 14 issues, get into step (2);
(2) decision instruction gets into step (3) for self calibration canonical; If not then get into step (12);
(3) gather photoelectric switching signal, get into step (4);
(4) judge the direction at the current place of load through optoelectronic switch 8 signals of gathering, as then getting into step (5) for positive dirction; As then getting into step (6) for negative direction;
(5) send instruction repertorie to motor driver 2, motor 1 is stopped behind negative direction operation 15 degree, get into step (7);
(6) send instruction repertorie to motor driver 2, motor 1 is stopped behind positive dirction operation 15 degree, get into step (7);
(7) gather grating chi 7 signals, get into step (8);
(8) resolve the absolute position at loading frame 6 current places, get into step (9);
(9) issue instruction repertorie to motor driver 2, make motor 1 drive load framework 6 be back to the absolute zero position place, get into step (10);
(10) control load framework 6 travels at the uniform speed to+55 degree positions, for scanning work is prepared, gets into step (11);
(11) send self check completion status word to signal Processing 14, accomplish the self calibration orthofunction;
(12) decision instruction is work scanning, then gets into step (13), otherwise gets into step (1);
(13) gather current optoelectronic switch 8 signals, and get into step (14);
(14) judge loading frame 6 current directions through optoelectronic switch 8 signal values,, be the negative step (16) that then gets into as for canonical gets into step (15);
(15) issue instruction repertorie to motor driver 2, make motor 1 drive load framework 6 to negative direction by the planning curve motion, get into step (17);
(16) issue instruction repertorie to motor driver 2, make motor 1 drive load framework 6 to positive dirction by the planning curve motion, get into step (17);
(17) send this scanning completion status word to signal Processing extension set 14, accomplish scanning work.
The algorithm that resolves of loading frame 6 current absolute positions is:
The round grating that the present invention selects is made up of the periodicity groove, counts calculating location information through the increment that begins from certain absolute reference point, can pass through totally the absolute line number of signal wire number between two RPs and following formula calculating reference point:
Z
1abs＝(absA-sgnA-1)I/2+(sgnA-dir)absZ
delt/2
A＝2absZ
delt-I
Wherein:
Z
1absAbsolute line number for the relative zero-bit that moves past first RP;
I is the nominal increment size between two permanent datums;
Dir is a sense of rotation, and value is+1 or-1;
Z
DeltIt is poor to be that two lines between permanent datum are counted;
Scanning motion planning curved configuration, loading frame 6 maximum speeds are 140 °/s, 400 °/s of peak acceleration
2, 110 ° of the anglecs of rotation, single sweep operation time 1.4s.
Claims (2)
1. three-dimensional imaging detector gate Servocontrol device, this device comprise servo control mechanism, measure feedback mechanism and servo controller, wherein:
Servo control mechanism comprises AC servo motor (1), motor driver (2), power supply adaptor (3), speed reduction unit (4), belt pulley (5) and loading frame (6); The AC servo motor main shaft is through the ring flange connection reducer; The motion of speed reduction unit drive pulley; Belt pulley links to each other with loading frame; Drive the detector gate loading frame and accomplish various FMs, AC servo motor is directly controlled by motor driver, and motor driver connects power supply adaptor and realizes that AC-DC conversion is that electric system provides power supply and realizes defencive function;
Measure feedback mechanism and comprise grating chi (7), optoelectronic switch (8); Grating chi (7) is installed on the loading frame main shaft; Grating chi (7) thus read head is fixed in loading frame and rotate to produce the angle information of coded signal pulse sensing lead framework rotation with framework; Optoelectronic switch (8) is installed on loading frame (6) top and contacts with angle indication disk, can realize the indication of center zero-bit and extreme position;
Servo controller comprises: the scanning curve control module of interactive communication module, signal acquisition module, self check correcting control module and servo control mechanism; The interactive communication module is divided into two parts: a part is accomplished the communication with host computer signal Processing extension set, receives its command signal that issues and feeds back current servo-drive system status information; Another part completion is communicated by letter with motor driver, and servo actuator is implemented control; Wherein, signal acquisition module is handled the quadrature coding pulse signal and the photoelectric switching signal of grating; The self check correcting control module is accomplished the self calibration positive order that the signal Processing extension set issues; The scanning worker that scanning curve control module completion signal Processing extension set issues organizes instruction.
2. according to right 1 described three-dimensional imaging detector gate Servocontrol device, it is characterized in that: servo controller carries out work according to following pattern:
Servo controller carries out work according to following mode of operation:
First pattern: accomplish self check and proofread and correct; Self check is proofreaied and correct in the course of work and to be gathered grating chi (7) read head calculated signals by servo controller (9) and go out load situation and control motor and return zero and move; After accomplishing correction, servo condition information reporting signal Processing extension set is waited for that issuing scanning work instructs;
Second pattern: accomplish scanning work, in the scanning work process by servo controller (9) according to the scanning motion curve calculation parameter of setting and control motor driver (2) and make servo-drive system loading frame (6) carry out scanning motion.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN 201110457501 CN102426432B (en) | 2011-12-30 | 2011-12-30 | Three-dimensional imaging security gate servo control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN 201110457501 CN102426432B (en) | 2011-12-30 | 2011-12-30 | Three-dimensional imaging security gate servo control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102426432A true CN102426432A (en) | 2012-04-25 |
| CN102426432B CN102426432B (en) | 2013-07-03 |
Family
ID=45960432
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN 201110457501 Active CN102426432B (en) | 2011-12-30 | 2011-12-30 | Three-dimensional imaging security gate servo control device |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102426432B (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112114539A (en) * | 2020-09-25 | 2020-12-22 | 成都易慧家科技有限公司 | Control system and method for double-motor-driven sliding door and window |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5786901A (en) * | 1980-09-26 | 1982-05-31 | Bendix Corp | Controller for double servo system |
| CN101145035A (en) * | 2006-09-15 | 2008-03-19 | 鸿富锦精密工业（深圳）有限公司 | Machine platform movement control system and method |
| CN101303317A (en) * | 2008-03-05 | 2008-11-12 | 中国科学院合肥物质科学研究院 | Explosive substance testing system apparatus and testing method thereof |
| CN101667029A (en) * | 2008-09-04 | 2010-03-10 | 微星科技股份有限公司 | Method for calibrating zeroing of servo mechanism |
-
2011
- 2011-12-30 CN CN 201110457501 patent/CN102426432B/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5786901A (en) * | 1980-09-26 | 1982-05-31 | Bendix Corp | Controller for double servo system |
| CN101145035A (en) * | 2006-09-15 | 2008-03-19 | 鸿富锦精密工业（深圳）有限公司 | Machine platform movement control system and method |
| CN101303317A (en) * | 2008-03-05 | 2008-11-12 | 中国科学院合肥物质科学研究院 | Explosive substance testing system apparatus and testing method thereof |
| CN101667029A (en) * | 2008-09-04 | 2010-03-10 | 微星科技股份有限公司 | Method for calibrating zeroing of servo mechanism |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112114539A (en) * | 2020-09-25 | 2020-12-22 | 成都易慧家科技有限公司 | Control system and method for double-motor-driven sliding door and window |
| CN112114539B (en) * | 2020-09-25 | 2023-11-28 | 成都易慧家科技有限公司 | Control system and method for double-motor driven sliding door and window |
Also Published As
| Publication number | Publication date |
|---|---|
| CN102426432B (en) | 2013-07-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102501890B (en) | Track changing control system for inspection vehicle and control method | |
| CN101619965B (en) | Wheel-pair automatic measuring device | |
| CN102897503B (en) | Combined positioning control system | |
| CN105127795B (en) | The method of the fixing centre of gyration of the inside and outside axle box axial location of the car wheel lathe that do not fall | |
| CN102419560B (en) | Servo controller for servo control device of three-dimensional imaging safety detection door | |
| CN105446331B (en) | Railcar alignment system and method based on encoder and rack | |
| CN103964154B (en) | Control method of combined positioning control system | |
| CN102331781B (en) | Trolley left-right linear synchronous travelling control circuit, control method and detection device | |
| CN106813584B (en) | Spiral bevel gear key parameter laser detection system and its detection method | |
| CN109407105A (en) | A kind of Servocontrol device of the online cruising inspection system of contact net geometric parameter | |
| CN104129715A (en) | Bridge type crane positioning system based on laser ranging and bar code positioning technology | |
| CN103940342A (en) | Double-rolling type arc-surface cam machining precision detecting device | |
| CN106238255A (en) | A kind of spray robot Dual-encoder redundant system | |
| CN102540928B (en) | Method for controlling servo controller of servo control device for three-dimensional security doors | |
| CN101722709A (en) | Automatic positioning and fault-tolerant safety device of frame roller in digital electronic engraving system | |
| CN106289458B (en) | A kind of level meter automatic calibration device | |
| CN102426432B (en) | Three-dimensional imaging security gate servo control device | |
| CN203076717U (en) | Large gear machining machinery | |
| CN202139537U (en) | Control circuit and detecting device for left and right linear synchronous walking of trolleys | |
| CN202453673U (en) | Safety check door servo control device | |
| CN102350421A (en) | Force position servo control system for automatically cleaning carbon bowl of anode carbon block for aluminum electrolysis | |
| CN202264802U (en) | Inspection vehicle shunt control system | |
| CN201737602U (en) | Crane positioner | |
| CN216052745U (en) | Portable automatic cruise rail inspection trolley control system | |
| CN201325768Y (en) | Accurately locating device of fork lifter |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20190830 Address after: 100013 Beijing City, Dongcheng District Hepingli No. 3 South Street Patentee after: Beijing Huahang Haiying New Technology Development Co.,Ltd. Address before: 100013 Beijing City, Dongcheng District Hepingli No. 3 South Street Patentee before: Beijing Huahang Radio Measurement Research Institute |