Three-axis parallel rotating mechanism for automatic charging and control method of three-axis parallel rotating mechanism

Through the design of the three-axis parallel rotating mechanism and the parallel drive branch, the existing automatic rotating mechanism has solved the problems of many parts, large errors and small load-bearing capacity, and achieved efficient and safe electric vehicle charging, with low cost and high accuracy Advantages of degree and high stiffness.

CN118876751APending Publication Date: 2024-11-01GUOCHUANG INNOVATION CENTER OF MOBILE ENERGY (JIANGSU) CO.,LTD.
View PDF 0 Cites 3 Cited by

Patent Information

Application Number
CN202411118263.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-15
Publication Date
2024-11-01

AI Technical Summary

Technical Problem

The existing automatic rotation mechanism has problems such as large number of parts, complexity, high cost, large error, small load-bearing capacity, large structural volume and low stiffness, making it difficult to achieve efficient and safe charging of electric vehicles.

Method used

The three-axis parallel rotation mechanism is adopted to realize the rotation adjustment of the electrical connection parts through three parallel drive branches. The hinge structure of the swing rod and the connecting rod is used to reduce the type of parts and structural complexity, improve the error accuracy and load-bearing capacity, and increase the Stiffness.

Benefits of technology

It realizes an automatic charging mechanism with low cost, small error, large load-bearing capacity, small structural volume and large stiffness, improving the accuracy and safety of the charging process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118876751A_ABST
    Figure CN118876751A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of automobile charging, in particular to a three-axis parallel rotating mechanism for automatic charging, which comprises a connecting seat and three parallel driving branches, an electric connecting piece is fixedly arranged on the connecting seat, three connecting holes are distributed in the periphery of the connecting seat, each parallel driving branch comprises a swing rod and a connecting rod, and the swing rod is connected with the connecting rod. The first connecting end of each swing rod is connected with a rotating shaft in a rotating mode, each rotating shaft is driven by a fixedly-arranged driving device to rotate, the second connecting ends of the swing rods are hinged to the first connecting ends of the connecting rods in a one-to-one correspondence mode, and the second connecting ends of the connecting rods are hinged to the connecting holes in a one-to-one correspondence mode. The rotating axes of all the rotating shafts in the three parallel driving branches and the hinged axes of the two connecting ends on all the connecting rods intersect at the same space point. According to the three-axis parallel rotating mechanism, rotating adjustment of the electric connecting piece is achieved through the three parallel driving branches, and the three-axis parallel rotating mechanism has the advantages of being low in cost, small in error, large in bearing capacity, small in structural size, large in rigidity and the like.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of automobile charging, and in particular to a three-axis parallel rotating mechanism for automatic charging and a control method thereof. Background Art

[0002] With the improvement of global environmental awareness and the development of renewable energy technology, electric vehicles (EVs), as a clean and efficient means of transportation, are gradually replacing traditional internal combustion engine vehicles and becoming the main choice for future travel.

[0003] The traditional charging method for electric vehicles is manual charging, where users need to hold a charging gun and connect it to the vehicle charging port, which causes connection difficulties and increased safety risks. In response, automatic charging of electric vehicles is becoming more and more popular, that is, the charging gun is inserted into the vehicle charging port through an automatic charging device, which is easy to operate and has low safety risks. However, due to the different spatial positions and postures of the charging ports of different vehicles, this brings difficulties to the docking of automatic charging devices. Automatic charging devices need to have an automatic rotation function to drive the gun head to rotate to adapt to vehicle charging ports with different angles and postures.

[0004] At present, the automatic rotation of the gun head is often achieved by using a series joint method, such as multi-axis joint robotic arms such as Jieka and Aobo, or some automatic charging companies have also developed a rotating platform in series to achieve the steering of the gun head. These series rotation mechanisms have the following disadvantages: 1. The number of parts of the series rotation joint / platform is large, the parts are complex, and the processing cost is high, making it difficult to popularize; 2. The errors between the series rotation joints / platforms have a cumulative effect, and the total transmission error is large; 3. Each joint / platform of the series rotation joint / platform must bear the force of the gun head and all the mechanisms between the gun head and the joint / platform, resulting in a small load-bearing capacity of the mechanism; 4. In order to enhance its load-bearing capacity, the size needs to be further increased, resulting in a large structural volume; 5. The transmission path of the series rotation joint / platform is long and the stiffness is poor. Summary of the invention

[0005] In order to solve the technical problems of the automatic rotating mechanism in the prior art, such as the large number of parts, complexity, high cost, large error, small load-bearing capacity, large structural volume and low rigidity, the present invention proposes a three-axis parallel rotating mechanism for automatic charging, which realizes the rotation adjustment of the electrical connector through three parallel drive branches, and has the advantages of low cost, small error, large load-bearing capacity, small structural volume and high rigidity.

[0006] The technical solution of the present invention:

[0007] A three-axis parallel rotation mechanism for automatic charging, comprising:

[0008] A connection base, on which an electrical connector is fixed, and three connection holes are arranged on the periphery of the connection base;

[0009] Three parallel drive branches, each of which includes a swing rod and a connecting rod, the first connecting end of each swing rod is respectively connected to a rotating shaft, each rotating shaft is respectively driven to rotate by a fixed driving device, the second connecting end of each swing rod is hinged to the first connecting end of each connecting rod one by one, and the second connecting end of each connecting rod is hinged to each connecting hole one by one;

[0010] In each parallel drive branch, the rotation axis of the rotating shaft and the articulation axes of the two connecting ends on the connecting rod are not collinear; the rotation axes of all the rotating shafts and the articulation axes of the two connecting ends on all the connecting rods in the three parallel drive branches intersect at the same spatial point.

[0011] Furthermore, the electrical connection piece is a charging gun or a charging stand.

[0012] Furthermore, the three connection holes are arranged circumferentially; and the three parallel drive branches are also arranged circumferentially in an initial state.

[0013] Furthermore, a mounting opening for mounting the electrical connector is formed on the connection base; three lugs are arranged on the periphery of the connection base, and one of the connection holes is arranged on each lug.

[0014] Furthermore, each driving device drives the corresponding rotating shaft to rotate directly or through a transmission mechanism.

[0015] Furthermore, the three-axis parallel rotation mechanism may be further added with one or more parallel auxiliary branches, each of which includes an auxiliary swing rod and an auxiliary connecting rod, the first connecting end of each auxiliary swing rod is connected to an auxiliary rotating shaft, each auxiliary rotating shaft is rotatably connected to a fixed seat, the second connecting end of each auxiliary swing rod is hinged to the first connecting end of each auxiliary connecting rod in a one-to-one correspondence, the outer periphery of the connecting seat is further correspondingly arranged with one or more auxiliary connecting holes, and the second connecting end of each auxiliary connecting rod is hinged to each auxiliary connecting hole in a one-to-one correspondence;

[0016] In each parallel auxiliary branch, the rotation axis of the auxiliary rotating shaft and the hinge axis of the two connecting ends on the auxiliary connecting rod are not colinear; the rotation axes of all rotating shafts and the hinge axes of the two connecting ends on all connecting rods in the three parallel driving branches, as well as the rotation axes of all auxiliary rotating shafts and the hinge axes of the two connecting ends on all auxiliary connecting rods in each parallel auxiliary branch intersect at the same spatial point.

[0017] Another aspect of the present invention provides a control method for a three-axis parallel rotation mechanism for automatic charging as described in any one of the above, comprising the following steps:

[0018] Obtaining a desired position of the electrical connector;

[0019] Calculate the angles that each drive device needs to rotate according to the desired posture;

[0020] The driving devices are controlled to rotate according to the calculated angle.

[0021] Further, the step of calculating the angles that each driving device needs to rotate according to the desired posture specifically includes:

[0022] Establish an electrical connector coordinate system Cxyz, establish a fixed platform coordinate system Gxyz, and establish a homogeneous transformation matrix between the electrical connector coordinate system Cxyz and the fixed platform coordinate system Gxyz according to the initial position and expected position of the electrical connector G C;

[0023] The spatial point is recorded as point O, and a virtual sphere is established with point O as the center of the sphere; the intersection point of the rotation axis of the rotating shaft in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point An, the intersection point of the hinge axis of the first connecting end of the connecting rod in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point Bn, the intersection point of the hinge axis of the second connecting end of the connecting rod in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point Cn, and points An, Bn and Cn constitute a spherical triangle in the initial state; the intersection point of the hinge axis of the first connecting end of the connecting rod in the nth parallel drive branch after rotation and the spherical surface of the virtual sphere is set as point B′n, the intersection point of the hinge axis of the second connecting end of the connecting rod in the nth parallel drive branch after rotation and the spherical surface of the virtual sphere is set as point C′n, and points An, B′n and C′n constitute a spherical triangle after rotation;

[0024] Determine the coordinates of points An, Bn and Cn in the electrical connector coordinate system Cxyz in the initial state, according to the homogeneous transformation matrix in the initial state G C calculates the coordinates of points An, Bn and Cn in the fixed platform coordinate system Gxyz, and calculates the spherical angle ∠BnAnCn; determines the coordinates of point C′n in the rotated electrical connector coordinate system Cxyz, according to the homogeneous transformation matrix after rotation G C′ calculates the coordinates of point C′n in the fixed platform coordinate system Gxyz, and calculates the spherical angle ∠C′nAnCn; calculates the spherical angle ∠C′nAnB′n according to the side lengths AnB′n, B′nC′n, and C′nAn;

[0025] If the three vector mixed product Then the angle that the nth drive device needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn-∠C′nAnCn); if the three-vector mixed product Then the angle that the n-th driving device needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn+∠C′nAnCn). The angle n is 1, 2, 3, and the solution is performed in sequence.

[0026] Another aspect of the present invention provides a three-axis parallel rotation mechanism for automatic charging, comprising:

[0027] A connection base, on which an electrical connector is fixed, and the outer periphery of the connection base is arranged with three or more connection holes;

[0028] Three or more parallel branches, each of the parallel branches includes a swing rod and a connecting rod, the first connecting end of each swing rod is respectively connected to a rotating shaft, each rotating shaft is provided with a torsion spring, when each swing rod rotates around the rotating shaft, the corresponding torsion spring is deformed by force, the second connecting end of each swing rod is hinged to the first connecting end of each connecting rod one by one, and the second connecting end of each connecting rod is hinged to each connecting hole one by one; the number of parallel branches corresponds to the setting of the connecting holes;

[0029] In each parallel branch, the rotation axis of the rotating shaft and the hinge axes of the two connecting ends on the connecting rod are not collinear; the rotation axes of all rotating shafts and the hinge axes of the two connecting ends on all connecting rods in three or more parallel branches intersect at the same spatial point.

[0030] Furthermore, the electrical connector is a charging gun or a charging stand.

[0031] After adopting the above technical solution, the three-axis parallel rotation mechanism for automatic charging and the control method thereof provided by the present invention have the following beneficial effects compared with the prior art:

[0032] A three-axis parallel rotation mechanism provided by the present invention is compared with the serial rotation joint / platform in the prior art: three parallel drive branches are used for parallel drive, each parallel drive branch only includes a drive device, a rocker rod and a connecting rod, each parallel drive branch has a small number of parts, a small number of parts, a simple part structure and a low processing cost; and the errors of the three parallel drive branches can be averaged at the position of the electrical connector, so that the movement is more precise compared with the serial mechanism; in addition, the three parallel drive branches jointly share the force of the electrical connector, each parallel drive branch is subjected to uniform and small force, the force of the entire mechanism is more reasonable, and the bearing capacity of the entire mechanism is greater; in addition, due to the strong bearing capacity, the overall size can be made smaller; and the movement path is short and the rigidity is greater. BRIEF DESCRIPTION OF THE DRAWINGS

[0033] Figure 1 It is a schematic diagram of the overall structure of the three-axis parallel rotation mechanism of Example 1;

[0034] Figure 2It is an exploded view of the three-axis parallel rotating mechanism of the first embodiment;

[0035] Figure 3 is a schematic structural diagram of a driving device of Embodiment 1;

[0036] Figure 4 Schematic diagram of the structure of the swing rod of the first embodiment;

[0037] Figure 5 is a schematic structural diagram of a connecting rod of Embodiment 1;

[0038] Figure 6 This is a schematic structural diagram of the connecting socket of the first embodiment;

[0039] Figure 7 for Figure 1 A magnified view of a single parallel drive branch in FIG.

[0040] Figure 8 This is a schematic diagram of the positions of points An, Bn, and Cn in Example 2;

[0041] Fig. 9 Schematic diagram of the spherical triangle of the three-axis parallel rotation mechanism in Example 2 before and after rotation in four situations;

[0042] Fig.10 It is a structural schematic diagram of the parallel rotating mechanism of Example 4.

[0043] in,

[0044] Connecting seat 1, connecting hole 11, lug 12, mounting opening 13; electrical connector 2; rocker arm 3, first drive hole 31, second drive hole 32; connecting rod 4, first hinge hole 41, second hinge hole 42; rotating shaft 5, driving device 6; torsion spring 7; supporting plate 8. DETAILED DESCRIPTION

[0045] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, rather than all the embodiments. The following description of at least one exemplary embodiment is actually only illustrative and is by no means intended to limit the present invention and its application or use. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0046] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present application. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprise" and / or "include" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.

[0047] In addition, it should be noted that the use of terms such as "first" and "second" to limit components is only for the convenience of distinguishing the corresponding components. If not otherwise stated, the above terms have no special meaning and therefore cannot be understood as limiting the scope of protection of the present invention.

[0048] Embodiment 1:

[0049] like Figure 1-7 As shown, this embodiment provides a three-axis parallel rotation mechanism for automatic charging, which includes a connecting base 1 and three parallel drive branches, wherein an electrical connector 2 is fixedly provided on the connecting base 1, and the electrical connector 2 can be fixedly installed on the connecting base 1, or directly form an integrated structure with the connecting base 1; the electrical connector 2 can be a charging gun or a charging base; and three connecting holes 11 are also arranged on the periphery of the connecting base 1.

[0050] Furthermore, in the three parallel drive branches, each parallel drive branch includes a rocker arm 3 and a connecting rod 4. The first connecting end of each rocker arm 3 is respectively connected to a rotating shaft 5. Each rotating shaft 5 is respectively driven to rotate by a driving device 6. These driving devices 6 are all fixed on a base plate and fixed relative to the base plate. The base plate can be fixed to the ground-end mobile mechanism / vehicle end. The second connecting end of each rocker arm 3 is hinged to the first connecting end of each connecting rod 4 one by one, and the second connecting end of each connecting rod 4 is hinged to each connecting hole 11 one by one. Specifically, in each parallel drive branch, the first connection end and the second connection end of the swing rod 3 are located at both ends of the swing rod 3, and the first connection end of the swing rod 3 is formed as a first drive hole 31, which is fitted with the rotating shaft 5 of the driving device 6 by interference fit or assembled by pins and keys, so that the swing rod 3 can be driven to rotate when the rotating shaft 5 rotates, and the swing rod 3 is formed as a drive rod, and the second connection end of the swing rod 3 is formed as a second drive hole 32; the first connection end and the second connection end of the connecting rod 4 are located at both ends of the connecting rod 4, and the first connection end of the connecting rod 4 is formed as a first hinge hole 41, which is coaxially rotatably connected with the second connection end of the swing rod 3 through a hinge shaft; the second connection end of the connecting rod 4 is formed as a second hinge hole 42, which is coaxially rotatably connected with the connection hole 11 on the connecting seat 1 through a hinge shaft. In other embodiments, the first connection end and the second connection end of the swing rod 3 may not be set at both ends, for example, they are set close to the middle and have a suitable spacing; similarly, the first connection end and the second connection end of the connecting rod 4 may not be set at both ends, for example, they are set close to the middle and have a suitable spacing.

[0051] Each of the rotating shafts 5 has a rotation axis, and both ends of each of the connecting rods 4 have an articulation axis. In each parallel drive branch, the rotation axis of the rotating shaft 5 and the articulation axes at both ends of the connecting rod 4 are not colinear; and the rotation axes of all the rotating shafts 5 and the articulation axes at both ends of all the connecting rods 4 in the three parallel drive branches intersect at the same spatial point, that is, they are all common point axes. Specifically, each connection hole 11 on the connecting seat 1 is tilted, and each swing rod 3 and the connecting rod 4 also has multiple bends or arcs, so that the rotation axis of each rotating shaft 5 and the articulation axes at both ends of each connecting rod 4 intersect at the same spatial point. When each driving device 6 rotates, the corresponding connecting rod 4 is driven to rotate through the swing rod 3. The three connecting rods 4 cooperate to ensure the stability of the electrical connector 2, and can realize the three-axis pure rotation Rx, Ry, Rz of the electrical connector 2 around the spatial point as the center, thereby realizing the angle adjustment of the electrical connector 2 within a certain range.

[0052] Among them, on the premise of meeting the above requirements, the shape, size and arrangement of the rotation axis of the rocker arm 3 of different parallel drive branches can be different; the shape, size and arrangement of the articulation axis of the connecting rod 4 of different parallel drive branches can also be different; the driving devices 6 of different parallel drive branches can also be different.

[0053] When the electrical connector 2 is a charging gun, the mechanism can be set on a mobile mechanism on the ground side, and after adjusting the angle according to the charging seat of the target vehicle, it can be driven by the mobile mechanism to dock; when the electrical connector 2 is a charging seat, the mechanism can be set on the vehicle to adjust the spatial three-dimensional angle of the charging seat on the vehicle side, so as to adapt to the automatic charging equipment on the ground side that can only translate but not rotate the charging gun.

[0054] Thus, the three-axis parallel rotation mechanism provided in this embodiment is compared with the serial rotation joint / platform in the prior art: three parallel drive branches are used for parallel drive, each parallel drive branch only includes a drive device 6, a rocker rod 3 and a connecting rod 4, each parallel drive branch has a small number of parts, a simple part structure, and a low processing cost; and, the errors of the three parallel drive branches can be averaged at the position of the electrical connector 2, so that the movement is more precise compared with the serial mechanism; in addition, the three parallel drive branches jointly share the force of the electrical connector 2, each parallel drive branch is subjected to uniform and small force, the force of the entire mechanism is more reasonable, and the bearing capacity of the entire mechanism is greater; in addition, due to the strong bearing capacity, the overall size can be made smaller; and the movement path is short, and the rigidity is also greater.

[0055] Preferably, in this embodiment, the rotation axes of all the rotating shafts 5 and the hinge axes at both ends of all the connecting rods 4 are inclined toward the middle of the same side of the connecting seat 1, for example, they are all set toward the middle electrical connector 2, which can better realize the rotation of the electrical connector 2.

[0056] In this embodiment, three connection holes 11 are arranged circumferentially, preferably in a circular array, and are evenly arranged on the outer periphery of the connection seat 1; three parallel drive branches are also arranged circumferentially in the initial state, preferably in a circular array, that is, in the initial state, the drive devices 6 in the three parallel drive branches are the same and evenly distributed, the swing rods 3 are the same and evenly distributed, and the connecting rods 4 are the same and evenly distributed. The parts in the three parallel drive branches are the same, which can further reduce the types of parts and reduce the machining cost. In addition, such an evenly distributed arrangement is more conducive to the rotation control of the electrical connector 2. In other embodiments, in order to make the movement of the mechanism more flexible, the structure and position of each drive device 6, the shape, size and position of each swing rod 3, and the length, size and position of each connecting rod 4 can be set as needed.

[0057] like Figure 6 As shown, in this embodiment, a mounting opening 13 for mounting an electrical connector 2 is formed in the middle of the connecting base 1, which can be adapted to a variety of electrical connectors 2; three lugs 12 are provided on the periphery of the connecting base 1, and each lug 12 is provided with a connecting hole 11, thereby simplifying the structure of the connecting base 1.

[0058] The driving device 6 can be selected from but not limited to a motor, a pneumatic device or a hydraulic power device; and the driving device 6 can directly drive the rotating shaft 5 to rotate, or for the purpose of convenient assembly, protecting the driving device 6, etc., it can also drive the rotating shaft 5 to rotate through a transmission mechanism such as belt drive, gear drive, chain drive, worm gear drive, etc.

[0059] From the above content, it can be seen that the three-axis parallel rotation mechanism for automatic charging provided in this embodiment realizes the rotation adjustment of electrical connectors such as charging guns through three parallel drive branches, and has the advantages of low cost, small error, large load-bearing capacity, small structural volume and high rigidity.

[0060] Embodiment 2:

[0061] like Figure 8-9 As shown, this embodiment provides a control method for the three-axis parallel rotation mechanism for automatic charging as described in Embodiment 1, the method comprising the following steps:

[0062] S1: Obtaining the desired position of the electrical connector 2;

[0063] The initial posture of the electrical connector 2 is determined by the initial state, so the initial posture of the electrical connector 2 can be known; and the desired posture of the electrical connector 2 is determined according to the angle of the charging seat of the specific vehicle, so it is necessary to first obtain the angle of the charging seat of the specific vehicle. Specifically, the angle of the charging seat on the vehicle can be known by identifying the type of vehicle, and then the rotation of the electrical connector 2 can be controlled according to the angle. Alternatively, the angle of the charging seat of the vehicle can also be detected by industrial camera image detection and other methods, which is a prior art and will not be described in detail here.

[0064] S2: Calculate the angles that each driving device 6 needs to rotate according to the desired posture;

[0065] First, establish the electrical connector coordinate system Cxyz and the fixed platform coordinate system Gxyz. The fixed platform coordinate system Gxyz can be the fixed base coordinate system of the ground-end mobile mechanism. In the initial state, the electrical connector 2 is in the initial position, and the electrical connector coordinate system Cxyz has not rotated. The homogeneous transformation matrix between the electrical connector coordinate system Cxyz and the fixed platform coordinate system Gxyz in the initial state can be obtained according to the initial position. G C; Preferably, the directions of the coordinate axes of the electrical connector coordinate system Cxyz and the fixed platform coordinate system Gxyz in the initial state can be set to be consistent, and their origin is preferably the same spatial point mentioned above. After the rotation, the electrical connector 2 is in the desired posture, and the electrical connector coordinate system Cxyz also rotates, and each coordinate axis rotates through a certain angle. The homogeneous transformation matrix between the electrical connector coordinate system Cxyz and the fixed platform coordinate system Gxyz after the rotation can be obtained according to the desired posture. G C;

[0066] Specifically, the relative position relationship between a spatial coordinate system and another coordinate system can be obtained through the homogeneous transformation matrix. The homogeneous transformation matrix is ​​a 4×4 matrix, in which the column vectors represent the three direction vectors of the coordinate axis in a coordinate system and the representation of the coordinate origin in the relative coordinate system. For example, the homogeneous transformation matrix G C=[ G C x G C y G C z G C p ] is the representation of the electrical connector coordinate system Cxyz in the fixed platform coordinate system Gxyz, where G C x G C y G C z G C p They respectively represent the vector representation of the three coordinate axes xyz in the electrical connector coordinate system Cxyz in the fixed platform coordinate system Gxyz, and the representation of the coordinate system origin P in the electrical connector coordinate system Cxyz in the fixed platform coordinate system Gxyz.

[0067] In order to realize the conversion of a point in space between different spatial coordinate systems, it can be realized in the form of vector and matrix multiplication. For example, the coordinates of a point A in the electrical connector coordinate system Cxyz are known to be expressed as C A=( C x A , C y A , C z A ,1) T , then the point A is expressed in the fixed platform coordinate system Gxyz as G A= G C C A; On the contrary, if we know the coordinate position of point A in the fixed platform coordinate system Gxyz G A=( G x A , G y A , G z A ,1) T , then the point A is expressed in the electrical connector coordinate system Cxyz as C A= G C -1G A.

[0068] Furthermore, the spatial point where the rotation axis of each rotating shaft 5 and the hinge axis at both ends of each connecting rod 4 intersect is recorded as point O, and a virtual sphere with a radius R is established with point O as the center of the sphere; the intersection point of the rotation axis of the rotating shaft 5 in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point An, the intersection point of the hinge axis of the first connection end of the connecting rod 4 in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point Bn, and the intersection point of the connecting rod 4 in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point Bn. The intersection of the hinge axis of the second connection end of the rod 4 and the virtual spherical surface is set as point Cn, and points An, Bn and Cn form a spherical triangle in the initial state; the intersection of the hinge axis of the first connection end of the connecting rod 4 in the nth parallel drive branch after rotation and the virtual spherical surface is set as point B'n, and the intersection of the hinge axis of the second connection end of the connecting rod 4 in the nth parallel drive branch after rotation and the virtual spherical surface is set as point C'n, and points An, B'n and C'n form a spherical triangle after rotation. Among them, since the rotation axis corresponding to point An is fixed, the actual position of point An does not change before and after the rotation.

[0069] According to the initial posture, the coordinates of points An, Bn and Cn in the electrical connector coordinate system Cxyz in the initial state can be determined. According to the homogeneous transformation matrix between the electrical connector coordinate system Cxyz in the initial state and the fixed platform coordinate system Gxyz G C can calculate the coordinates of points An, Bn and Cn in the fixed platform coordinate system Gxyz. The lengths of the three sides of the spherical triangle △AnBnCn can also be determined according to the initial state, so that the spherical angle ∠BnAnCn can be calculated;

[0070] Since point Cn rotates with the electrical connector coordinate system Cxyz, the coordinates of point Cn in the electrical connector coordinate system Cxyz in the initial state are the same as the coordinates of point C′n in the electrical connector coordinate system Cxyz after rotation. After determining the coordinates of point C′n in the electrical connector coordinate system Cxyz after rotation, the homogeneous transformation matrix between the electrical connector coordinate system Cxyz after rotation and the fixed platform coordinate system Gxyz is used. G C calculates the coordinates of point C'n in the fixed platform coordinate system Gxyz; the coordinates of points C'n, Cn, and An in the fixed platform coordinate system Gxyz are known, and the lengths of the three sides of the spherical triangle △CnAnC'n can be calculated, and thus the spherical angle ∠C'nAnCn can be calculated;

[0071] From the rigid body motion, we know that the side length of the spherical triangle corresponding to the pendulum 3 and the connecting rod 4 is unchanged, that is, AnBn=AnB′n, BnCn=B′nC′n. The spherical angle ∠C′nAnB′n is calculated according to the side lengths AnB′n, B′nC′n, and C′nAn.

[0072] According to the spherical angles ∠C′nAnB′n, ∠BnAnCn and ∠C′nAnCn, the spherical angle ∠BnAnB′n can be calculated. Specifically, if the three-vector mixed product Then the angle that the n-th driving device 6 needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn-∠C′nAnCn), where the positive and negative values ​​represent the direction of rotation and the absolute value represents the size of the rotation angle. Then the angle that the n-th driving device 6 needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn+∠C′nAnCn), where the positive and negative values ​​represent the rotation direction, and the absolute value represents the rotation angle.

[0073] Specifically, Fig. 9 As shown, it can be divided into the following cases: In the first case, the three-vector mixed product The angle that the n-th driving device 6 needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn-∠C′nAnCn), which is a positive number, and the n-th driving device 6 rotates forward; in the second case, the three-vector mixed product The angle that the n-th driving device 6 needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn+∠C′nAnCn), which is a positive number, and the n-th driving device 6 rotates forward; in the third case, the three-vector mixed product The angle that the n-th driving device 6 needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn-∠C′nAnCn), which is a negative number, and the n-th driving device 6 is reversed; in the fourth case, the three-vector mixed product The angle that the n-th driving device 6 needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn+∠C′nAnCn), which is a negative number, and the n-th driving device 6 is reversed. , ∠BnAnB′n=0, and the nth driving device 6 does not rotate.

[0074] S3: Control each driving device 6 to rotate according to the calculated angle.

[0075] According to the calculated angles of rotation required by the driving devices 6 in each parallel driving branch, each driving device 6 is controlled to rotate so that the electrical connector 2 rotates to the final desired position. Then, the ground-side mobile mechanism can be driven to dock with the vehicle-mounted charging base. This is a prior art and will not be described in detail here.

[0076] From the above content, it can be seen that the control method of a three-axis parallel rotation mechanism for automatic charging provided in this embodiment can calculate the rotation angle of the driving device in each parallel driving branch, thereby controlling each driving device to rotate so that the electrical connector moves to the desired position.

[0077] Embodiment three:

[0078] This embodiment adds one or more parallel auxiliary branches on the basis of the first embodiment. The structure and axis arrangement of each parallel auxiliary branch are similar to the parallel driving branch. The difference is that no driving device is provided to drive the rotation of the shaft, but the auxiliary shaft is directly connected to a fixed fixed seat for rotation, thereby increasing the force distribution and enhancing the rigidity of the entire mechanism.

[0079] Specifically, the three-axis parallel rotation mechanism of this embodiment, on the basis of the three parallel drive branches described in Example 1, is further provided with one or more parallel auxiliary branches. The parallel auxiliary branches can be arranged between two parallel drive branches, that is, three parallel drive branches + one or more parallel auxiliary branches are adopted. Each of the parallel auxiliary branches includes an auxiliary rocker arm and an auxiliary connecting rod. The first connecting end of each auxiliary rocker arm is connected to an auxiliary rotating shaft. Each auxiliary rotating shaft is rotatably connected to a fixed seat through bearings and other parts. The fixed seat can be formed on the aforementioned fixed base plate. The second connecting end of each auxiliary rocker arm is hinged to the first connecting end of each auxiliary connecting rod in a one-to-one manner. One or more auxiliary connecting holes are also arranged correspondingly on the outer periphery of the connecting seat 1. The auxiliary connecting holes are arranged circumferentially at intervals with reference to the aforementioned connecting holes, and the second connecting end of each auxiliary connecting rod is hinged to each auxiliary connecting hole in a one-to-one manner. In each parallel auxiliary branch, the rotation axis of the auxiliary rotating shaft and the hinge axis of the two connecting ends on the auxiliary connecting rod are not colinear; the rotation axes of all rotating shafts 5 and the hinge axes of the two connecting ends on all connecting rods 4 in the three parallel driving branches, as well as the rotation axes of all auxiliary rotating shafts and the hinge axes of the two connecting ends on all auxiliary connecting rods in each parallel auxiliary branch intersect at the same spatial point.

[0080] That is to say, this embodiment adds one or more parallel auxiliary branches on the basis of three parallel drive branches, and the auxiliary swing rod, auxiliary connecting rod and auxiliary shaft in the parallel auxiliary branch can be set with reference to the swing rod 3, connecting rod 4 and shaft 5 in the parallel drive branch, except that the auxiliary shaft in this embodiment is not driven by the driving device, but rotates passively and freely. In this way, the bearing capacity and rigidity of the whole mechanism are greater.

[0081] Embodiment 4:

[0082] like Fig.10As shown, this embodiment provides a three-axis parallel rotation mechanism for automatic charging. Compared with the first embodiment, the difference is that in this embodiment, a driving device 6 is not used to drive each shaft 5 to rotate, but a torsion spring 7 is provided at the shaft 5 to achieve passive angle adaptation.

[0083] Specifically, the three-axis parallel rotation mechanism of this embodiment also includes a connecting base 1 and three parallel branches. An electrical connector 2 is fixedly provided on the connecting base 1. The electrical connector 2 can be a charging gun or a charging base. Three connecting holes 11 are arranged on the periphery of the connecting base 1.

[0084] In the three parallel branches, each parallel branch includes a swing rod 3 and a connecting rod 4. The first connecting end of each swing rod 3 is respectively connected to a rotating shaft 5. A torsion spring 7 is provided at each rotating shaft 5. When each swing rod 3 rotates around the rotating shaft 5, the corresponding torsion spring 7 is deformed by force. Specifically, one end of the rotating shaft 5 is fixedly connected to the first connecting end of the swing rod 3, and the other end of the rotating shaft 5 is rotatably connected to the support plate 8. Alternatively, one end of the rotating shaft 5 is rotatably connected to the first connecting end of the swing rod 3, and the other end of the rotating shaft 5 is fixedly or rotatably connected to the support plate 8, that is, the swing rod 3 can only rotate relative to the support plate 8. The support plate 8 can be fixed to the ground end mobile mechanism / vehicle end. The two ends of the torsion spring 7 are respectively against or fixed on the swing rod 3 and the support plate 8. When the swing rod 3 rotates, the torsion spring 7 is deformed by force. Further, the second connecting end of each swing rod 3 is hinged to the first connecting end of each connecting rod 4 one by one, and the second connecting end of each connecting rod 4 is hinged to each connecting hole 11 one by one.

[0085] In each parallel branch, the rotation axis of the rotating shaft 5 and the hinge axis of the two connecting ends of the connecting rod 4 are not collinear; the rotation axes of all the rotating shafts 5 and the hinge axes of the two connecting ends of all the connecting rods 4 in the three parallel branches intersect at the same spatial point. When the electrical connector 2 is subjected to force, each connecting rod 4 rotates and drives each swing rod 3 to rotate, and each torsion spring 7 is subjected to force and deformation to achieve adaptive adjustment, and the torsion of the torsion spring 7 can also ensure the stability of the electrical connector 2 to a certain extent.

[0086] Wherein, under the premise of meeting the above requirements, the shapes, sizes and arrangements of the rotation axes of the rocker arms 3 of different parallel branches may be different; the shapes and arrangements of the articulation axes of the connecting rods 4 of different parallel branches may also be different.

[0087] When the electrical connector 2 is a charging gun, the mechanism can be set on a mobile mechanism on the ground side, and driven by the mobile mechanism to dock. During the docking process, the angle deviation of the vehicle charging seat can be passively met; when the electrical connector 2 is a charging seat, the mechanism can be set on the vehicle to adapt to the automatic charging equipment on the ground side that can only translate but not rotate the charging gun, and passively adjust the angle of the vehicle-side charging seat during docking.

[0088] It should be noted that the number of the parallel branches can be more than three, such as four, five or more, and the structure of the added parallel branches refers to the above settings; in addition, the number of connecting holes 11 also needs to be set to multiple accordingly.

[0089] From the above content, it can be seen that the three-axis parallel rotation mechanism for automatic charging provided in this embodiment can passively meet the angle deviation during automatic charging docking, and has the characteristics of low cost, large load-bearing capacity, and small structural volume.

[0090] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can make equivalent replacements or changes according to the technical scheme and inventive concept of the present invention within the technical scope disclosed by the present invention, which should be covered by the protection scope of the present invention.

Claims

1. A three-axis parallel rotating mechanism for automatic charging, characterized in that: include: A connecting seat (1), on which an electrical connector (2) is fixedly provided, and three connecting holes (11) are arranged on the outer periphery of the connecting seat (1); Three parallel drive branches, each of the parallel drive branches comprises a swing rod (3) and a connecting rod (4), the first connecting end of each swing rod (3) is respectively connected to a rotating shaft (5), each rotating shaft (5) is respectively driven to rotate by a fixed driving device (6), the second connecting end of each swing rod (3) is hinged to the first connecting end of each connecting rod (4) in a one-to-one correspondence, and the second connecting end of each connecting rod (4) is hinged to each connecting hole (11) in a one-to-one correspondence; In each parallel drive branch, the rotation axis of the rotating shaft (5) and the articulation axis of the two connecting ends on the connecting rod (4) are not colinear; the rotation axes of all the rotating shafts (5) and the articulation axes of the two connecting ends on all the connecting rods (4) in the three parallel drive branches intersect at the same spatial point.

2. The three-axis parallel rotation mechanism according to claim 1, characterized in that: The electrical connector (2) is a charging gun or a charging base.

3. The three-axis parallel rotation mechanism according to claim 1, characterized in that: The three connection holes (11) are arranged circumferentially; the three parallel drive branches are also arranged circumferentially in an initial state.

4. The three-axis parallel rotation mechanism according to claim 1, characterized in that: The connection seat (1) is formed with a mounting opening (13) for mounting the electrical connector (2); the outer periphery of the connection seat (1) is provided with three lugs (12), and each lug (12) is provided with one of the connection holes (11).

5. The three-axis parallel rotation mechanism according to claim 1, characterized in that: Each driving device (6) drives the corresponding rotating shaft (5) to rotate directly or through a transmission mechanism.

6. The three-axis parallel rotation mechanism according to claim 1, characterized in that: The three-axis parallel rotation mechanism may also be supplemented with one or more parallel auxiliary branches, each of which includes an auxiliary swing rod and an auxiliary connecting rod, the first connecting end of each auxiliary swing rod is connected to an auxiliary rotating shaft, each auxiliary rotating shaft is rotatably connected to a fixed seat, the second connecting end of each auxiliary swing rod is hinged to the first connecting end of each auxiliary connecting rod in a one-to-one correspondence, the outer periphery of the connecting seat (1) is also correspondingly arranged with one or more auxiliary connecting holes, and the second connecting end of each auxiliary connecting rod is hinged to each auxiliary connecting hole in a one-to-one correspondence; In each parallel auxiliary branch, the rotation axis of the auxiliary shaft and the hinge axes of the two connecting ends on the auxiliary connecting rod are not collinear; The rotation axes of all rotating shafts (5) in the three parallel drive branches and the hinge axes of the two connecting ends on all connecting rods (4), as well as the rotation axes of all auxiliary rotating shafts in each parallel auxiliary branch and the hinge axes of the two connecting ends on all auxiliary connecting rods intersect at the same spatial point.

7. A control method for a three-axis parallel rotating mechanism for automatic charging as claimed in any one of claims 1 to 6, characterized in that: The following steps are involved: Obtaining a desired position and posture of the electrical connector (2); Calculating the angles that each driving device (6) needs to rotate according to the desired posture; The rotation of each driving device (6) is controlled according to the calculated angle.

8. The control method of the three-axis parallel rotation mechanism according to claim 7, characterized in that: in, Calculating the angles that each driving device (6) needs to rotate according to the desired posture specifically includes: Establish an electrical connector coordinate system Cxyz, establish a fixed platform coordinate system Gxyz, and establish a homogeneous transformation matrix between the electrical connector coordinate system Cxyz and the fixed platform coordinate system Gxyz according to the initial position and expected position of the electrical connector (2). G C; The spatial point is recorded as point O, and a virtual sphere is established with point O as the center of the sphere; the intersection point of the rotation axis of the rotating shaft (5) in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point An, the intersection point of the hinge axis of the first connecting end of the connecting rod (4) in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point Bn, the intersection point of the hinge axis of the second connecting end of the connecting rod (4) in the nth parallel drive branch in the initial state and the spherical surface of the virtual sphere is set as point Cn, and points An, Bn and Cn constitute a spherical triangle in the initial state; the intersection point of the hinge axis of the first connecting end of the connecting rod (4) in the nth parallel drive branch after rotation and the spherical surface of the virtual sphere is set as point B′n, the intersection point of the hinge axis of the second connecting end of the connecting rod (4) in the nth parallel drive branch after rotation and the spherical surface of the virtual sphere is set as point C′n, and points An, B′n and C′n constitute a spherical triangle after rotation; Determine the coordinates of points An, Bn and Cn in the electrical connector coordinate system Cxyz in the initial state, according to the homogeneous transformation matrix in the initial state G C calculates the coordinates of points An, Bn and Cn in the fixed platform coordinate system Gxyz, and calculates the spherical angle ∠BnAnCn; determines the coordinates of point C′n in the rotated electrical connector coordinate system Cxyz, according to the homogeneous transformation matrix after rotation G C calculates the coordinates of point C'n in the fixed platform coordinate system Gxyz, and calculates the spherical angle ∠C'nAnCn; calculates the spherical angle ∠C'nAnB'n according to the side lengths AnB'n, B'nC'n, and C'nAn; If the three vector mixed product Then the angle that the n-th driving device (6) needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn-∠C′nAnCn); if the three-vector mixed product Then the angle that the n-th driving device (6) needs to rotate is ∠BnAnB′n=∠C′nAnB′n-(∠BnAnCn+∠C′nAnCn).

9. A three-axis parallel rotation mechanism for automatic charging, characterized in that: include: A connection base (1), on which an electrical connection piece (2) is fixedly provided, and the outer periphery of the connection base (1) is provided with three or more connection holes (11); Three or more parallel branches, each of the parallel branches comprises a swing rod (3) and a connecting rod (4), the first connecting end of each swing rod (3) is respectively connected to a rotating shaft (5), each rotating shaft (5) is provided with a torsion spring (7), when each swing rod (3) rotates around the rotating shaft (5), the corresponding torsion spring (7) is deformed by force, the second connecting end of each swing rod (3) is hinged to the first connecting end of each connecting rod (4) in a one-to-one correspondence, and the second connecting end of each connecting rod (4) is hinged to each connecting hole (11) in a one-to-one correspondence; In each parallel branch, the rotation axis of the rotating shaft (5) and the hinge axes of the two connecting ends on the connecting rod (4) are not collinear; the rotation axes of all the rotating shafts (5) and the hinge axes of the two connecting ends on all the connecting rods (4) in three or more parallel branches intersect at the same spatial point.

10. The three-axis parallel rotation mechanism according to claim 9, characterized in that: The electrical connector (2) is a charging gun or a charging base.

Citation Information

Cited By

  • Plug-in device, plug-in system with a plug-in device, as well as robot with a plug-in device

    US12580346B2

  • Plug-in device, plug-in system with a plug-in device, as well as robot with a plug-in device

    US20240055800A1

  • Three-axis parallel rotating mechanism for automatic charging and control method therefor

    WO2026037149A1