3.1. Structural Design and Kinematic Analysis of Supply-Robot Arm
3.1.1. Structural Design of Supply-Robot Arm
The main design parameter of the supply-robot arm is the length of each link [
23,
24]. The length of the waist-joint link is mainly determined using the frame size and the relative height of the seeder and the ground. The small arm link is mainly responsible for adjusting the inclination angle of the discharge port, so the docking range is mainly determined using the length of the big arm link. Due to limitations in the range of motion of the joint drive components and the joint structure, the maximum design angle of the big-arm joint is 45°, and the angle range during normal operation is usually 0~30°. During operation, a safe distance of about 1 m should be left between the two machines to prevent interference between vehicles. In order to meet the above operation requirements, the following requirements should be met:
where
is the big arm link length, mm;
is the angle between the boom link and the horizontal plane, mm;
is half the width of the supply device, mm; and
is the machine working distance, mm.
When the joint angle of the big arm is 30°, the projection distance in the horizontal plane is the shortest. At this time, the length of the big-arm-connecting rod can be obtained, which is greater than 2078.5 mm. Finally, based on the actual situation, the size of the big arm is rounded to 2180 mm. At the same time, the small-arm-connecting rod is determined according to the structural characteristics. The size is 350 mm.
3.1.2. Kinematic Analysis of Supply-Robot Arm
- (1)
Forward kinematic analysis
In order to obtain the relationship between the spatial coordinates of the outlet of the supply device and the joint angle of the robotic arm, a kinematic analysis of the robotic arm was performed [
25,
26]. The modified D-H method is used to set the link coordinate system of the robotic arm. A base coordinate system is established on the frame and each link coordinate system is established at the drive shaft of the rod. The link coordinate system of the supply-robot arm is shown in
Figure 3.
According to the modified D-H method modeling rules, the parameter
represents the rotation angle between the connecting rod joint axis
and
, and the parameter
represents the angle through which the connecting rod
has rotated around the joint axis
from the initial value. The parameter
is the distance between the joint rotation axes, and the parameter
represents the distance between the relative positions of the links. The final D-H link parameters of the docking robotic arm are obtained as shown in
Table 2. Among them,
= 1195 mm,
= 2180 mm,
= 350 mm, a = 480 mm, and the rotation angle ranges of each joint are shown in
Table 3.
The transformation matrix between adjacent connecting rod coordinate systems is as follows:
The transformation matrix of the coordinate system {3} relative to the coordinate system {0} can be obtained by multiplying the transformation matrices of each adjacent link:
The forward kinematics equation of the supply-robot arm is obtained as follows:
where
, , , , , , , , , , , . Besides, , , , , , .
The forward kinematics equation of the modified D-H method obtains the position coordinates of the center of the end of the connecting rod’s rotation axis. In order to obtain the coordinates of the end of the connecting rod, which is the discharge port, the original forward kinematics equation must be multiplied by the transformation vector:
. The forward kinematic equation of the connecting-rod end point is obtained as follows:
- (2)
Inverse kinematic analysis
By analyzing the working requirements, the target posture of the end link of the robotic arm in the base coordinate system can be obtained. In order to control the hydraulic drive element to make the robotic arm reach the target posture, inverse kinematics analysis is performed. The solution process of each joint is as follows. Multiply the forward kinematics equations on the left by
to find the following:
Let the elements (3, 4) in Equations (6) and (7) correspond to the same, and we can find
Using trigonometric substitution we can solve
For the two possible solutions for the positive and negative signs, due to the restrictions on the angle range and rotation direction, a unique solution can be obtained, that is
In the same way, if the elements (2, 4) in Equations (6) and (7) are equal, we can find
which can be solved using
Let the elements (3, 1) and (3, 2) in Equations (6) and (7) correspond to the same:
So far, the mathematical relationship between the joint angle of the supply manipulator and the spatial posture of the discharge port has been obtained.
3.2. Parameter Design of Screw Conveyor Device
The screw conveyor is a continuous conveying equipment that uses rotating spiral blades to push materials for forced conveying. Under the condition of ensuring sufficient and stable feeding, the material in the device has a stable filling coefficient [
27]. Under this condition, the output of the material can be controlled by controlling the advancement speed of the material in the device. Therefore, controllable quantitative output of seeds can be achieved by designing the spiral auger parameters rationally. The structure of the spiral auger is shown in
Figure 4.
The calculation formula for the conveying capacity
Q of the spiral auger per unit time is as follows
where
Q is spiral conveyor flow rate, kg/min;
D is spiral blade diameter, m;
S is pitch, m;
n is spiral blade speed, r/min;
is fill factor;
is material density, kg/m
3;
is the inclined conveying coefficient.
It can be seen from Formula (16) that the conveying volume
Q per unit time is related to
D,
S,
n,
,
, and
, among which the material density of wheat seeds is 680 kg/m
3, the filling coefficient
, and the inclined conveying coefficient
are related to the inclination angle. The inclined conveying coefficient is shown in
Table 4.
During the spiral conveying process, the periodic changes in the space of the spiral cavity cause the real-time flow rate to pulsate. In order to ensure the uniformity and stability of the conveyed flow rate, each part of the spiral auger adopts the same pitch and blade diameter, at the same time, trying to choose a larger rotation speed within the permitted range to reduce the impact of periodic changes on flow consistency. Each section of the spiral auger is at horizontal, vertical, and inclination angles within the range of 0°~30° according to the actual installation and working status. It can be seen from
Table 4 that the inclined conveying coefficient is the smallest in the vertical state, so the flow rate of the auger at the waist joint is the lowest at the same speed. The flow value of this section of the auger is the maximum flow rate that the entire screw conveying system can output, so it is
= 0.46,
= 0.30 for calculation. Increasing the spiral blade speed
n can increase the conveying flow rate, but if the speed is too high, the centrifugal force on the material will be too large and the material will be thrown to the pipe wall, making it impossible to convey. The spiral speed satisfies the following empirical formula:
where
is maximum screw speed, r/min;
A is comprehensive characteristic coefficient of materials.
The value of the comprehensive characteristic coefficient of the material is related to the state and surface properties of the material itself. For wheat seeds, the empirical value
A = 46 is taken. According to the provisions of the Machinery Industry Standard of the People’s Republic of China JB/T7679-2019 [
28] “Screw Conveyor”, the nominal diameter
D size series of the spiral blades are 100, 125, 160, 200, 250, 315, and 400 mm, etc. The blades’ diameters are 200 mm, which is determined based on the structural dimensions of the whole machine. The size of the pitch determines the value of the helix angle and the slip surface where the material runs. It is usually calculated according to the following formula:
where
Ks is the pitch coefficient.
Referring to the empirical value of the screw conveyor design, the pitch coefficient is usually
Ks = 0.8~1.0. Combined with the recommended value in the above standards, the pitch is 200 mm. The value of the spiral blade speed should be less than its maximum value:
From Formula (17), it can be gathered that the maximum critical speed of the designed spiral blade is 102.9 r/min. According to the requirements of the research project on the supply flow value, the seed supply volume must reach 50 kg per minute. From Formula (16), it can be gathered that the rotation speed of the spiral blade at this flow rate is 84.7 r/min, which is lower than the maximum critical speed, which proves that the parameters of the designed spiral auger are reasonable and provides parameters for the selection of the reduction ratio of the power input sprocket. The flow rate at the maximum critical speed is 60.7 kg/min. Finally, the diameter Dl of the spiral auger shaft is usually 0.2~0.35 times the diameter of the spiral blade, so the shaft diameter is 40 mm.