Design method of oblique large displacement small hole double planetary frame film-covered sweet potato transplanter
By designing a double planetary coated sweet potato transplanter with oblique large displacement hole mouth, the six-position 3R chain rod model and dual-objective optimization algorithm are used to solve the size of the existing sweet potato transplanter in oblique large displacement hole. The different problems have maximized the fit between the hole and the trajectory, ensuring the efficiency of sweet potato transplantation and the stability of the film.
Patent Information
- Application Number
- CN202211564431.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-12-07
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2042-12-07
AI Technical Summary
It is difficult to achieve the hole mouth under the conditions of oblique large displacement in existing sweet potato transplanters, and the hole mouth sizes vary when the position is optimized, resulting in the problem of easy film damage.
A double planetary rack-type coated sweet potato transplanter with oblique large displacement hole mouth was designed. By constructing a mechanism including the first planetary wheel system and the second planetary wheel system, it is based on a mathematical model of a six-position 3R open chain rod. , combined with the dual-objective optimization algorithm, optimize the transplanting trajectory and hole size to achieve minimization of holes and maximize trajectory fit.
The holes of the sweet potato transplanter are minimized under the conditions of oblique large displacement, ensuring the maximum fit between the transplanting trajectory and the pre-designed trajectory, avoiding film damage, and meeting the needs of sweet potato transplanting.
Smart Images

Figure CN115812398B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of mechanical technology, relates to a transplanter, and specifically relates to a design method of an oblique large-displacement small-hole double-planetary frame type film-covered sweet potato transplanter. Background Art
[0002] Compared with straight, oblique and horizontal planting methods, the boat-bottom planting method has the highest overall yield. Covering the ridges with film can effectively maintain the moisture content and temperature of the soil, making the growth environment of sweet potatoes more suitable and increasing yield.
[0003] The existing sweet potato transplanter has the problem of large hole opening and easy damage to the film. Compared with the single planetary frame transplanter, the double planetary frame transplanter is easier to achieve more accurate postures. After completing the pre-design of the double planetary frame mechanism, there are still many combinations of the proposed optimization points and the first planetary frame rotation angles between the key postures of the burrowing section. Different combinations will result in different hole openings. Therefore, it is necessary to propose a design method for a sweet potato transplanter that can achieve the smallest hole opening under the conditions of large oblique displacement of sweet potato transplanting. Summary of the invention
[0004] The purpose of the invention is to address the deficiencies of the prior art and to propose a design method for an oblique large-displacement small-hole double-planetary frame film-covered sweet potato transplanter used in film-covered sweet potato transplanting.
[0005] In order to solve the above technical problems, the technical solution adopted by the present invention is:
[0006] The specific steps of the present invention are as follows:
[0007] Step 1, construct an oblique large displacement small hole double planetary frame film-covered sweet potato transplanting mechanism. The oblique large displacement small hole double planetary frame film-covered sweet potato transplanting mechanism includes a first planetary gear train, a second planetary gear train and a transplanting arm. The first planetary gear train includes a sun gear shaft, a first planetary frame, a sun gear, a first intermediate gear, a third intermediate gear, planetary gear two, a second intermediate gear and a planetary gear one. The sun gear shaft is fixedly connected to the first planetary frame and forms a rotating pair with the frame; the sun gear is fixedly connected to the frame and is loosely mounted on the sun gear shaft; the intermediate gear shaft and the planetary gear shaft both form a rotating pair with the first planetary frame; the intermediate gear shaft is fixedly connected to the first intermediate gear, the second intermediate gear and the third intermediate gear. The first intermediate gear is meshed with the sun gear, the second intermediate gear is meshed with the planetary gear one, and the third intermediate gear is meshed with the planetary gear two; the planetary gear one is loosely mounted on the planetary gear shaft, and the planetary gear two is fixedly connected to the planetary gear shaft. The second planetary gear system includes a second planetary carrier, a circular gear 1, a circular gear 2, a circular gear 3, a cable cam, a cam swing rod, a cable swing rod and a cable. The second planetary carrier is fixedly connected to the planetary gear 1 by teeth; the circular gear shaft 1 and the circular gear shaft 2 both form a rotating pair with the second planetary carrier; the circular gear 1 and the cable cam are both fixedly connected to one end of the planetary gear shaft that passes through the first planetary carrier and enters the second planetary carrier; the circular gear 2 is loosely sleeved on the circular gear shaft 1, and the circular gear 3 is fixedly connected to the circular gear shaft 2; the circular gear 2 is meshed with the circular gear 1 and the circular gear 3; the cam swing rod and the cable swing rod are both fixedly connected to the circular gear shaft 1, and the cam swing rod and the cable cam form a cam pair; one end of the cable is fixedly connected to the cable swing rod. The transplanting arm comprises a transplanting arm shell, a seedling clamping seat and a seedling clamping claw; the transplanting arm shell is three-way fixedly connected with the circular gear; the seedling clamping seat and the transplanting arm shell form a sliding pair, and are connected to the transplanting arm shell through a spring; the other end of the pull wire is fixedly connected to the seedling clamping seat; the tails of the two seedling clamping claws are both hinged to the transplanting arm shell, and the two seedling clamping claws pass through two clamping grooves opened in the seedling clamping seat.
[0008] Step 2: According to the transplanting trajectory requirements of sweet potatoes, determine the coordinates Pd of the six key points on the transplanting trajectory i ,i=1,2...6, attitude angle θ of the seedling clamp at each key point i , i = 1, 2...6 and the first planet carrier line attitude angle fjwz corresponding to each key point i , the attitude angle of the seedling clamp is the angle between the seedling clamp and the horizontal plane, and further determine the corresponding coordinates of the six key points on the static trajectory when the forward speed is 0. Among them, the six key points are the seedling clamp point, the entry point, the seedling clamp claw preparation opening point, the planting point, the unearthed point and the seedling clamp claw preparation closing point. Then, with the attitude angle of the first planetary frame corresponding to the first key point as a reference, the attitude angle of the first planetary frame corresponding to the second to sixth key points is obtained. i , i=2,3...6 The time elapsed accounts for the proportion of one rotation of the first planet carrier. From formula (1), we can deduce the point Pj corresponding to each key point on the static trajectory i, i=1,2...6 i=1,2...6.
[0009]
[0010] Step 3: Establish a mathematical model of the six-position 3R open-chain rod and obtain the solution curve of the 3R open-chain rod.
[0011] Step 4: Solve the parameter solution domain of the six-position 3R open-chain rod.
[0012] Step 5: Obtain the pre-designed sweet potato transplanting trajectory through interpolation, and take the solution with the smallest hole opening in the solution curve of the 3R open-chain rod as the optimal solution of the 3R open-chain rod.
[0013] Step 6: Use the optimal solution of the 3R open-chain rod, select the quasi-optimization control points on the sweet potato transplanting trajectory achieved by the optimal solution, set the coordinate adjustment boundary values of each quasi-optimization control point and the corresponding upper and lower limits of the first planetary frame rotation angle adjustment and record them in a matrix form.
[0014] Step seven, write the horizontal coordinate, vertical coordinate and the first planet carrier angle corresponding to each proposed optimization control point into a matrix form, set the horizontal coordinate and vertical coordinate changes of each proposed optimization control point and the corresponding first planet carrier angle change, and obtain the positive vector of coordinate change, the negative vector of coordinate change, the positive vector of angle change and the negative vector of angle change.
[0015] Step 8, setting the optimization goal and constraint conditions of the dual-objective optimization algorithm; wherein the optimization goal is to minimize the hole opening and maximize the fit between the transplanting trajectory and the pre-designed transplanting trajectory;
[0016] Constraint 1: The horizontal and vertical coordinates of each proposed optimization control point generated after the sth iteration should be within the adjustment boundary value set in step 6, and the first planet carrier rotation angle corresponding to each proposed optimization control point generated after the sth iteration should be within the upper and lower limits of the first planet carrier rotation angle adjustment set in step 6;
[0017] Constraint 2: The angular displacement of the first planet carrier, the angular displacement of the second planet carrier and the angular displacement of the transfer arm index line corresponding to the control point to be optimized meet the processing requirements of the non-circular gear tooth profile.
[0018] Step nine, use the dual-objective optimization algorithm to optimize the control points to be optimized, and obtain the solution of the final 3R open-chain rod and the corresponding angular displacement of the first planetary carrier, the angular displacement of the second planetary carrier relative to the first planetary carrier, and the angular displacement of the transplanting arm mark line relative to the second planetary carrier by solving the optimized control points. In addition, the transmission ratios of each pair of non-circular gears and the pitch curves of each non-circular gear that meet the requirements of non-circular gear tooth profile processing are obtained to complete the design of the sweet potato transplanter.
[0019] The present invention has the following beneficial effects:
[0020] In view of the problem that the conventional mechanism solving method cannot simultaneously meet the requirements of large oblique displacement and small hole opening of sweet potato transplanting by solving the dynamic trajectory of the mechanism when the mechanism parameters of the mechanism are completely determined, the present invention establishes a mathematical model of a six-pose 3R open-chain rod based on the mapping relationship between the static trajectory and the transplanting trajectory and based on the six poses on the transplanting trajectory (six key point coordinates and the posture angles of the seedling clamping claws at each key point), obtains the solution curve of the 3R open-chain rod that meets the requirements of the transplanting trajectory and the six poses, and takes a solution with the smallest hole opening in the solution curve of the 3R open-chain rod as the optimal solution of the 3R open-chain rod. However, at this time, only a preliminary screening is performed to obtain the mechanism solution, and the optimal solution does not include the parameters of the angular displacement of the first planetary frame, the angular displacement of the second planetary frame relative to the first planetary frame, and the angular displacement of the transplanting arm mark line relative to the second planetary frame. Then, the present invention takes the compliance with the boundary conditions of the quasi-optimization control points and the first planetary carrier angle and the processing requirements of the non-circular gear tooth profile as the restriction conditions, takes the maximum fit between the realized transplanting trajectory and the pre-designed transplanting trajectory located below the soil surface and the minimum hole opening as the optimization goal, selects the quasi-optimization control points on the sweet potato transplanting trajectory realized by the optimal solution of the 3R open-chain rod, and through the dual-objective optimization algorithm, optimizes and iterates the quasi-optimization control points with a given step size change and the first planetary carrier angle corresponding to each quasi-optimization control point, and obtains the optimal oblique large displacement small hole opening double planetary carrier covered sweet potato transplanter (including the first planetary carrier angular displacement, the angular displacement of the second planetary carrier relative to the first planetary carrier, and the angular displacement of the transplanting arm mark line relative to the second planetary carrier). The sweet potato transplanter perfectly meets the transplanting requirements. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] Figure 1 It is a schematic diagram of the mechanism of the sweet potato transplanting mechanism of the present invention.
[0022] Figure 2-1 It is a schematic diagram of the transplanting trajectory pre-designed in the embodiment of the present invention.
[0023] Figure 2-2 It is a schematic diagram of the static trajectory pre-designed in the embodiment of the present invention.
[0024] Figure 3 It is a mathematical model diagram of the 3R open chain rod in the present invention.
[0025] Figure 4 It is a global Burmester curve diagram formed by the solution set of the first hinge point and the second hinge point of the sweet potato transplanting mechanism in the present invention.
[0026] Figure 5 It is a global Burmester curve diagram formed by the solution set of the rotation center of the first planetary frame of the sweet potato transplanting mechanism in the present invention.
[0027] Figure 6It is a schematic diagram of the angular displacement of the second planet carrier relative to the first planet carrier and the angular displacement of the transplanting arm index line relative to the second planet carrier corresponding to a 3R open-chain lever solution in an embodiment of the present invention.
[0028] Figure 7 It is a schematic diagram of the lower transplanting trajectory and the hole formation corresponding to a 3R open-chain rod solution in an embodiment of the present invention.
[0029] Figure 8 It is a schematic diagram showing different combinations of the relationship between the transplanting trajectory and the angular displacement of the first planet carrier, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplanting arm mark line relative to the second planet carrier.
[0030] Fig. 9 It is a relationship diagram between the first planet carrier rotation angle and the transplanting depth corresponding to one set of control points to be optimized.
[0031] Fig.10 It is a schematic diagram of setting various proposed optimized control points and their set boundaries on the transplanting trajectory.
[0032] Fig.11 It is a schematic diagram of a 3R open-chain rod having two special-shaped positions when one set of quasi-optimization control points satisfies constraint condition 1.
[0033] Fig.12 It is a schematic diagram of the deepest point of transplanting horizontally and the point where transplanting enters the soil on the transplanting trajectory.
[0034] Fig.13 It is a schematic diagram of a membership function constructed by the present invention that describes the degree of fit between the transplanting trajectory to be optimized and the part of the pre-designed transplanting trajectory located below the soil surface.
[0035] Fig.14 It is a schematic diagram of a set of non-dominated optimal solutions of two optimization objective functions calculated and obtained by an embodiment of the present invention.
[0036] Fig.15 It is a schematic diagram of the angular displacement of the second planet carrier relative to the first planet carrier and the angular displacement of the transplanting arm mark line relative to the second planet carrier obtained after optimization of the present invention.
[0037] Figure 16-1 It is a schematic diagram of the static trajectory of the sweet potato transplanter obtained after optimization of the present invention;
[0038] Figure 16-2 yes Figure 16-1 A partial enlarged view of .
[0039] Fig.17 It is a schematic diagram of the transplanting trajectory of the sweet potato transplanter obtained after optimization of the present invention.
[0040] Fig.18 It is a transmission ratio curve diagram of each pair of non-circular gears obtained after optimization of the present invention.
[0041] Fig.19 It is a schematic diagram of each non-circular gear pitch curve obtained after optimization of the present invention. DETAILED DESCRIPTION
[0042] The present invention will be further described below in conjunction with the accompanying drawings and embodiments.
[0043] The design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter is as follows:
[0044] Step 1: Figure 1, construct an oblique large displacement small hole mouth double planetary frame film-covered sweet potato transplanting mechanism. The oblique large displacement small hole mouth double planetary frame film-covered sweet potato transplanting mechanism includes a first planetary gear train 01, a second planetary gear train 02 and a transplanting arm 03. The first planetary gear train 01 includes a sun gear shaft 0101, a first planetary carrier 0102, a sun gear 0103, a first intermediate gear 0104, a third intermediate gear 0105, a planetary gear two 0106, a second intermediate gear 0108 and a planetary gear one 0109. The sun gear shaft 0101 is fixedly connected to the first planetary carrier and forms a rotating pair with the frame; the sun gear 0103 is fixedly connected to the frame and is loosely sleeved on the sun gear shaft; the intermediate gear shaft 0107 and the planetary gear shaft 0110 both form a rotating pair with the first planetary carrier 0102; the intermediate gear shaft 0107 is fixedly connected to the first intermediate gear 0104, the second intermediate gear 0108 and the third intermediate gear 0105. The first intermediate wheel meshes with the sun wheel, the second intermediate wheel meshes with the planet wheel 1 0109, and the third intermediate wheel meshes with the planet wheel 2 0106; the planet wheel 1 0109 is loosely mounted on the planet wheel shaft 0110, and the planet wheel 2 0106 is fixedly connected to the planet wheel shaft. The second planetary gear train 02 includes a second planet carrier 0201, a circular gear 1 0202, a circular gear 2 0203, a circular gear 3 0204, a cable cam 0205, a cam swing rod 0207, a cable swing rod 0208, and a cable 0209. The second planetary carrier 0201 is fixedly connected to the planetary gear one 0109 by teeth; the circular gear shaft one 0206 and the circular gear shaft two 0210 both form a rotating pair with the second planetary carrier 0201; the circular gear one 0202 and the cable cam 0205 are both fixedly connected to one end of the planetary gear shaft passing through the outside of the first planetary carrier 0102 and entering the inside of the second planetary carrier 0201; the circular gear two 0203 is loosely mounted on the circular gear shaft one 0206, and the circular gear three 0204 is fixedly connected to the circular gear shaft two 0210; the circular gear two is meshed with the circular gear one and the circular gear three; the cam rocker 0207 and the cable rocker 0208 are both fixedly connected to the circular gear shaft one, and the cam rocker and the cable cam 0205 form a cam pair; one end of the cable 0209 is fixedly connected to the cable rocker. The transplanting arm 03 includes a transplanting arm housing 0301, a seedling clamping seat 0302 and a seedling clamping claw 0303; the transplanting arm housing 0301 is fixedly connected to the circular gear; the seedling clamping seat 0302 and the transplanting arm housing 0301 form a sliding pair, and are connected to the transplanting arm housing 0301 through a spring; the other end of the pull wire 0209 is fixedly connected to the seedling clamping seat 0302; the tails of the two seedling clamping claws 0303 are both hinged to the transplanting arm housing, and the two seedling clamping claws 0303 pass through the two clamping grooves opened in the seedling clamping seat 0302.
[0045] When the motor drives the sun gear shaft, the first planet carrier 0102 rotates around the sun gear, so that the first intermediate wheel transmits power to the second intermediate wheel and the third intermediate wheel through the intermediate wheel shaft, the second intermediate wheel drives planetary gear one, and planetary gear one drives the second planet carrier through tooth engagement; the third intermediate wheel drives planetary gear two, and planetary gear two transmits power to circular gear one and the cable cam through the planetary gear shaft; circular gear two meshes with circular gear one and circular gear three at the same time, so that circular gear three and circular gear one rotate in the same direction and at the same speed relative to the second planet carrier, and circular gear three then drives the transplanting arm through circular gear shaft two, and a transplanting trajectory is formed at the end of the transplanting arm. When the pull-wire cam rotates relative to the second planetary frame, it drives the cam swing rod. The cam swing rod and the pull-wire swing rod have the same rotation angle. When the pull-wire swing rod swings relative to the second planetary frame and moves away from the transplanting arm, it drives the pull wire. The pull wire drags the seedling clamping seat. The seedling clamping seat slides backward relative to the transplanting arm and compresses the spring, so that the two seedling clamping claws complete the closing action to clamp the seedlings. When the pull-wire swing rod swings relative to the second planetary frame and approaches the transplanting arm, the seedling clamping seat slides forward under the action of the spring restoring force, so that the two seedling clamping claws release the sweet potato seedlings.
[0046] Step 2: According to the transplanting trajectory requirements of sweet potatoes, determine the coordinates Pd of the six key points on the transplanting trajectory i ,i=1,2...6, attitude angle θ of the seedling clamp at each key point i , i=1,2...6 and the first planet carrier line corresponding to each key point (a virtual line with a fixed angle bsjjo with the first planet carrier. The introduction of the first planet carrier line is to solve the parameter solution domain of the six-position 3R open chain rod. If the first planet carrier line is not introduced, only a fixed parameter solution can be obtained) attitude angle fjwz i The attitude angle of the seedling clamping claw is the angle between the seedling clamping claw and the horizontal plane, and the corresponding coordinates of the six key points on the static trajectory when the forward speed is 0 are further determined.
[0047] like Figure 2-1 As shown, the front end of the seedling clamping claw forms a transplanting track ABCDEF; the seedling clamping claw clamps the sweet potato seedling from the supporting seedling delivery mechanism at point A, and the AB section is the seedling transport section; BCD is the soil entry section, point B is the soil entry point, and point D is the planting point. The seedling clamping claw remains closed throughout the ABC section, prepares to open at point C, and fully opens at the planting point D, completing the seedling planting action at D. When the seedling clamping claw moves on this section, the horizontal distance swept by the posture of the seedling clamping claw on the soil surface should be small; DE is the unearthed section, and the seedling clamping claw in this section should remain open throughout the whole process to prevent the seedling clamping claw from taking out the planted sweet potato seedlings. Similarly, the seedling clamping claw running on this section should also make the hole formed on the soil surface as small as possible. EFA section, this section is the seedling clamping section, the seedling clamping claw remains open throughout the DE section, prepares to close at point F, and fully closes at point A to achieve the clamping of sweet potato seedlings.
[0048] At point A, the seedling clamp claws clamp the seedlings. To ensure that the contact between the seedling clamp claws and the sweet potato seedlings is as large as possible, the attitude angle of the seedling clamp claws is about 90°. Considering that the triangular potato seedling conveyor belt should have a certain safety height from the ground during actual operation, the height of the planting point from the soil surface should be above 250mm, that is, the vertical height between point A and point B should be greater than 250mm. The planting spacing of potato seedlings is 200mm. The boat-bottom planting method requires that the root of the potato seedlings is about 50mm away from the soil surface and the horizontal distance from the entry point is about 125mm. Since the potato seedlings are relatively soft, the main reason for the formation of the film-breaking hole during planting is that the seedling clamp claws of the transplanting arm sweep through the various attitudes of the entry section BCDE. Five key points and the attitude angles of the seedling clamp claws at each key point are designed in the entry section, and two of the key points are made as close as possible to the entry point or the exit point. According to the above requirements, as shown in Table 1, six key points Pd are given. i ,i=1,2...6, the coordinates of the seedling clamp at each key point, and the attitude angle of the first planetary frame line corresponding to each key point fjwz i data:
[0049] Table 1
[0050] Key Points <![CDATA[Pd1]]> <![CDATA[Pd2]]> <![CDATA[Pd3]]> <![CDATA[Pd4]]> <![CDATA[Pd5]]> <![CDATA[Pd6]]> x coordinate / mm -263.99 -155.54 -65.59 -73.828 -123.44 -161.12 Y coordinate / mm 7.76 -284.00 -312.15 -326.70 -318.28 -298.06 The posture angle of the seedling clamp at each key point / (°) 90 156 164.2 153.7 137.2 127.2 First planet carrier line attitude angle / (°) 105.1 226.2 274.7 296.4 312.8 321.4
[0051] like Figure 2-2 As shown, when the first planetary frame rotates at a constant speed and the transplanting spacing is 200mm, during the rotation of the first planetary frame, the forward speed of the sweet potato transplanting mechanism driven by the mobile body should be v0 = -200mm / r. Taking the first planetary frame line attitude angle corresponding to the first key point as a reference, the first planetary frame line attitude angle fjwz corresponding to the second to sixth key points can be obtained i , i=2,3...6 The time elapsed accounts for the proportion of one rotation of the first planet carrier, and whether there is a forward speed, only the horizontal coordinates of the points on the transplanting trajectory and the static trajectory change, and the corresponding points Pj on the static trajectory and each key point can be deduced from formula (1) i , i=1,2...6 i=1,2...6.
[0052]
[0053] Combined with Table 1, the horizontal coordinate is calculated i=1,2...6 is [-263.99,-116.55,-88.27,32.45,-8.03,-40.49]. i=1,2...6 is the horizontal coordinate of each key point.
[0054] Step 3: Establish a mathematical model of the six-position 3R open-chain rod and obtain the solution curve of the 3R open-chain rod.
[0055] like Figure 3 , 3R open chain rod is composed of the first planetary frame, the second planetary frame and the transplanting arm, among which A0A c Indicates the first planet carrier, A c A d Indicates the second planet carrier, A d Pj represents the transplanting arm, A c A represents the first hinge point of the second planet carrier rotating relative to the first planet carrier. d represents the second hinge point of the transplanting arm relative to the second planetary carrier. Let γ j , j = 1, 2...5 is the angle of the transplanting arm posture angle corresponding to the second to sixth key points (the angle of the line connecting the front end of the clamping claw and the rotation center of the transplanting arm relative to the x-axis, and the line connecting the front end of the clamping claw and the rotation center of the transplanting arm is defined as the transplanting arm index line) relative to the angle of the transplanting arm posture angle corresponding to the first key point, let is the angle of rotation of the first planet carrier attitude angle corresponding to the second to sixth key points compared with the first planet carrier attitude angle corresponding to the first key point (its value is equal to the relative rotation angle of the first planet carrier mark line at different key points), that is, Let β j ,j=1,2...5 is the angle of rotation of the second planet carrier attitude angle corresponding to the second to sixth key points compared with the second planet carrier attitude angle corresponding to the first key point. i When , the vector passing through the front end of the seedling clamping claw is expressed as y Pji , i=1,2...6 are the ordinates of each key point; the vector of the first planet carrier Rotation The angle becomes The vector representing the second planet carrier Rotation β j The angle becomes Vector representing the transplanting arm After rotation γ j The angle becomes The front end of the seedling clamp moves from P1 to P i The loop vector equation is:
[0056]
[0057] In formula (2), i 2 =-1, vector is the coordinate of the rotation center A0 of the first planet carrier, and the rotation angle The same applies to the others. Separate the real and imaginary parts and solve cos(β j ) and sin(β j ),have to:
[0058]
[0059] Assuming that the distance between the front end of the seedling clamping claw and the rotation center of the first planetary frame is R, and the azimuth angle of the line connecting the front end of the seedling clamping claw and the rotation center of the first planetary frame relative to the X-axis is θ, we get:
[0060]
[0061] Substitute (4) into the loop vector equations (3), and from cos 2 (β j )+sin 2 (β j )-1=0 to solve the equation of the 3R open chain rod:
[0062] F j =A 1j Rcos(Θ)+A 2j Rsin(Θ)+A 3j (Z 3x Z 1x +Z 3y Z 1y )+A 4j (Z 3y Z 1x -Z 3x Z 1y )+A 5j Z 1x +A 6j Z 1y +A 7j Z 3x +A 8j Z 3y +A 9j (5)
[0063] Where:
[0064]
[0065]
[0066]
[0067]
[0068]
[0069]
[0070] A 7j =2(cos(γ j )x dj +sin(γ j )y dj )
[0071] A 8j =2(cos(γ j )y dj -sin(γ j )x dj )
[0072] A 9j =x dj 2 +y dj 2
[0073] Equation (5) contains unknowns R, Θ, Z 1x , Z 1y , Z 3x , Z 3y There are six in total. Given the six key points and the attitude angles of the seedling clamping claws at each key point, a total of five equations can be obtained, and the solutions of the remaining five unknowns at each azimuth angle θ can be obtained.
[0074] However, since the solution obtained from equation (5) actually exists, it satisfies the equation cos 2 (β j )+sin 2 (180-β j )-1=0 instead of cos 2 (β j )+sin 2 (β j )-1=0, so the solutions obtained are not all solutions of the 3R open chain rod. It is necessary to determine whether the length of the second planetary frame of the seedling clamping claw is equal at each key point to determine whether the group of solutions is the solution of the mechanism. The specific process is as follows:
[0075] Calculate the length of the second planetary frame when the front end of the seedling clamping claw is at the first key point: Where Z 2x and Z 2y It can be obtained by formula (4). At other key points, the positions of the first hinge point and the second hinge point are:
[0076]
[0077] Then at other key points, the distance between the first hinge point and the second hinge point is:
[0078]
[0079] Determine whether the distance between the first hinge point and the second hinge point is equal when the front end of the seedling clamping claw is at each key point. If they are equal, it is the solution of the mechanism, otherwise it is discarded.
[0080] After discarding the non-mechanism solution, γ j All are defined as 0, and the positions of the rotation center of the first planet carrier, the first hinge point and the second hinge point when the front end of the seedling clamp is at the first key point can be obtained respectively; then let Θ take values from 0 to 360 according to the set step size (0.5° in this paper), and the position point set of the first hinge point and the second hinge point is the global Burmester curve, as shown in Figure 4 shown.
[0081] Step 4: Solve the parameter solution domain of the six-position 3R open-chain rod.
[0082] The absolute azimuths Jc1i, Jc2i, and Jc3i of the first planet carrier, the second planet carrier, and the transplant arm mark line relative to the coordinate origin when they are at corresponding positions at each key point are obtained by formula (8).
[0083]
[0084] For each set of mechanism solutions obtained, the first planetary frame length L1, the second planetary frame length L2 and the transplanting arm rod length L3 (the length of the line connecting the front end of the seedling clamping claw and the rotation center of the transplanting arm, that is, the length of the transplanting arm mark line), as well as the transplanting arm mark line angle bsjjp (the angle from the transplanting arm mark line to the seedling clamping claw, which is a constant value) and the first planetary frame mark line angle bsjjo (the angle from the first planetary frame mark line to the first planetary frame, which is a constant value) of the mechanism can be obtained by formula (9), and the initial installation angles of the first planetary frame, the second planetary frame and the transplanting arm mark line are obtained according to formula (8), thereby obtaining the complete parameter solution domain.
[0085]
[0086] Solve the rotation angle of the first planet carrier (relative to the ground), the rotation angle Jc2i-Jc1i of the second planet carrier relative to the first planet carrier, and the rotation angle Jc3i-Jc2i of the transplant arm index line relative to the second planet carrier at the corresponding position of each key point, and determine the rotation direction of the first planet carrier position, the second planet carrier, and the transplant arm index line from the position corresponding to the first key point to the position corresponding to the second key point. When determining the rotation direction, the direction in which the rotation angle of the first planet carrier position, the second planet carrier, or the transplant arm index line from the position corresponding to the first key point to the position corresponding to the second key point is less than 180 degrees is determined as the rotation direction. If the rotation direction is determined to be counterclockwise when looking from the left side (the left side of the forward direction) to the right side (the right side of the forward direction), the rotation angle of the first planet carrier, the second planet carrier or the transfer arm mark line from the position corresponding to the first key point to the corresponding position of each subsequent key point counterclockwise is used as the angular displacement of the first planet carrier and the second planet carrier relative to the first planet carrier or the transfer arm mark line relative to the second planet carrier at the corresponding position of each subsequent key point; if the rotation direction is determined to be clockwise, the rotation angle of the first planet carrier, the second planet carrier or the transfer arm mark line from the position corresponding to the first key point to the corresponding position of each subsequent key point clockwise is used as the angular displacement of the first planet carrier and the second planet carrier relative to the first planet carrier or the transfer arm mark line relative to the second planet carrier at the corresponding position of each subsequent key point, and a negative sign is added to the angular displacement. Next, determine whether the angular displacement of the first planet carrier and the second planet carrier relative to the first planet carrier or the transfer arm line relative to the second planet carrier at the corresponding position of each key point is monotonic. If it is monotonic, add an angular displacement value of 360° to the angular displacement at the end, and the first planet carrier and the second planet carrier rotate counterclockwise relative to the first planet carrier or the transfer arm line relative to the second planet carrier; if it is monotonic, add an angular displacement value of -360° to the angular displacement at the end, and the first planet carrier and the second planet carrier rotate clockwise relative to the first planet carrier or the transfer arm line relative to the second planet carrier; if it is not monotonic, add an angular displacement value of 0° to the angular displacement at the end, and the first planet carrier and the second planet carrier swing relative to the first planet carrier or the transfer arm line relative to the second planet carrier. Angular displacement Jc1′ of the first planet carrier k , k = 1, 2, ..., 7, the angular displacement of the second planet carrier relative to the first planet carrier Jc2′ k ,k=1,2,...,7. Angular displacement Jc3′ of the transplanting arm mark line relative to the second planet carrier k ,k=1,2,...,7is obtained from formula (10).
[0087]
[0088]
[0089]
[0090] The rotation direction of the first planetary frame is set to be clockwise. At this time, the rotation direction of the front end of the seedling claw is also clockwise when it passes through each key point in sequence. At the same time, considering the actual reasonable interval length, L1∈[100,150], L2∈[60,120], L3∈[200,300] are limited, and the transplanting arm mark line angle bsjp is between 40 and 60. The parameter solution is further screened to obtain the solution curve as shown in Figure 5 To avoid confusion, Figure 5 Only the solution curve of the rotation center of the first planet carrier is shown.
[0091] Step 5: Obtain the pre-designed sweet potato transplanting trajectory through interpolation, and take the solution with the smallest hole opening in the solution curve of the 3R open-chain rod as the optimal solution of the 3R open-chain rod.
[0092] For each solution in the solution curve of the 3R open chain rod, formula (10) obtains the angular displacement of the first planet carrier, the second planet carrier relative to the first planet carrier or the transfer arm line relative to the second planet carrier at the corresponding position of each key point. The cubic B-spline interpolation fitting is used to obtain more angular displacements PHI1 of the first planet carrier relative to the ground, PHI2 of the second planet carrier relative to the first planet carrier, and PHI3 of the transfer arm line relative to the second planet carrier. Figure 6 The angular displacement of the second planet carrier relative to the first planet carrier and the angular displacement of the transfer arm line relative to the second planet carrier corresponding to one of the 3R open chain rod solutions are shown. Combined with the initial installation angles Jc11, Jc21, and Jc31 of the first planet carrier, the second planet carrier, and the transfer arm line, the coordinates of the point on the static trajectory (x pjm ,y pjm ) and the coordinates of the points on the transplanting trajectory (x pdm ,y pdm ), so that the transplanting trajectory is obtained as Figure 7 shown.
[0093]
[0094] Where m is the mark of a point on the static trajectory or transplanting trajectory after cubic spline fitting.
[0095] The distance that the seedling clamping claws sweep across the soil surface is the size of the film-breaking hole. Find the minimum ordinate value miny on the transplanting trajectory obtained by formula (11): pdm (This implementation takes the value of 327.4 mm). According to the transplanting requirements of sweet potato seedlings, this value plus 50 mm is regarded as the soil surface for transplanting. Find all the track points whose ordinates are below the soil surface on the transplanting track and record them as (x pdn ,y pdn ), then the linear equation of the seedling clamp at the nth track point below the soil surface is expressed as y n =tan(Jc31-PHI3n +bsjjp)·(xx pdn )+y pdn , let y n =miny pdm +50, find the horizontal coordinate x of the intersection point between the seedling clamping claw and the soil surface at each track point under the soil surface n value, then maxx n -minx n This is the size of the hole formed.
[0096] The solution with the smallest hole in the solution curve of the 3R open chain rod is selected as the optimal solution, see Table 2:
[0097] Table 2
[0098] project value <![CDATA[Coordinate of the rotation center point A0 of the first planetary carrier / (mm)]]> (0.33,0.15) <![CDATA[Initial installation angle Jc11 of the first planet carrier / (°)]]> 105.1 <![CDATA[Initial installation angle Jc21 of the second planet carrier / (°)]]> 135.8 <![CDATA[Initial installation angle Jc31 / (°) of the transplanting arm marking line]]> 223.9 Length of the first planet carrier L1 / (mm) 113.29 Second planet carrier length L2 / (mm) 89.42 Transplanting arm length L3 / (mm) 236.45 Angle from transplanting arm mark line to seedling clamping claw bsjjp / (°) 47
[0099] At the optimal solution, the angular displacement of the first planet carrier is Jc1′ k , k = 1, 2, ..., 7, the angular displacement of the second planet carrier relative to the first planet carrier Jc2′ k ,k=1,2,...,7. Angular displacement Jc3′ of the transplanting arm mark line relative to the second planet carrier k ,k=1,2,...,7see Table 3.
[0100] Table 3
[0101] Number of items 1 2 3 4 5 6 7 <![CDATA[Jc1′ k ]]> 0 121.1 169.6 191.3 207.7 216.3 360 <![CDATA[Jc2′ k ]]> 0 90.7 132.5 147.2 164.3 175.7 360 <![CDATA[Jc3′ k ]]> 0 34.7 36.2 19.6 3.7 -4.3 0
[0102] In this embodiment, the minimum ordinate value miny on the transplanting trajectory pdm =-327.4mm. After calculation, the hole size is 20.7mm.
[0103] Among them, although the parameters in Table 2 are determined, the angular displacement of the first planet carrier, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplanting arm mark line relative to the second planet carrier are not determined except for the key points and supplementary values.
[0104] Step 6: Use the optimal solution of the 3R open-chain rod, select the quasi-optimization control points on the sweet potato transplanting trajectory achieved by the optimal solution, set the coordinate adjustment boundary values of each quasi-optimization control point and the corresponding upper and lower limits of the first planetary frame rotation angle adjustment and record them in a matrix form.
[0105] Due to Jc1′ k , Jc2′ k , Jc3′ kThe adjustment can be made by adjusting the pitch curves of the non-circular gears (sun gear 0103, first intermediate gear 0104, third intermediate gear 0105, planetary gear 2 0106, second intermediate gear 0108 and planetary gear 1 0109) in the first planetary gear train. Therefore, there is also room for further optimization of the hole formed by the seedling clamping claws in the soil entry and exit sections of the transplanting trajectory of the front end of the seedling claws. For example, Figure 8 As shown in the figure, the same transplanting trajectory can have different Jc1′ in the entry and exit sections. k , Jc2′ k , Jc3′ k , the same Jc1′ k , Jc2′ k , Jc3′ k There may also be different positions of the transplanting trajectory entry and exit sections, and these different combinations will also lead to different sizes of the hole opening. Therefore, if you want to further reduce the hole opening, you must adjust the position of the control point to be optimized and Jc1′ on the transplanting trajectory at the same time. k , Jc2′ k , Jc3′ k Make adjustments.
[0106] Since it is easier to form a large hole at the unearthed point of the unearthed section, 10 proposed optimization control points (x nyhr ,y nyhr ), r = 1, 2, ..., 10 and the first planet carrier angle Jc1 corresponding to the position of each proposed optimized control point nyhr ,r=1,2,...,10,where (x nyhr ,y nyhr )∈(x pdn ,y pdn ), where 4 proposed optimization control points are located in the burial section, 6 points are located in the excavation section, the first proposed optimization control point is the burial point, and the last proposed optimization control point is the excavation point, as shown in Table 4.
[0107] For all the proposed optimization control points, the corresponding first planetary frame rotation angle is used as the horizontal coordinate, and the vertical coordinate of each proposed optimization control point is combined to draw the relationship diagram between the first planetary frame rotation angle and the transplanting depth, such as Fig. 9 The planting point D (the trajectory point corresponding to the release of the seedling claws) is located near the lowest point of the transplanting trajectory. The rotation angle of the first planetary frame in the entrenching section is about 70 degrees, and the corresponding angle in the emerging section is about 35 degrees, that is, the entrenching section takes about twice as much time as the emerging section.
[0108] Table 4
[0109] Quasi-optimization point <![CDATA[x nyh / mm]]> <![CDATA[y nyh / mm]]> <![CDATA[First planetary carrier rotation angle Jc1 nyh / (°) <!-- 10 -->]]> 1 -170.29 -277.86 220.47 2 -120.44 -293.71 240.05 3 -80.79 -302.80 259.89 4 -63.58 -317.02 280.98 5 -89.95 -326.98 303.52 6 -104.77 -324.31 308.08 7 -123.44 -318.28 312.84 8 -147.10 -306.88 318.25 9 -167.37 -293.59 322.84 10 -183.38 -280.52 326.65
[0110] In order to avoid the sweet potato transplanting trajectory after optimization from deviating too far from the pre-designed trajectory, it is necessary to first determine the coordinate adjustment boundary value of each proposed optimization control point and the upper and lower limits of the first planetary frame rotation angle adjustment corresponding to the position of each proposed optimization control point. Fig.10 As shown, since the proposed optimization control points 1 and 10 are close to the soil surface, the upper limit of the vertical coordinates of the two points can be set to close to -275. The proposed optimization control points 5 and 6 are close to the planting points, and the lower limit of the vertical coordinates is close to -329 mm. The coordinate adjustment boundary values of each proposed optimization control point are divided on the principle of minimizing interference with each other and being relatively uniform.
[0111] The coordinate adjustment boundary values of each proposed optimization control point and the corresponding upper and lower limits of the first planet carrier rotation angle adjustment are recorded in a matrix form. For example, in this embodiment, the lower limit matrix is set to lb = [-190.3, -135.4, -92.8, -73.6, -97.5, -111.8, -133.4, -157.1, -179.4, -190.4, -292.9, -305.7, -314.8, -329.0, -330.0, -328.3, -321.3, -312.9, -302.6, -290.5, 215.5, 230.0, 250.4, 271.0, 292.5, 306.1, 8,310.8,316.2,320.8,324.8], and the upper limit matrix is ub=[-160.3,-108.4,-70.8,-58.6,-81.0,-97.3,-113.4,-135.1,-156.4,-163.4,-274.9,-281.7,-290.8,-305.0,-315.0,-312.3,-306.3,-294.9,-286.6,-275.5,230.5,249.5,269.9,292.0,305.5,310.1,314.8,320.2,324.6,331.6].
[0112] Step 7: Write the horizontal coordinate, vertical coordinate and the first planet carrier rotation angle corresponding to each proposed optimization control point into a matrix form G 1 In this embodiment, G 1=[-170.29,-120.44,-80.79,-63.58,-89.95,-104.77,-123.44,-147.10,-167.37,-183.38,-277.86,-293.71,-302.80,-317.02,-326.98,-324.31,-318.28,-306.88,-293.59,-280.52,220.47,240.05,259.89,280.98,303.52,308.08,312.84,318.25,322.84,326.65].
[0113] Set the horizontal and vertical coordinate changes of each optimized control point to 0.5 mm (Δh t ,t=1,2,...,10 and Δh t , t=10,11,...,20 represent the changes of the horizontal and vertical coordinates of each control point to be optimized respectively), the angle change Δα t , t=1,2,...,10 are all 1°, and the positive vector and negative vector of coordinate change are and The positive angle change vector and the negative angle change vector are and
[0114] Step 8: Set the optimization goal and constraint conditions of the dual-objective optimization algorithm. The optimization goal is to minimize the hole opening and maximize the fit between the transplanting trajectory and the pre-designed transplanting trajectory.
[0115] Constraint 1: The horizontal and vertical coordinates of each quasi-optimization control point generated after the sth iteration should be within the adjustment boundary value set in step 6, and the first planet carrier rotation angle corresponding to each quasi-optimization control point generated after the sth iteration should be within the upper and lower limits of the first planet carrier rotation angle adjustment set in step 6, that is, the following inequality is satisfied:
[0116]
[0117] in, is the matrix G that records the horizontal coordinates, vertical coordinates and the first planet carrier rotation angle of each proposed optimization control point after the sth iteration. s The uth element in lb, u=1,2,...,30 r ,r=1,2,...,10 is the lower limit of the horizontal coordinate adjustment of the rth control point to be optimized, lb r+10 is the lower limit of the ordinate adjustment of the rth control point to be optimized, lb r+20 is the lower limit of the adjustment of the first planet carrier angle corresponding to the rth proposed optimization control point, ubr is the upper limit of the horizontal coordinate adjustment of the rth control point to be optimized, ub r+10 is the upper limit of the ordinate adjustment of the rth control point to be optimized, ub r+20 is the upper limit of the adjustment of the first planet carrier rotation angle corresponding to the rth optimized control point, and the augmented objective function is:
[0118]
[0119] is the barrier function, and the parameter τ1>0 is the penalty parameter, and its value is infinitely close to 0. Within the parameter range and close to the boundary, tends to ∞, the augmented objective function also tends to ∞.
[0120] Constraint 2: The angular displacement of the first planet carrier, the angular displacement of the second planet carrier and the angular displacement of the transfer arm index line corresponding to the control point to be optimized meet the processing requirements of the non-circular gear tooth profile.
[0121] The coordinates of the rth quasi-optimization control point (x csjr ,y csjr )for:
[0122]
[0123] The coordinates of the first hinge point corresponding to the rth proposed optimization control point (x csAcr ,y csAcr )for:
[0124]
[0125] Using the rod length of the second planetary frame and the unchanged length of the transplanting arm line, calculate the coordinates of the second hinge point (x csAdr ,y csAdr ), as follows:
[0126]
[0127] Formula (16) will obtain two sets of solutions for the second hinge points, which are recorded as (x csAdr1 ,y csAdr1 )、(x csAdr2 ,y csAdr2 ), the obtained 3R open chain rod will produce two special-shaped positions a and b, such as Fig.11 As shown in the figure, the two special-shaped positions both meet the angle requirements of the transplanting trajectory and the first planetary frame. However, when the front end of the seedling claw is in the soil entry section, looking from the left side (the left side of the forward direction) to the right side (the right side of the forward direction), only the 3R open-chain rod corresponding to one of the positions meets the vector of the first hinge point pointing to the second hinge point. If the vector rotates counterclockwise within the range of 0° to 180°, it can be aligned with the first hinge point pointing to the proposed optimized control point A.G (x nyhr ,y nyhr ) coincide with each other (this requirement is set because the seedling claw should be tilted forward when entering the soil), and the 3R open-chain rod that meets this requirement can be selected by the following operation: for a certain set of 3R open-chain rods, add a z-axis component with a value of 0 to these two vectors, and after adding, they are recorded as three-dimensional vectors and calculate If the z-axis component value is greater than 0, the 3R open-chain rod meets the requirements and this 3R open-chain rod is selected; otherwise, another 3R open-chain rod is selected.
[0128] For the selected 3R open chain rod, calculate the front end of the seedling claw at the first key point (x pj1 ,y pj1 ) and each proposed optimized control point A G (x nyhr ,y nyhr ) is the azimuth of the first planetary frame, the second planetary frame and the transplanting arm mark line. The process can refer to formula (8), and then calculate the front end of the seedling claw at the first key point and each proposed optimization control point A G (x nyhr ,y nyhr ), and according to the monotonicity of the first planet carrier angular displacement Jccs1′, the second planet carrier angular displacement Jccs2′ and the transplant arm line angular displacement Jccs3′, an angular displacement value of 0° or 360° is added after them respectively. This process can refer to formula (10), and then the angular displacement PHIcs1 of the first planet carrier, the angular displacement PHIcs2 of the second planet carrier relative to the first planet carrier, and the angular displacement PHIcs3 of the transplant arm line relative to the second planet carrier are obtained through cubic B-spline interpolation fitting.
[0129] like Figure 1 As shown, the total transmission ratio from the first planet carrier to the second planet carrier is The transmission ratios of the pre-distributed sun gear and the first intermediate gear and the second intermediate gear and the planetary gear 1 are Introducing the adjustment factor Then the transmission ratio of the adjusted sun gear and the first intermediate gear is The transmission ratio of the second intermediate gear to the planetary gear is The total transmission ratio from the first planet carrier to the transplanting arm is The transmission ratio of circular gear 1 to circular gear 3 is designed to be 1. According to the transmission ratio calculation method of the differential gear system, The transmission ratio between the third intermediate gear and the second planetary gear is Assuming that the center distances between the sun gear and the first intermediate gear, the second intermediate gear and the planetary gear one, and the third intermediate gear and the planetary gear two are all L1 / 2, the polar diameters of the driving gear and the driven gear of each pair of non-circular gears among the sun gear and the first intermediate gear, the second intermediate gear and the planetary gear one, and the third intermediate gear and the planetary gear two are obtained by the following formula:
[0130]
[0131] Among them, i is the transmission ratio of the driving wheel to the driven wheel, and the angular displacement of the driven wheel β 主 is the angular displacement of the driving wheel. Substitute the angular displacement PHIcs1 of the first planet carrier (which is the angular displacement of the sun gear in the conversion gear system) to get the angular displacement of the first intermediate wheel. Similarly, substitute the angular displacement of the second intermediate wheel to get the angular displacement of planetary gear one. Substitute the angular displacement of the third intermediate wheel to get the angular displacement of planetary gear two.
[0132] The calculation formula for the curvature radius of the non-circular gear pitch curve is:
[0133]
[0134] For the driving wheel, Therefore, the radius of curvature of the driving wheel is:
[0135]
[0136] The radius of curvature of the driven wheel is:
[0137]
[0138] For non-circular gears, profile distortion occurs when the minimum radius of curvature is less than zero and the absolute value of the radius of curvature is less than or equal to the pitch radius of the tool. * When the ratio of the product of the modulus m and the square of the sine value of the pressure angle α is greater than , undercutting will occur. In both cases, the tooth profile cannot be made. That is, r d +minρ<0 and ha * ·m / (sin 2 (α))-maxρ>0. Comprehensive comparison shows that the tool with larger module and fewer teeth is easier to process the target non-circular gear. The tool module m=2.5, the tool teeth number is 16, and the tool pitch circle radius r d =(2.5*16) / 2=20mm, pressure angle α=20°. The augmented objective function is constructed as:
[0139]
[0140] where ρ vrepresents the curvature radius of the vth, v=1, 2, ..., 6th non-circular gears; parameter τ2 is a penalty parameter, which is greater than 0 and infinitely close to 0.
[0141] Optimization goal 1: The angular displacement of the first planetary carrier, the angular displacement of the second planetary carrier relative to the first planetary carrier, and the angular displacement of the transplanting arm mark line relative to the second planetary carrier that simultaneously meet constraints 1 and 2 have the greatest fit with the pre-designed transplanting trajectory below the soil surface.
[0142] According to constraint 2, PHIcs1, PHIcs2, PHIcs3 and the initial installation angles Jc11, Jc21, Jc31 (the azimuth corresponding to the first key point) of the first planet carrier, the second planet carrier and the transplant arm mark line, the rotation center coordinates (x A0 ,y A0 ), the coordinates of the point on the static trajectory (x) that satisfies both constraint conditions 1 and constraint conditions 2, the angular displacement of the first planet carrier, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplant arm line relative to the second planet carrier, are obtained by equation (22): cdpj ,y cspj ) and the coordinates of the points on the transplanting trajectory (x cspd ,y cspd ).
[0143]
[0144] like Fig.12 As shown in the figure, find the minimum ordinate value miny in the transplanting trajectory obtained by formula (22) cspd , record all the vertical coordinates on the transplanting track that are less than miny cspd +50 points, the smallest value of the horizontal coordinate among these points minx cspdb It is recorded as the transplanting point of potato seedlings, and the maximum value of the horizontal axis is maxx cspdb Recorded as the deepest point of the transplanted potato seedlings. According to the transplanting requirements of sweet potato seedlings, the horizontal distance between the deepest point of the transplanting and the point of transplanting into the soil should be 125mm±3.5mm, and should not be less than 110mm or greater than 140mm.
[0145] The generalized bell-shaped membership function is particularly suitable for describing the conformity with symmetric interval characteristics. The representation of this membership function is as follows: In the formula, parameter c represents the center line, and the function is symmetrically distributed about c. Parameter a represents the length of the interval. The membership value in the interval with a length near the center line is 1. Parameter b represents the speed of decline. When the variable x is far away from the appropriate interval, the function value will decline rapidly and approach 0 infinitely. The closer the function value is to 1, the more it meets the actual requirements, and the closer it is to 0, the less it meets the actual requirements.
[0146] The present invention adopts a bell-shaped membership function to express the optimization goal of the horizontal distance between the deepest point of transplanting and the point of transplanting into the soil. According to the requirements of sweet potato seedling transplanting, the membership function value is defined as 10 -2 The values below are inappropriate for lateral transplantation. Set c = 125, a = 7, x = 110, f (x, a, b, c) = 10 -2 Substituting into the membership function expression, we get b = 3.0146. Considering that the closer the membership function is to 1, the better the degree of compliance is, and the optimization function substituted into step nine should be a set of solutions where the solution function is close to 0, so the objective function is:
[0147]
[0148] like Fig.13 As shown, the membership function value of formula (23) is in the range of 100 to 150, which can better describe the degree of conformity between the horizontal distance between the deepest point of the transplanting and the transplanting entry point of the pre-designed transplanting trajectory and the transplanting trajectory achieved by the angular displacement of the first planetary carrier, the angular displacement of the second planetary carrier relative to the first planetary carrier, and the angular displacement of the transplanting arm mark line relative to the second planetary carrier that simultaneously meet the constraints 1 and 2, thereby describing the degree of conformity between the realized transplanting trajectory and the pre-designed transplanting trajectory located below the soil surface.
[0149] Optimization goal 2: Minimize the transplanting hole opening achieved by the angular displacement of the first planet carrier, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplanting arm mark line relative to the second planet carrier that simultaneously meet constraint conditions 1 and constraint conditions 2.
[0150] Find the minimum ordinate value miny on the transplanting trajectory obtained by equation (22) cspd , add 50mm to this value and regard it as the soil surface for transplanting. Find all the trajectory points whose ordinates are below the soil surface on the transplanting trajectory and record them as (x cspd ,y cspd ), calculate the straight line equation y of the seedling clamp at each track point under the soil surface cs =tan(Jc31-PHIcs3+bsjjp)·(xx cspd )+y cspd , let y cs =miny cspd +50, find the x-coordinate value of the intersection of the seedling clamp claw and the soil surface at each track point under the soil surface, then the maximum value of the x-coordinate value The minimum value of the x-axis minus the horizontal axis This is the size f4 of the hole.
[0151]
[0152] Step nine, use the dual-objective optimization algorithm to optimize the proposed optimization control points, and obtain the azimuths of the first planet carrier, the second planet carrier and the transplanting arm mark line according to the first key point and the optimized control point, as well as the angular displacement of the first planet carrier after cubic B-spline interpolation fitting, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplanting arm mark line relative to the second planet carrier, and obtain the transmission ratios of each pair of non-circular gears and the pitch curves of each non-circular gear that meet the non-circular gear tooth profile processing requirements, and complete the design of the sweet potato transplanter. The specific process is as follows:
[0153] According to the two optimization objective functions and two constraint condition functions obtained in step eight, two augmented optimization objective functions are obtained:
[0154]
[0155] In actual operation, f1(G s ) and f2(G s The penalty parameters τ1 and τ2 in the MATLAB floating point relative accuracy eps = 2.2204 × 10 -16 . f1(G s ) and f2(G s ) The penalty parameters of these two function values have little impact on the actual value and the optimization calculation results. These two function values are only used as restrictions to ensure that the sweet potato transplanter can be used for actual processing and production. The final output of the optimization calculation results is mainly composed of f3(G s ) and f4(G s )constitute.
[0156] The dual-objective optimization algorithm is used to calculate two augmented optimization objective functions. Theoretically, the larger the cardinality of the weight vector, the more objective function solution sets are obtained, and the more truly the theoretical value of the solution can be reflected. However, due to the huge amount of calculation and computer performance, the cardinality of the weight vector is set to H = 7; the number of objective functions is m = 2, then the total number of weight vectors is The number of iterations is 700. After calculation, a relatively uniform set of non-dominated optimal solutions for the two optimization objective functions is finally obtained, such as Fig.14 As shown in the figure, a group of optimization objective function values with better sweet potato transplanting trajectory and smaller hole opening are selected. The optimization objective function values of this group are (15.049, 0.065), which represents the optimization objective function f4, that is, the size of the sweet potato hole opening is 15.049 mm. The optimization objective function f3 is calculated using formula (23) to obtain the horizontal distance between the deepest point of transplanting and the point where transplanting enters the soil, which is 120.5 mm.
[0157] The 10 optimized control points and the corresponding first planet carrier rotation angles corresponding to the optimization objective function values of this group are shown in Table 5.
[0158] Table 5
[0159] Quasi-optimization point <![CDATA[x nyh / mm]]> <![CDATA[y nyh / mm]]> <![CDATA[First planetary carrier rotation angle Jc1 nyh / (°)]]> 1 -169.29 -277.86 220.47 2 -119.94 -293.71 240.05 3 -80.79 -302.8 260.39 4 -63.58 -315.52 281.48 5 -89.95 -326.98 302.52 6 -107.27 -324.31 308.08 7 -123.94 -318.28 312.84 8 -147.1 -306.88 318.25 9 -167.37 -293.59 322.84 10 -182.38 -279.52 326.65
[0160] Execute the step of restriction condition 2 in step eight to obtain the azimuth angles of the first planet carrier, the second planet carrier and the transplanting arm mark line when the front end of the seedling claw passes through the first key point and 10 quasi-optimization control points corresponding to the optimization objective function value of the group, as well as the angular displacement of the first planet carrier, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplanting arm mark line relative to the second planet carrier after cubic B-spline interpolation fitting, and obtain the transmission ratios of each pair of non-circular gears and the pitch curves of each non-circular gear that meet the non-circular gear tooth profile processing requirements, as shown respectively. Fig.18 and Fig.19 shown. Fig.15 The angular displacement of the second planetary frame relative to the first planetary frame and the angular displacement of the transplanting arm index line relative to the second planetary frame are shown. The final static trajectory and transplanting trajectory of the sweet potato transplanter are obtained using equation (22), respectively. Figure 16-1 , Figure 16-2 and Fig.17 So far, the design of the sweet potato transplanter is completed.
Claims
1. Design method of oblique large displacement small hole double planetary frame film covering sweet potato transplanter, Features: The specific steps of this method are as follows: Step 1, construct an oblique large displacement small hole double planetary frame film-covered sweet potato transplanting mechanism; the oblique large displacement small hole double planetary frame film-covered sweet potato transplanting mechanism includes a first planetary gear system, a second planetary gear system and a transplanting arm; wherein the first planetary gear system includes a sun gear shaft, a first planetary frame, a sun wheel, a first intermediate wheel, a third intermediate wheel, planetary wheel two, a second intermediate wheel and a planetary wheel one; the sun gear shaft is fixedly connected to the first planetary frame and forms a rotating pair with the frame; the sun wheel is fixedly connected to the frame and is loosely mounted on the sun gear shaft; the intermediate wheel shaft and the planetary wheel shaft both form a rotating pair with the first planetary frame; the intermediate wheel shaft is fixedly connected to the first intermediate wheel, the second intermediate wheel and the third intermediate wheel; the first intermediate wheel is meshed with the sun wheel, the second intermediate wheel is meshed with the planetary wheel one, and the third intermediate wheel is meshed with the planetary wheel two; the planetary wheel one is loosely mounted on the planetary wheel shaft, and the planetary wheel two is fixedly connected to the planetary wheel shaft; the second planetary gear system includes a second planetary frame, a circular gear one, a circular gear two, Circular gear 3, cable cam, cam swing rod, cable swing rod and cable; the second planetary carrier is fixedly connected to the planetary gear 1 by teeth; the circular gear shaft 1 and the circular gear shaft 2 form a rotating pair with the second planetary carrier; the circular gear 1 and the cable cam are fixedly connected to one end of the planetary gear shaft that passes through the first planetary carrier and enters the second planetary carrier; the circular gear 2 is loosely sleeved on the circular gear shaft 1, and the circular gear 3 is fixedly connected to the circular gear shaft 2; the circular gear 2 is meshed with the circular gear 1 and the circular gear 3; the cam swing rod and the cable The swing rods are all fixedly connected to the circular gear shaft 1, and the cam swing rod and the wire pulling cam form a cam pair; one end of the wire pulling is fixedly connected to the wire pulling swing rod; the transplanting arm comprises a transplanting arm housing, a seedling clamping seat and a seedling clamping claw; the transplanting arm housing is fixedly connected to the circular gear 3; the seedling clamping seat and the transplanting arm housing form a sliding pair, and are connected to the transplanting arm housing through a spring; the other end of the wire pulling is fixedly connected to the seedling clamping seat; the tails of the two seedling clamping claws are both hinged to the transplanting arm housing, and the two seedling clamping claws pass through the two clamping grooves provided in the seedling clamping seat; Step 2: According to the transplanting trajectory requirements of sweet potatoes, determine the coordinates Pd of the six key points on the transplanting trajectory i ,i=1,2...6, attitude angle θ of the seedling clamp at each key point i , i = 1, 2...6 and the first planet carrier line attitude angle fjwz corresponding to each key point i , the attitude angle of the seedling clamping claw is the angle between the seedling clamping claw and the horizontal plane, and further determine the corresponding coordinates of the six key points on the static trajectory when the forward speed is 0; among them, the six key points are the seedling clamping point, the soil entry point, the seedling clamping claw preparation opening point, the planting point, the soil exit point and the seedling clamping claw preparation closing point; then, with the attitude angle of the first planetary frame mark corresponding to the first key point as a reference, the attitude angles of the first planetary frame mark corresponding to the second to the sixth key points are obtained. i , i=2,3...6 The time elapsed accounts for the proportion of one rotation of the first planet carrier. From formula (1), we can deduce the point Pj corresponding to each key point on the static trajectory i , i=1,2...6 Step 3: Establish a mathematical model of the six-position 3R open-chain rod and obtain the solution curve of the 3R open-chain rod; Step 4: Solve the parameter solution domain of the six-pose 3R open-chain rod; Step 5: obtain the pre-designed sweet potato transplanting trajectory through interpolation, and take the solution with the smallest hole opening in the solution curve of the 3R open-chain rod as the optimal solution of the 3R open-chain rod; Step 6: adopt the optimal solution of the 3R open-chain rod, select the quasi-optimization control points on the sweet potato transplanting trajectory realized by the optimal solution, set the coordinate adjustment boundary value of each quasi-optimization control point and the corresponding upper and lower limits of the first planetary frame rotation angle adjustment and record them in a matrix form; Step 7, writing the horizontal coordinate, vertical coordinate and the first planet carrier rotation angle corresponding to each proposed optimization control point into a matrix form, setting the horizontal coordinate and vertical coordinate changes of each proposed optimization control point and the corresponding first planet carrier rotation angle change, and obtaining the coordinate change positive vector, coordinate change negative vector, angle change positive vector and angle change negative vector; Step 8, setting the optimization goal and constraint conditions of the dual-objective optimization algorithm; wherein the optimization goal is to minimize the hole opening and maximize the fit between the transplanting trajectory and the pre-designed transplanting trajectory; Constraint 1: The horizontal and vertical coordinates of each proposed optimization control point generated after the sth iteration should be within the adjustment boundary value set in step 6, and the first planet carrier rotation angle corresponding to each proposed optimization control point generated after the sth iteration should be within the upper and lower limits of the first planet carrier rotation angle adjustment set in step 6; Constraint 2: The angular displacement of the first planet carrier, the angular displacement of the second planet carrier and the angular displacement of the transfer arm index line corresponding to the control point to be optimized meet the processing requirements of the non-circular gear tooth profile; Step nine, use the dual-objective optimization algorithm to optimize the control points to be optimized, and obtain the solution of the final 3R open-chain rod and the corresponding angular displacement of the first planetary carrier, the angular displacement of the second planetary carrier relative to the first planetary carrier, and the angular displacement of the transplanting arm mark line relative to the second planetary carrier by solving the optimized control points. In addition, the transmission ratios of each pair of non-circular gears and the pitch curves of each non-circular gear that meet the requirements of non-circular gear tooth profile processing are obtained to complete the design of the sweet potato transplanter.
2. According to the design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter described in claim 1, Features: Step 3: Establish a mathematical model of the six-position 3R open-chain rod. The specific process of obtaining the solution curve of the 3R open-chain rod is as follows: The 3R open chain lever is composed of the first planetary frame, the second planetary frame and the transplanting arm. 0 A c Indicates the first planet carrier, A c A d Indicates the second planet carrier, A d Pj represents the transplanting arm, A c A represents the first hinge point of the second planet carrier rotating relative to the first planet carrier. d represents the second hinge point of the transplanting arm rotating relative to the second planetary carrier; let γ j , j = 1, 2...5 is the angle of rotation of the transplanting arm posture angle corresponding to the second to sixth key points relative to the transplanting arm posture angle corresponding to the first key point, let is the angle at which the first planet carrier attitude angle corresponding to the second to sixth key points rotates compared to the first planet carrier attitude angle corresponding to the first key point, that is, Let β j ,j=1,2...5 is the angle of rotation of the second planet carrier attitude angle corresponding to the second to sixth key points compared with the second planet carrier attitude angle corresponding to the first key point; when the front end of the seedling clamping claw moves from Pj 1 Move to Pj i When , the vector passing through the front end of the seedling clamping claw is expressed as is the ordinate of each key point; represents the vector of the first planet carrier Rotation The angle becomes The vector representing the second planet carrier Rotation β j The angle becomes Vector representing the transplanting arm After rotation γ j The angle becomes The front end of the seedling clamping claw is from P 1 Move to P i The loop vector equation is: In formula (2), i 2 =-1, vector A is the rotation center of the first planet carrier 0 Coordinates, rotation angle Separate the real and imaginary parts and solve for cos(β j ) and sin(β j ),have to: Assuming that the distance between the front end of the seedling clamping claw and the rotation center of the first planetary frame is R, and the azimuth angle of the line connecting the front end of the seedling clamping claw and the rotation center of the first planetary frame relative to the X-axis is θ, we get: Substitute (4) into the loop vector equations (3), and from cos 2 (β j )+sin 2 (β j )-1=0 to solve the equation of the 3R open chain rod: F j = A 1j R cos(Θ) + A 2j R sin(Θ) + A 3j (Z 3x Z 1x + Z 3y Z 1y ) + A 4j (Z 3y Z 1x - Z 3x Z 1y ) + A 5j Z 1x + A 6j Z 1y + A 7j Z 3x + A 8j Z 3y + A 9j In formula (5): A 7j =2(cos(γ j )x dj +sin(γ j )y dj ) A 8j =2(cos(γ j )y dj -sin(γ j )x dj ) TO 9j =x dj 2 +y dj 2 Equation (5) contains unknowns R, Θ, Z 1x , Z 1y , Z 3x , Z 3y There are six in total. Given the six key points and the attitude angles of the seedling clamping claws at each key point, five equations are obtained, and the solutions of the remaining five unknowns at each azimuth angle θ are obtained; However, since the solution obtained from equation (5) actually exists, it satisfies the equation cos 2 (β j )+sin 2 (180-β j )-1=0 instead of cos 2 (β j )+sin 2 (β j )-1=0, so the solutions obtained are not all solutions of the 3R open chain rod. It is necessary to determine whether the length of the second planetary frame of the seedling clamping claw is equal at each key point to determine whether the group of solutions is the solution of the mechanism. The specific process is as follows: Calculate the length of the second planetary frame when the front end of the seedling clamping claw is at the first key point: Where Z 2x and Z 2y It is obtained by formula (4); at other key points, the positions of the first hinge point and the second hinge point are: Then at other key points, the distance between the first hinge point and the second hinge point is: Determine whether the distance between the first hinge point and the second hinge point is equal when the front end of the seedling clamping claw is at each key point. If they are equal, it is the solution of the mechanism, otherwise it is discarded; After discarding the non-mechanism solution, γ j All are defined as 0, and the positions of the rotation center of the first planet carrier, the first hinge point and the second hinge point when the front end of the seedling clamping claw is at the first key point are obtained respectively; then let θ take values from 0 to 360 according to the set step size, and the position point set of the first hinge point and the second hinge point obtained is the global Buermester curve.
3. According to the design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter described in claim 2, Features: Step 4: The specific process of solving the parameter solution domain of the six-pose 3R open-chain rod is as follows: The absolute azimuths Jc1i, Jc2i, and Jc3i of the first planet carrier, the second planet carrier, and the transplant arm mark line relative to the coordinate origin when they are at the corresponding positions of each key point are obtained by formula (8); For each set of mechanism solutions obtained, the first planetary frame length L1, the second planetary frame length L2 and the transplanting arm length L3 of the mechanism, as well as the transplanting arm mark line angle bsjjp and the first planetary frame mark line angle bsjjo are obtained by formula (9); wherein the transplanting arm length L3 is the length of the line connecting the front end of the seedling clamping claw and the rotation center of the transplanting arm, that is, the transplanting arm mark line length; the transplanting arm mark line angle bsjjp is the angle from the transplanting arm mark line to the seedling clamping claw; the first planetary frame mark line angle bsjjo is the angle from the first planetary frame mark line to the first planetary frame; the initial installation angles of the first planetary frame, the second planetary frame and the transplanting arm mark line are obtained according to formula (8), thus obtaining: Solve the rotation angle of the first planet carrier, the rotation angle Jc2i-Jc1i of the second planet carrier relative to the first planet carrier, and the rotation angle Jc3i-Jc2i of the transplant arm line relative to the second planet carrier at the corresponding position of each key point, and determine the rotation direction of the first planet carrier position, the second planet carrier and the transplant arm line at the corresponding position of the first key point to the corresponding position of the second key point; when determining the rotation direction, rotate the first planet carrier position, the second planet carrier or the transplant arm line at the corresponding position of the first key point to the corresponding position of the second key point The direction in which the rotation angle is less than 180 degrees is determined as the rotation direction; if the rotation direction is determined to be counterclockwise when looking from the left side of the forward direction to the right side of the forward direction, the rotation angle of the first planet carrier, the second planet carrier or the transfer arm mark line from the position corresponding to the first key point to the position corresponding to the subsequent key points is respectively used as the angular displacement of the first planet carrier and the second planet carrier relative to the first planet carrier or the transfer arm mark line relative to the second planet carrier at the corresponding position of the subsequent key points; if the rotation direction is determined to be clockwise, the first planet carrier and the second planet carrier are respectively rotated counterclockwise to the corresponding position of the first key point. Or the rotation angle of the transfer arm mark line from the position corresponding to the first key point to the position corresponding to each subsequent key point is respectively used as the angular displacement of the first planet carrier and the second planet carrier relative to the first planet carrier or the transfer arm mark line relative to the second planet carrier at the corresponding position of each subsequent key point, and a negative sign is added to the angular displacement; then, it is determined whether the angular displacement of the first planet carrier and the second planet carrier relative to the first planet carrier or the transfer arm mark line relative to the second planet carrier at the corresponding position of each key point is monotonic. If it is monotonic, a 360° angular displacement value is added to the angular displacement. , then the first planet carrier and the second planet carrier rotate counterclockwise relative to the first planet carrier or the transfer arm line relative to the second planet carrier; if it is monotonically decreasing, an angular displacement value of -360° is added to the angular displacement at the end, then the first planet carrier and the second planet carrier rotate clockwise relative to the first planet carrier or the transfer arm line relative to the second planet carrier; if it is not monotonically decreasing, an angular displacement value of 0° is added to the angular displacement at the end, then the first planet carrier and the second planet carrier swing relative to the first planet carrier or the transfer arm line relative to the second planet carrier; the angular displacement of the first planet carrier Jc1′ k , k = 1, 2, ..., 7, the angular displacement of the second planet carrier relative to the first planet carrier Jc2′ k ,k=1,2,...,7. Angular displacement Jc3′ of the transplanting arm mark line relative to the second planet carrier k ,k=1,2,...,7 is obtained from formula (10); The rotation direction of the first planetary carrier is set to be clockwise. At this time, the front end of the seedling claw also rotates clockwise when passing through each key point in sequence. At the same time, L1∈[100,150], L2∈[60,120], L3∈[200,300] are limited, and the transplanting arm mark line angle bsjjp is between 40 and 60, and the parameter solution is further screened.
4. According to the design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter described in claim 3, Features: Step 5: Obtain the pre-designed sweet potato transplanting trajectory through interpolation, and take the solution with the smallest hole opening in the solution curve of the 3R open-chain rod as the optimal solution of the 3R open-chain rod. The specific process is as follows: For each solution in the solution curve of the 3R open chain rod, the angular displacement of the first planet carrier and the second planet carrier relative to the first planet carrier or the transfer arm line relative to the second planet carrier at the corresponding position of each key point is obtained by using formula (10). The angular displacement PHI1 of the first planet carrier relative to the ground, the angular displacement PHI2 of the second planet carrier relative to the first planet carrier, and the angular displacement PHI3 of the transfer arm line relative to the second planet carrier are obtained by using cubic B-spline interpolation fitting. Then, the initial installation angle Jc1 of the first planet carrier, the second planet carrier and the transfer arm line is obtained. 1 、Jc2 1 、Jc3 1 , the coordinates of the points on the static trajectory (x pjm ,y pjm ) and the coordinates of the points on the transplanting trajectory (x pdm ,y pdm ); Where m is the mark of the point on the static trajectory or transplanting trajectory after the cubic spline fitting is completed; Find the minimum ordinate value min y on the transplanting trajectory obtained by equation (11) pdm , add 50mm to this value and regard it as the soil surface for transplanting; find all the trajectory points whose ordinates are below the soil surface on the transplanting trajectory and record them as (x pdn ,y pdn ), then the linear equation of the seedling clamp at the nth track point below the soil surface is expressed as y n =tan(Jc3 1 -PHI3 n +bsjjp)·(xx pdn )+y pdn , let y n =min y pdm +50, find the horizontal coordinate x of the intersection point between the seedling clamping claw and the soil surface at each track point under the soil surface n value, then max x n -minx n It is the size of the hole formed; Select the solution with the smallest hole in the solution curve of the 3R open chain rod as the optimal solution, and solve the angular displacement Jc1′ of the first planet carrier k , k = 1, 2, ..., 7, the angular displacement of the second planet carrier relative to the first planet carrier Jc2′ k ,k=1,2,...,7. Angular displacement Jc3′ of the transplanting arm mark line relative to the second planet carrier k ,k=1,2,...,7.
5. According to the design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter described in claim 4, Features: Step 6 The specific process is as follows: Use the optimal solution of the 3R open-chain rod and select 10 quasi-optimal control points (x nyhr ,y nyhr ), r = 1, 2, ..., 10 and the first planet carrier angle Jc1 corresponding to the position of each proposed optimized control point nyhr ,r=1,2,...,10, where 4 proposed optimization control points are located in the burial section and 6 points are located in the excavation section, the first proposed optimization control point is the burial point and the last proposed optimization control point is the excavation point; then determine the coordinate adjustment boundary value of each proposed optimization control point and the upper and lower limits of the first planet carrier angle adjustment corresponding to the position of each proposed optimization control point, and record the coordinate adjustment boundary value of each proposed optimization control point and the corresponding upper and lower limits of the first planet carrier angle adjustment in matrix form.
6. The design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter according to claim 5, Features: Step 7 The specific process is as follows: Write the horizontal coordinates, vertical coordinates of each proposed optimization control point and the first planet carrier rotation angle corresponding to each proposed optimization control point into a matrix form G 1 , set the horizontal and vertical coordinate changes of each optimized control point to 0.5mm, and the angle change Δα t , t=1,2,...,10 are all 1°, and the positive vector and negative vector of coordinate change are and The positive angle change vector and the negative angle change vector are and Where Δh t ,t=1,2,...,10 and Δh t , t=10,11,...,20 respectively represent the changes of the horizontal and vertical coordinates of each control point to be optimized.
7. The design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter according to claim 6, Features: The specific restriction condition 1 in step 8 is as follows: The following inequalities are satisfied: in, is the matrix G that records the horizontal coordinates, vertical coordinates and the first planet carrier rotation angle of each proposed optimization control point after the sth iteration. s The uth element in lb, u=1,2,...,30 r ,r=1,2,...,10 is the lower limit of the horizontal coordinate adjustment of the rth control point to be optimized, lb r+10 is the lower limit of the ordinate adjustment of the rth control point to be optimized, lb r+20 is the lower limit of the adjustment of the first planet carrier angle corresponding to the rth proposed optimization control point, ub r is the upper limit of the horizontal coordinate adjustment of the rth control point to be optimized, ub r+10 is the upper limit of the ordinate adjustment of the rth control point to be optimized, ub r+20 is the upper limit of the adjustment of the first planet carrier rotation angle corresponding to the rth optimized control point, and the augmented objective function is: is the barrier function, parameter τ 1 >0 is the penalty parameter.
8. The design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter according to claim 7, Features: In step 8, constraint 2 is determined as follows: The coordinates of the rth quasi-optimization control point (x csjr ,y csjr )for: The coordinates of the first hinge point corresponding to the rth proposed optimization control point (x csAcr ,y csAcr )for: Using the rod length of the second planetary frame and the unchanged length of the transplanting arm line, calculate the coordinates of the second hinge point (x csAdr ,y csAdr ), as follows: Formula (16) obtains the solutions of two sets of second hinge points, which are respectively denoted as (x csAdr1 ,y csAdr1 )、(x csAdr2 ,y csAdr2 ), the obtained 3R open chain rod will produce two special-shaped positions. The following operations are performed on the two special-shaped positions: for a certain set of 3R open chain rods, add a z-axis component with a value of 0 to these two vectors, and after adding, they are recorded as three-dimensional vectors and calculate If the z-axis component value is greater than 0, the 3R open-chain rod meets the requirements and the 3R open-chain rod is selected; otherwise, another 3R open-chain rod is selected; For the selected 3R open chain rod, calculate the front end of the seedling claw at the first key point (x pj1 ,y pj1 ) and the azimuths of the first planetary frame, the second planetary frame and the transplanting arm mark line at each proposed optimization control point, and then calculate the angular displacement Jccs1′ of the first planetary frame, the angular displacement Jccs2′ of the second planetary frame and the angular displacement Jccs3′ of the transplanting arm mark line at the first key point and each proposed optimization control point, and according to the monotonicity of the angular displacement Jccs1′ of the first planetary frame, the angular displacement Jccs2′ of the second planetary frame and the angular displacement Jccs3′ of the transplanting arm mark line, respectively, they are supplemented with an angular displacement value of 0° or 360°, and then more angular displacements PHIcs1 of the first planetary frame, the angular displacement PHIcs2 of the second planetary frame relative to the first planetary frame, and the angular displacement PHIcs3 of the transplanting arm mark line relative to the second planetary frame are obtained through cubic B-spline interpolation fitting; The total transmission ratio from the first planet carrier to the second planet carrier is The transmission ratios of the pre-distributed sun gear and the first intermediate gear and the second intermediate gear and the planetary gear 1 are Introducing the adjustment factor Then the transmission ratio of the adjusted sun gear and the first intermediate gear is The transmission ratio of the second intermediate gear to the planetary gear is The total transmission ratio from the first planet carrier to the transplanting arm is The transmission ratio of circular gear 1 to circular gear 3 is designed to be 1. According to the transmission ratio calculation method of the differential gear system, The transmission ratio between the third intermediate gear and the second planetary gear is Assume that the center distances between the sun gear and the first intermediate gear, the second intermediate gear and the planetary gear one, and the third intermediate gear and the planetary gear two are all L. 1 / 2, then the polar diameter of the driving wheel and the driven wheel of each pair of non-circular gears among the sun wheel and the first intermediate wheel, the second intermediate wheel and the planetary wheel one, and the third intermediate wheel and the planetary wheel two can be calculated by the following formula: Among them, i is the transmission ratio of the driving wheel to the driven wheel, and the angular displacement of the driven wheel β 主 is the angular displacement of the driving wheel, substitute the angular displacement PHIcs1 of the first planet carrier to get the angular displacement of the first intermediate wheel, substitute the angular displacement of the second intermediate wheel to get the angular displacement of the planetary wheel one, substitute the angular displacement of the third intermediate wheel to get the angular displacement of the planetary wheel two; The calculation formula for the curvature radius of the non-circular gear pitch curve is: For the driving wheel, Therefore, the radius of curvature of the driving wheel is: The radius of curvature of the driven wheel is: The tooth profile of non-circular gears should satisfy r d +minρ<0 and ha * ·m / (sin 2 (α))-maxρ>0; assuming the tool module m, the number of tool teeth z, and the pressure angle α, the tool pitch radius r d =m*z / 2, the augmented objective function is constructed as: where ρ v represents the curvature radius of the vth, v=1, 2, ..., 6th non-circular gears; parameter τ 2 is the penalty parameter.
9. The design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter according to claim 8, Features: The optimization objectives in step eight are as follows: Optimization goal 1: The angular displacement of the first planetary carrier, the angular displacement of the second planetary carrier relative to the first planetary carrier, and the angular displacement of the transplanting arm mark line relative to the second planetary carrier that simultaneously meet constraint conditions 1 and constraint conditions 2 have the greatest fit with the part of the pre-designed transplanting trajectory located below the soil surface; PHIcs1, PHIcs2, PHIcs3 and the initial installation angle Jc1 of the first planet carrier, the second planet carrier and the transplanting arm line derived according to constraint condition 2 1 、Jc2 1 、Jc3 1 , the first planet carrier rotation center coordinate (x A0 ,y A0 ), the coordinates of the point on the static trajectory (x) that satisfies both constraint conditions 1 and constraint conditions 2, the angular displacement of the first planet carrier, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplant arm line relative to the second planet carrier, are obtained by equation (22): cdpj ,y cspj ) and the coordinates of the points on the transplanting trajectory (x cspd ,y cspd ); Find the minimum ordinate value min y in the transplanting trajectory obtained by formula (22) cspd , record all the vertical coordinates on the transplanting trajectory that are less than min y cspd +50 points, the smallest value of the horizontal coordinate among these points min x cspdb It is recorded as the transplanting point of potato seedlings, and the maximum value of the horizontal axis is max x cspdb It is recorded as the deepest point of the transplanted potato seedlings; Define the bell-shaped membership function value as 10 -2 The values below are inappropriate lateral transplanting values, and the objective function is constructed as follows: Optimization goal 2: minimize the transplanting hole opening achieved by the angular displacement of the first planet carrier, the angular displacement of the second planet carrier relative to the first planet carrier, and the angular displacement of the transplanting arm mark line relative to the second planet carrier that simultaneously meet constraint conditions 1 and constraint conditions 2; Find the minimum ordinate value min y on the transplanting trajectory obtained by equation (22) cspd , add 50mm to this value and regard it as the soil surface for transplanting; find all the trajectory points whose ordinates are below the soil surface on the transplanting trajectory and record them as (x cspd ,y cspd ), calculate the straight line equation y of the seedling clamp at each track point under the soil surface cs =tan(Jc3 1 -PHIcs3+bsjjp)·(xx cspd )+y cspd , let y cs =min y cspd +50, find the x-coordinate value of the intersection of the seedling clamp claw and the soil surface at each track point under the soil surface, then the maximum value of the x-coordinate value The minimum value of the x-axis minus the horizontal axis The size of the hole is f 4 ; 10. The design method of the oblique large displacement small hole double planetary frame film-covered sweet potato transplanter according to claim 9, Features: Step 9 The specific process is as follows: According to the two optimization objective functions and two constraint condition functions obtained in step eight, two augmented optimization objective functions are obtained: f 1 (G s ) and f 2 (G s ) in the penalty parameter τ 1 and τ 2 The value is 2.2204×10 -16 ; The two augmented optimization objective functions are calculated using the dual-objective optimization algorithm to obtain the non-dominated optimal solution set of the two optimization objective functions. A set of optimization objective function values with good transplanting trajectory and small hole mouth is selected. This set of optimization objective function values uses formula (23) to calculate the horizontal distance between the deepest point of transplanting and the point where transplanting enters the soil; Execute the step of restriction condition 2 in step eight to obtain the azimuths of the first planetary carrier, the second planetary carrier and the transplanting arm mark line when the front end of the seedling picking claw passes through the first key point and 10 simulated optimization control points corresponding to the optimization objective function value of this group, as well as the angular displacement of the first planetary carrier, the angular displacement of the second planetary carrier relative to the first planetary carrier, and the angular displacement of the transplanting arm mark line relative to the second planetary carrier after cubic B-spline interpolation fitting, and obtain the transmission ratios of each pair of non-circular gears and the pitch curves of each non-circular gear that meet the requirements of non-circular gear tooth profile processing to complete the design of the sweet potato transplanter.
