CN205058056U - Restrain parallelly connected platform vibration control system based on acceleration sensor - Google Patents
Restrain parallelly connected platform vibration control system based on acceleration sensor Download PDFInfo
- Publication number
- CN205058056U CN205058056U CN201520810994.3U CN201520810994U CN205058056U CN 205058056 U CN205058056 U CN 205058056U CN 201520810994 U CN201520810994 U CN 201520810994U CN 205058056 U CN205058056 U CN 205058056U
- Authority
- CN
- China
- Prior art keywords
- acceleration transducer
- degree
- freedom
- driving lever
- platform
- 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.)
- Expired - Fee Related
Links
Landscapes
- Control Of Position Or Direction (AREA)
Abstract
The utility model discloses a restrain parallelly connected platform vibration control system based on acceleration sensor, including three parallel branch mechanism, every parallel branch mechanism includes three -phase AC servo motor, reduction gear, driving lever, passive pole, three -phase AC servo motor installs on fixed platform, is equilateral triangle and distributes, and three -phase AC servo motor connect the retarder, reduction gear pass through the rotation axis connection driving lever, and the other end of driving lever passes through the rotation axis connection driven lever, and the other end of driven lever moves the platform through rotation axis connection, moves the platform and is equilateral triangle, adopt incremental encoder test initiative joint position, adopt acceleration sensor to detect the acceleration that parallelly connected platform moved platform and driving lever, according to initiative joint positional information with add the speed information integrated design controller, restrain the autovibration when connecting vibration or the point location of platform in the motion process in parallel.
Description
Technical field
The utility model relates to the control of 3-RRR parallel connection platform, particularly relates to a kind of based on acceleration transducer suppression parallel connection platform vibration control system.
Background technology
Parallel robot compares the application advantage that serial manipulator has high speed, high accuracy, high bearing capacity, and the end moving platform of parallel robot can realize high-speed motion, accurately locates, carry large mass loading.Select parallel robot as precisely locating platform, realize high speed, high accuracy, high efficiency location.Each active joint coordination motion of parallel robot makes moving platform by expectation orbiting motion.In practical application there is multifold nonlinear factors in parallel connection platform, the elastic deformation etc. of the gap of decelerator and friction, joint space, rod member, due to the impact of non-linear factor, parallel robot can produce vibration in motion process, 3-RRR parallel connection platform Singularity and near location time easily cause self-excited vibration.
Summary of the invention
The purpose of this utility model is the shortcoming and defect overcoming above-mentioned prior art, there is provided a kind of and suppress parallel connection platform vibration control system based on acceleration transducer, solve prior art parallel connection platform in motion process or location time vibration problem, make the motion of parallel connection platform or steady positioning, precisely.
The utility model is achieved through the following technical solutions:
A kind of based on acceleration transducer suppression parallel connection platform vibration control system, comprise three parallel branch mechanisms, each parallel branch mechanism comprises a three-phase alternating-current servo motor 1, decelerator 2, driving lever 4, follower lever 6;
The three-phase alternating-current servo motor 1 of each parallel branch mechanism is arranged on inside three installing holes of fixed platform respectively, installing hole is equilateral triangle distribution, three-phase alternating-current servo motor 1 connection reducer 2, decelerator turning cylinder 3 installed by decelerator 2, decelerator turning cylinder 3 connects driving lever 4, the other end of driving lever 4 connects follower lever 6 by driving lever turning cylinder 5, and the other end of follower lever 6 connects moving platform 8 by follower lever turning cylinder 7, and moving platform 8 is in equilateral triangle;
Three three-phase alternating-current servo motors 1 combine driving driving lever 4, and driving lever 4 drives follower lever 6 to make moving platform 8 desirably orbiting motion;
Incremental encoder is installed in the end of three-phase alternating-current servo motor 1, connects the code device signal interface of Dspace semi-physical simulation control card, for detecting three-phase alternating-current servo motor 1 physical location;
Moving platform 8 is provided with support 9, two linear distributing Three Degree Of Freedom acceleration transducers installed by support 9, namely, first Three Degree Of Freedom acceleration transducer 11-1 and the second Three Degree Of Freedom acceleration transducer 11-2, for detecting two translational degree of freedom and a rotational freedom directional acceleration of moving platform 8; Single-degree-of-freedom acceleration transducer installed respectively by driving lever 4, namely, first single-degree-of-freedom acceleration transducer 10-1, the second single-degree-of-freedom acceleration transducer 10-2 and the 3rd single-degree-of-freedom acceleration transducer 10-3, for detecting driving lever 4 rotational freedom directional acceleration;
Described Three Degree Of Freedom acceleration transducer is connected the input of charge amplifier with the output of single-degree-of-freedom acceleration transducer, charge amplifier output connects the A/DC interface of Dspace semi-physical simulation control card; Three-phase alternating-current servo motor 1 is connected by the I/O interface of servo-driver with Dspace semi-physical simulation control card;
Described single-degree-of-freedom acceleration transducer is arranged on the center of driving lever 4, distance driving lever turning cylinder 5 axle center 180mm;
Described first Three Degree Of Freedom acceleration transducer 11-1 is arranged on the center of moving platform 8, and the second Three Degree Of Freedom acceleration transducer 11-2 is arranged on the position of y-axis positive direction distance moving platform 8 center 40mm.
Described Three Degree Of Freedom acceleration transducer and single-degree-of-freedom acceleration transducer, be piezoelectric type electric charge output type acceleration transducer;
The above-mentioned control method suppressing parallel connection platform vibration control system based on acceleration transducer, is characterized in that comprising the steps:
Step one: Dspace semi-physical simulation control card transmits control signal to servo driver drives three-phase alternating-current servo motor 1, drives decelerator 2 to rotate, by driving lever 4 with by lever 6, moving platform 8 is moved according to desired trajectory;
Step 2: the incremental encoder that three-phase alternating-current servo motor 1 end is installed detects the position of driving lever 4 in real time, signal is inputted Dspace semi-physical simulation control card by incremental encoder after servo-driver frequency division, by physical location and desired locations poor, deviation signal produces control signal through position-force control algorithm, control signal exports to servo-driver through the D/AC interface of Dspace semi-physical simulation control card, three-phase alternating-current servo motor 1 is driven to move, make the motion accompanying desired trajectory of driving lever 4, and then make moving platform 8 by expectation orbiting motion;
Step 3: in motion process or point location time, the acceleration of driving lever 4 and moving platform 8 is tested respectively by single-degree-of-freedom acceleration transducer and Three Degree Of Freedom acceleration transducer, the Vibration Condition of acceleration information reflection driving lever 4 and moving platform 8, self-excited vibration when three-phase alternating-current servo motor 1 is suppressed vibration in motion process or point location as brake, realize moving platform 8 in motion process or point location time high accuracy.
Tested the acceleration of driving lever 4 and moving platform 8 described in step 3 respectively by single-degree-of-freedom acceleration transducer and Three Degree Of Freedom acceleration transducer, testing process is as follows:
Two translatory acceleration values of moving platform 8
with an angle of rotation accekeration
obtained by following formulae discovery:
The the first Three Degree Of Freedom acceleration transducer 11-1 being arranged on moving platform 8 center records x directional acceleration a
x1with y directional acceleration a
y1, the second Three Degree Of Freedom acceleration transducer 11-2 records x directional acceleration a
x2with y directional acceleration a
y2, the rotating angular acceleration of moving platform central spot is
The utility model, relative to prior art, has following advantage and effect:
The utility model adopts 2 Three Degree Of Freedom acceleration transducers to be arranged on moving platform, and can calculate 2, moving platform center translational degree of freedom and 1 rotational freedom directional acceleration, mechanism is simple, quality is light, volume is little, and do not affect the characteristic of parallel connection platform, cost is low.The utility model can detect the acceleration of 3-RRR parallel connection platform driving lever and moving platform, in conjunction with the active joint angles that incremental encoder is measured, can derive the physical location of 3-RRR parallel connection platform driving lever and moving platform, speed, acceleration.The position of the utility model employing incremental encoder and acceleration transducer detection 3-RRR parallel connection platform driving lever and moving platform, speed, acceleration, these signals through resolving as control signal to servo-driver, can suppress self-excited vibration when vibration in motion process or point location.
Self-excited vibration signal when the utility model utilizes acceleration transducer to detect vibration signal in parallel connection platform motion process or point location, have certainty of measurement high, sample frequency is high, the advantage that dynamic response is fast;
Detection system based on acceleration transducer of the present utility model adopt piezoelectric type electric charge output type acceleration transducer can within the scope of high bandwidth measuring vibrations information, can accurate analysis vibratory output;
In sum, control system based on the vibration of acceleration transducer measurement device suppression parallel connection platform of the present utility model and method adopt two Three Degree Of Freedom acceleration transducers to be arranged on moving platform, two, moving platform center translational degree of freedom and a rotational freedom directional acceleration can be calculated, single-degree-of-freedom acceleration transducer is adopted to measure driving lever acceleration, incremental encoder measures main diarthrodial position, these signals can calculate the physical location of 3-RRR parallel connection platform driving lever and moving platform, speed, acceleration, and then quantitative analysis parallel connection platform Singularity and near location time self-excited vibration, analyze non-linear factor as the gap of decelerator and friction, the elastic deformation of rod member, the gaps in joint etc. are on the impact of parallel connection platform dynamics, the mechanism of further analysis self-excited vibration, the driving lever vibration information suppressing the control system of parallel connection platform vibration and method to be measured by single-degree-of-freedom acceleration transducer based on acceleration transducer measurement device of the present utility model applies control signal through control algolithm to three-phase alternating-current servo motor, can suppress in parallel connection platform motion process or the vibration of point location, according to the moving platform vibration information that Three Degree Of Freedom acceleration transducer is measured, can Vibration Condition be analyzed, evaluate the control effects suppressing vibration.
Accompanying drawing explanation
Fig. 1 is that the utility model suppresses the general structure schematic diagram of parallel connection platform vibration control system based on acceleration transducer;
Fig. 2 is the front view of Fig. 1;
Fig. 3 is the top view of Fig. 1;
Fig. 4 is acceleration transducer scheme of installation;
Fig. 5 is 2 Three Degree Of Freedom acceleration transducer scheme of installations on Fig. 1 moving platform; First Three Degree Of Freedom acceleration transducer is arranged on the center of moving platform, and the second Three Degree Of Freedom acceleration transducer is arranged on the y-axis direction of moving platform, linearly distributes.
Fig. 6 is the single-degree-of-freedom acceleration transducer scheme of installation on Fig. 1 driving lever;
Fig. 7 suppresses parallel connection platform vibration control process blocks figure based on incremental encoder measurement device; Using the signal of incremental encoder after anti-phase and filtering as control signal to servo-driver, can self-excited vibration be suppressed.
Fig. 8 suppresses parallel connection platform vibration control process blocks figure based on acceleration transducer measurement device; Dotted line frame is control algolithm part, after reality test joint space and the position of working space, speed, acceleration, self-excited vibration when vibration when can suppress parallel connection platform motion according to the thinking design con-trol algorithm of robot dynamics's control method or point location.
Detailed description of the invention
Below in conjunction with specific embodiment, the utility model is more specifically described in detail.
Embodiment
As shown in Fig. 1 to 8, parallel connection platform controls to be control joint space track desirably orbiting motion, and then makes working space track desirably orbiting motion.Under the position control mode of three-phase alternating-current servo motor, by the I/O mouth output pulse signal of Dspace semi-physical simulation control card, pulse speed corresponding speed, number of pulses correspondence position, each pulse at least needs two sampling periods to complete, sampling period and electronics gear ratio determine speed and the precision of driving lever (initiatively joint), and then determine speed and the precision of moving platform, servo-driver completes the control algolithm of three rings (electric current loop, speed ring, position ring), and the output torque of three-phase alternating-current servo motor is calculated by servo-driver and exports, under the Torque Control pattern of three-phase alternating-current servo motor, Dspace semi-physical simulation control card exports analog voltage signal by D/AC port, this signal is converted to the output torque of three-phase alternating-current servo motor by servo-driver, motor position signal is fed back to servo-driver by incremental encoder, servo-driver feeds back to Dspace semi-physical simulation control card and completes position-force control after position signalling is carried out scaling down processing, servo-driver enters current loop control portion after receiving the Torque Control voltage signal of Dspace semi-physical simulation control card output, generate the driving moment be directly proportional to control voltage signal, direct relation is not had in the speed of Torque Control pattern down-sampling cycle and driving joint and precision.
Based on incremental encoder measure portion: incremental encoder is measured three-phase alternating-current servo motor position signalling and fed back to servo-driver, servo-driver feeds back to Dspace semi-physical simulation control card and completes position-force control after position signalling is carried out scaling down processing, servo-driver enters current loop control portion after receiving the analog voltage signal of Dspace semi-physical simulation control card, exporting the moment be directly proportional to analog voltage signal drives three-phase alternating-current servo motor to move, and makes joint by expectation orbiting motion;
Based on acceleration transducer measure portion: the charge signal that acceleration transducer (Three Degree Of Freedom acceleration transducer and single-degree-of-freedom acceleration transducer) gathers is converted into analog voltage signal through charge amplifier, analog voltage signal is converted into data signal through A/DC, data signal calculates brake signal to servo-driver through control algolithm, suppresses the vibration of parallel connection platform;
Utilize acceleration transducer to measure parallel connection platform vibration information, compact structure, quality is light, and volume is little, does not change parallel connection platform structure feature, and have wider measuring frequency bandwidth, precision is high, and sample frequency is high, and dynamic response is fast.
The dimensional parameters of driving lever 4 is: 245mm × 25mm × 10mm; By the dimensional parameters of lever 6 be: 242mm × 25mm × 10mm, all construction materials are aluminium alloy, and component surface carries out oxidation processes, can insulate.Fixed platform is made up of square steel plate, steel frame construction and marble, and mounted motor is convenient, and vibration isolating effect is good.Every bar side chain have one initiatively joint (driving lever turning cylinder 3) and two by joint (by lever turning cylinder 5,7), joint is cradle head, the material that turning cylinder is connected with bearing is No. 45 steel.
Three-phase alternating-current servo motor 1 adopts the three-phase alternating-current servo motor of An Chuan Electric Machine Co., Ltd model SGMAV-10ADA61, rated power 1000W, nominal torque 3.18N.m, incremental encoder precision 20, angular resolution 360 °/2
20=0.000343 °, operating voltage 200V;
The matching used servo-driver model SGDV-120A of three-phase alternating-current servo motor 1, maximum applicable capacity 1500W, operating voltage 200V;
Decelerator 2 adopts the decelerator of Guangdong Xinbao Electric Co., Ltd. model VRS-075B-5-K3-19DC19, speed reducing ratio 1:5;
The sensor of Yangzhou Ingram gram observation and control technology Co., Ltd model 222A50 selected by single-degree-of-freedom acceleration transducer 10, sensitivity 50pC/g, measuring frequency scope 0.5Hz ~ 6kHz, range ± 1000g; The sensor of Yangzhou Ingram gram observation and control technology Co., Ltd model 243A10 selected by Three Degree Of Freedom acceleration transducer 11, sensitivity 10pC/g, measuring frequency scope 1Hz ~ 6kHz, range ± 200g;
Charge amplifier adopts Jiangsu Lianneng Electronic Technology Co., Ltd.'s model to be the equipment of YE5850, and the analog voltage that the quantity of electric charge of input can be converted to into geometric ratio relation exports, and lower frequency limit is extremely low, and maximum input charge amount is 10
6pC, output voltage range is-10V ~+10V;
The DS1103 semi-physical simulation control card of Dspace company of Germany, with Matlab/Simulink seamless link, utilizes the modeling pattern of Simulink to build Controlling model; There is provided 16,36 tunnel A/DC interface, input analog voltage scope-10V ~+10V, 8 16, tunnel D/AC interfaces, export analog voltage range-10V ~+10V, be furnished with 32 digital I/O mouths, incremental encoder signal fetch interface is provided;
The industrial computer of Yanhua Co., Ltd selected by computer, and Dspace semi-physical simulation control card is arranged on the inside by isa bus slot.
As mentioned above, just the utility model can be realized preferably.
Embodiment of the present utility model is not restricted to the described embodiments; other are any do not deviate from Spirit Essence of the present utility model and principle under do change, modification, substitute, combine, simplify; all should be the substitute mode of equivalence, be included within protection domain of the present utility model.
Claims (3)
1. one kind is suppressed parallel connection platform vibration control system based on acceleration transducer, it is characterized in that comprising three parallel branch mechanisms, each parallel branch mechanism comprises a three-phase alternating-current servo motor (1), decelerator (2), a driving lever (4), a follower lever (6);
The three-phase alternating-current servo motor (1) of each parallel branch mechanism is arranged on inside three installing holes of fixed platform respectively, installing hole becomes equilateral triangle to distribute, three-phase alternating-current servo motor (1) connection reducer (2), the axle of decelerator (2) installs decelerator turning cylinder (3), decelerator turning cylinder (3) connects one end of driving lever (4), the other end of driving lever (4) connects one end of follower lever (6) by driving lever turning cylinder (5), the other end of follower lever (6) is by follower lever turning cylinder (7), connect moving platform (8), moving platform (8) is in equilateral triangle,
The three-phase alternating-current servo motor (1) of three parallel branch mechanisms, combines and drives driving lever (4), drives follower lever (6) to make moving platform (8) desirably orbiting motion by driving lever (4);
Incremental encoder is installed in the end of three-phase alternating-current servo motor (1), connects the code device signal interface of Dspace semi-physical simulation control card, for detecting three-phase alternating-current servo motor (1) physical location;
Moving platform (8) is provided with support (9), the upper linear distributing Three Degree Of Freedom acceleration transducer of installation two of support (9), namely, first Three Degree Of Freedom acceleration transducer (11-1) and the second Three Degree Of Freedom acceleration transducer (11-2), for detecting two translational degree of freedom and a rotational freedom directional acceleration of moving platform (8); (4) install single-degree-of-freedom acceleration transducer respectively with driving lever, namely, first single-degree-of-freedom acceleration transducer (10-1), the second single-degree-of-freedom acceleration transducer (10-2) and the 3rd single-degree-of-freedom acceleration transducer (10-3), for detecting driving lever (4) rotational freedom directional acceleration;
Described Three Degree Of Freedom acceleration transducer is connected by cable with the input of charge amplifier with the output of single-degree-of-freedom acceleration transducer, and charge amplifier output connects the A/DC interface of Dspace semi-physical simulation control card; Three-phase alternating-current servo motor (1) is connected by the I/O interface of servo-driver with Dspace semi-physical simulation control card.
2. according to claim 1 based on acceleration transducer suppression parallel connection platform vibration control system, it is characterized in that: described single-degree-of-freedom acceleration transducer is arranged on the center of driving lever (4), distance driving lever turning cylinder (5) axle center 180mm;
Described first Three Degree Of Freedom acceleration transducer (11-1) is arranged on the center of moving platform (8), and the second Three Degree Of Freedom acceleration transducer (11-2) is arranged on the position of y-axis positive direction distance moving platform (8) center 40mm.
3. according to claim 1 based on acceleration transducer suppression parallel connection platform vibration control system, it is characterized in that: described Three Degree Of Freedom acceleration transducer and single-degree-of-freedom acceleration transducer, be piezoelectric type electric charge output type acceleration transducer.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201520810994.3U CN205058056U (en) | 2015-10-19 | 2015-10-19 | Restrain parallelly connected platform vibration control system based on acceleration sensor |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201520810994.3U CN205058056U (en) | 2015-10-19 | 2015-10-19 | Restrain parallelly connected platform vibration control system based on acceleration sensor |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN205058056U true CN205058056U (en) | 2016-03-02 |
Family
ID=55384657
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201520810994.3U Expired - Fee Related CN205058056U (en) | 2015-10-19 | 2015-10-19 | Restrain parallelly connected platform vibration control system based on acceleration sensor |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN205058056U (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105252539A (en) * | 2015-10-19 | 2016-01-20 | 华南理工大学 | Control system and method for inhibiting vibration of parallel-connection platform based on acceleration sensor |
-
2015
- 2015-10-19 CN CN201520810994.3U patent/CN205058056U/en not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105252539A (en) * | 2015-10-19 | 2016-01-20 | 华南理工大学 | Control system and method for inhibiting vibration of parallel-connection platform based on acceleration sensor |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105252539A (en) | Control system and method for inhibiting vibration of parallel-connection platform based on acceleration sensor | |
| CN1146765C (en) | Position controller | |
| CN2809621Y (en) | Intelligent detection system for bevel gear transmission quality | |
| CN100335877C (en) | Torque test air support rotating platform for control torque gyro | |
| CN107081787B (en) | Kinetic characteristic detection method based on industrial robot built-in sensors signal | |
| CN102778895B (en) | Method for accurate positioning control system under overweight environment | |
| CN106426089B (en) | Flexible three-freedom parallel institution vibration detection control device and control method | |
| CN104075890A (en) | Comprehensive servo motor and harmonic speed reducer testing platform | |
| CN203981405U (en) | A kind of servomotor and harmonic wave speed reducing machine comprehensive test platform | |
| CN202974629U (en) | Precise spring leaf performance tester | |
| CN210154618U (en) | Three-dimensional electric suspension multi-physical field parameter testing system | |
| CN103901789B (en) | Vibration output force following control device and control method thereof | |
| CN111365200A (en) | Flatness detection method for tower flange of wind generating set | |
| CN106483318A (en) | A kind of proximity switch tachymeter | |
| CN105806403A (en) | Stepping motor performance test device | |
| CN102192999A (en) | Probe-based automatic airflow pressure and velocity measurement device | |
| CN106644514A (en) | Planetary vehicle single-wheel rack device capable of continuously adjusting load | |
| CN205058056U (en) | Restrain parallelly connected platform vibration control system based on acceleration sensor | |
| CN105425148A (en) | Integrated testing stand for linear motors | |
| CN110095288A (en) | A kind of robot speed reducer comprehensive performance off-line test experimental rig and test method | |
| CN102072796B (en) | Solar battery array dynamic-measurement system | |
| CN201499120U (en) | Motor rotation speed wireless checking control device | |
| CN104458116A (en) | Triangular wave force generator and force detection system feature test method thereof | |
| CN109696286A (en) | A kind of high-speed electric main shaft dynamically load vibration measurement device | |
| CN205384042U (en) | Encoder reliability test device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160302 Termination date: 20181019 |