Detailed description of the invention
Below in conjunction with brief description of the drawings, utility model is described further.
As shown in Figure 1, the utility model is made up of six servomotors (1), (2), (3), (4), (5) and (6) and steering wheel (7) thereof, spring structure unit (9), (10) and (11), driving rope (8), confinement ring (12), elastic film (13) and drive case (14).
As shown in Figure 2, the flexible film of each spring overcoat (13), inside arranges two driving ropes (8), on driving cross section, middle part (19), driving rope is tied up on mooring points (21), upper in driving cross section, end (20), driving rope is tied up on mooring points (22).
In the flexible mechanical arm configuration being formed by three springs, get it and drive cross section, as shown in Figure 3.After three springs fit tightly, on same circumference, arrange and drive rope mooring points, wherein, at the upper mooring points I (23) that arranges of spring I (24), at the upper mooring points II (26) that arranges of spring II (25), at spring III (27) upper layout mooring points III (28), and 120Du azimuth, adjacent mooring points interval is evenly distributed on same circumference.
The flexible arm that spring structure unit based on being close to by three forms, drive on cross section at it, draw with three mooring points of circle spacings 120 degree distributions, 3 driving ropes in end and driving cross section, middle part can be by the combination of different power, make mechanical arm to any direction bending, can realize 2 frees degree.Because each driving is relatively independent, the free degree in two cross sections can superpose, and like this, mechanical arm has just had 4 frees degree, and can reach arbitrarily in space position has " S type " deformability.
The construction unit of three spring designs being adopted to the method design fitting tightly, is mainly based on following basic understanding.
As Fig. 4, in identical flexible body angle of bend one timing of A, B two character, two flexible body spacing are larger, complete the amount of contraction that the required flexible body of bending of requirement produces larger, and the telescopic traction power providing is also larger.In A and B1, A and B2, A and tri-flexible body combinations of B3, in order to make the bending specific angle of A flexible link, needed amount of contraction: B1 < B2 < B3.Obviously, the advantage in bending property of being combined in of A and B1 is more obvious.
Above-mentioned conclusion is applied in the mechanical arm of construction unit composition of three spring designs, also expects that it approaches as much as possible.So, select the wrapping of three flexible body fixed points.In order to ensure that mechanical arm has certain rigidity, can not chosen axis to the very good spring of retractility, must stretch and just can realize remarkable bending by a small amount of.In flexible mechanical arm structural design, it is very necessary that the application of above-mentioned conclusion seems.
Servo motor driving system is as follows with being connected of flexible mechanical arm.
Six servomotors and steering wheel thereof and driving rope form drive system, article six, drive rope one end to tie up to respectively on the different driving cross section of different spring structures unit, the other end ties up to respectively on the steering wheel of different servo motor, carry out folding and unfolding rope by the rotation of driven by motor steering wheel, and then control contraction and the bending of mechanical arm.In the drive system being formed by servomotor, turn over specific angle by computer control servomotor, drive around the folding and unfolding of the driving rope on steering wheel.Drive the connected mode of rope as follows:
--steering wheel---drives rope---mooring points---spring II middle part to drive cross section to servomotor (1);
---steering wheel---drives rope---mooring points---spring I middle part to drive cross section to servomotor (2);
---steering wheel---drives rope---mooring points---spring III middle part to drive cross section to servomotor (3);
---steering wheel---drives driving cross section, rope---mooring points---spring III end to servomotor (4);
---steering wheel---drives driving cross section, rope---mooring points---spring I end to servomotor (5);
---steering wheel---drives driving cross section, rope---mooring points---spring II end to servomotor (6).
Control system internal communication and as follows with the connection procedure of drive system: being first power supply mode, the alternating current of 220V being transformed to the direct current of 5V by dc source, is servomotor power supply by 32 road helm control circuit plates; With helm control circuit plate power supply in Gei32 road between the laminated cell of 9V.32 road helm control circuit plates provide 32 tunnels relatively independent rudder control interface, when mechanical arm performance test, servomotor I-VI are connected on respectively on 1-6 interface; Then be communication and control mode, on circuit board, have bluetooth receiver module, can directly receive by the control information out of computer Bluetooth transmission.Bluetooth transmission module is inserted on computer USB interface, move on computers bluetooth software Bluesoleil He32 road steering wheel control software simultaneously, set up radio communication by the bluetooth receiver module on bluetooth discovery and circuit board, then set up the connection of 32 road steering wheel control softwares and Bluesoeil, so just set up the radio communication between the helm control circuit plate of steering wheel control software He32 road, Liao32 road, motion that can the each road of controlled in wireless servomotor.
Embodiment 1
This enforcement is that the planar 360 degree based on driving cross section, middle part rotatablely moves and axial shrinkage motion.Participate in driving except controlling middle part the servomotor (4), (5) and (6) in cross section of this enforcement, flexible mechanical arm agent structure system and control system thereof in addition.
The implementation process of planar 360 degree rotation: first drive servomotor (2) rotation, driving rope shrinks, and makes spring I drive flexible mechanical arm to realize base portion 90 bendings of spending between cross section (18) and driving cross section, middle part (19) are installed; Then drive servomotor (1), make flexible mechanical brachiocylloosis orientation to the residing orientation rotation of spring II, when two driving rope (8) amounts of contraction are when identical, the residing orientation of flexible mechanical arm is the middle orientation of spring I and spring II; Then drive servomotor (2) to rotate backward, discharge and drive rope to original state, flexible mechanical brachiocylloosis orientation is continued to the residing orientation rotation of spring II to identical with its orientation of living in; Then drive servomotor (3), driving rope shrinks, make flexible mechanical brachiocylloosis orientation to the residing orientation rotation of spring III, when two driving rope amounts of contraction are when identical, the residing orientation of flexible mechanical arm is the middle orientation of spring II and spring III; Then drive servomotor (1) to rotate backward, discharge and drive rope to original state, flexible mechanical brachiocylloosis orientation is continued to the residing orientation rotation of spring III to identical with its orientation of living in; Then drive servomotor (2), drive rope to shrink, make flexible mechanical brachiocylloosis orientation to the residing orientation rotation of spring I, when two driving rope amounts of contraction are when identical, the residing orientation of flexible mechanical arm is the middle orientation of spring I and spring III; Then drive servomotor III to rotate backward, discharge and drive rope to original state, flexible mechanical brachiocylloosis orientation is continued to the residing orientation rotation of spring I to identical with its orientation of living in; Finally drive servomotor (2) to rotate backward, discharge and drive rope to original state, make flexible mechanical arm return to free straightened condition.
The implementation process of axial shrinkage: first simultaneously control servomotor (1), (2), (3) directional-rotation, three drive rope (8) with the same amount of identical speed contraction phase, can realize flexible mechanical arm lengths and reduce; Then control servomotor (1), (2), (3) reverse rotation, discharge respective drive rope to original state, make flexible mechanical arm recover former length.
The implementation process of planar 360 degree rotation is the motion of two frees degree, has verified the two degree-of-freedom motion ability under three driven by servomotor.The implementation process of axial shrinkage is the motion of one degree of freedom.
Embodiment 2
What this enforcement realized is flexible mechanical arm, in " S type " deformability that can reach arbitrarily in space, needs all devices to participate in realizing.
The approach that realizes of " S type " distortion has two: the one, and 2 drivings of middle part Cross section Design, end cross-sectional design single-point drives; The 2nd, middle part Cross section Design single-point drives, 2 drivings of end cross-sectional design.
The implementation process of the first approach is as follows:
First drive servomotor (2) to rotate, drive rope to shrink, make spring I drive flexible mechanical arm to realize the bending of 90 degree between base portion installation cross section and driving cross section, middle part; Then drive servomotor (4) and (6) to rotate simultaneously, two drive rope (8) with the same amount of identical speed contraction phase, make spring II and spring III drive flexible mechanical arm to realize middle part simultaneously and drive 90 bendings of spending between cross section (19) and driving cross section, end (20), form " S type " distortion; Finally drive servomotor (2), (4) and (6) to rotate backward, three drive ropes (8) to return to former length with identical speed, make the flexible mechanical arm straightened condition that affranchises simultaneously.
The implementation process of the second approach is as follows:
First drive servomotor (1) and (2) to rotate simultaneously, respective drive rope (8) shrinks, and makes spring II and I drive flexible mechanical arm to realize the bending of 90 degree between base portion installed surface (18) and driving cross section, middle part (19); Then drive servomotor (4) to rotate, drive rope (8) to shrink, make spring III drive flexible mechanical arm realization middle part to drive the bending of 90 degree between cross section and driving cross section, end, form " S type " and be out of shape; Finally drive servomotor (1), (2) and (4) to rotate backward, three drive ropes (8) to return to former length with identical speed, make the flexible mechanical arm straightened condition that affranchises simultaneously.
In two kinds of implementation processes twice 90 degree are bending in same plane, and bending opposite direction, the driving cross section, end (20) under " S type " deformation state with its at mechanical arm the cross-wise direction under free straightened condition parallel.This enforcement is four-degree-of-freedom process, has verified the four-degree-of-freedom locomitivity of flexible mechanical arm under six driven by servomotor.