Accurate positioning method for single-track type fertilizer applicator
Technical Field
The invention relates to a control method of agricultural machinery, in particular to a control method of a fertilizer applicator, and specifically relates to a precise positioning method of a single-track type fertilizer applicator.
Background
The trunk and the canopy of the dwarf and close-planted fruit tree are short, and the row spacing and the plant spacing are small. Because the space is narrow and small, the fertilization machinery of traditional manual driving can't carry the fertilizer can and get into inside the orchard and fertilize the operation. Therefore, an automatic rail fertilizer applicator is required to replace manual operation. Most of the existing fertilizer applicators are positioned by satellites. However, because the crown of the fruit tree blocks satellite signals, the traditional RTK-GPS positioning cannot be generally used in an orchard, and improvement is urgently needed.
Disclosure of Invention
The invention aims to provide a precise positioning method of a single-track type fertilizer applicator, aiming at the defects of the prior art, which can quickly position the coordinates of the fertilizer applicator on a track, is simple to realize and high in accuracy and is not influenced by temperature.
The technical scheme of the invention is as follows:
a precise positioning method of a single-track type fertilizer applicator comprises a single linear metal track and the fertilizer applicator, wherein the fertilizer applicator is arranged on the track and moves along the track; a metal electrode is led out from the bottom of the fertilizer applicator and is electrically contacted with the track; the fertilizer applicator divides the track into two sections at the position on the track, and a track resistance I and a track resistance II are correspondingly formed; the rail resistor I, the potentiometer I, the resistor I, the milliammeter I and the power supply are connected to form an impedance bridge circuit I; the rail resistor II, the potentiometer II, the resistor II, the milliammeter II and a power supply are connected to form an impedance bridge circuit II; the positioning method comprises the following steps:
1) determining the absolute coordinates of the two ends of the rail by means of a measuring tool: head end A (x)1,y1) And tail end B (x)2,y2) And calculating the length L of the track;
2) a fertilizer applicator is arranged on the track, and the position point of the fertilizer applicator on the track is P; installing an impedance bridge circuit I and an impedance bridge circuit II; wherein: track resistance I is RxThe track resistance II is RyThe potentiometer I is Rc1The potentiometer II is Rc2The resistance I is R1The resistance II is R2The power supply is 5V;
3) the industrial personal computer sends out a control instruction to gradually increase the output resistance value of the potentiometer I from 0 to R1+R2Step length is 0.1 omega, and refreshing frequency is 10 Hz; meanwhile, the current value of the milliammeter I is synchronously read through an industrial personal computer, and the refreshing frequency is 10 Hz; recording the output value R of the potentiometer I when the value of the milliammeter I is minimumc1f;
4) The reverse operation is performed to make the output resistance of the potentiometer I from R1+R2Continuously decreasing until 0; simultaneously, synchronously reading the current value of the milliammeter I through an industrial personal computer; recording the output value R of the potentiometer I when the value of the milliammeter I is minimumc1b;
5) Calculated as Rx=(Rc1f+Rc1b)/2;
6) The industrial personal computer sends out a control instruction to gradually increase the output resistance value of the potentiometer II from 0 to R1+R2Step length is 0.1 omega, and refreshing frequency is 10 Hz; meanwhile, the current value of the milliammeter II is synchronously read through an industrial personal computer, and the refreshing frequency is 10 Hz; recording the output value R of the potentiometer II when the value of the milliammeter II is minimumc2f;
7) The reverse operation is performed, so that the output resistance value of the potentiometer II is from R1+R2Continuously decreasing until 0; meanwhile, the current value of the milliammeter II is synchronously read through an industrial personal computer; recording the output value R of the potentiometer II when the value of the milliammeter II is minimumc2b;
8) Calculated as Ry=(Rc2f+Rc2b)/2;
9) Calculating the distance from the point P to the point A: PA | ═ Rx/(Rx+Ry)×L;
10) Converting P to coordinates:
further, the potentiometer I and the potentiometer II are both digital potentiometers; and the milliammeter I and the milliammeter II are both digital milliammeters.
Further, the potentiometer I, the potentiometer II, the milliammeter I and the milliammeter II are provided with RS485 bus interfaces and are respectively connected to an industrial personal computer.
The invention has the beneficial effects that:
the invention has the advantages of reasonable design, simple structure, convenient control, simple realization, high accuracy and no influence of temperature, and can quickly position the coordinates of the fertilizer applicator on the track.
Drawings
FIG. 1 is a schematic diagram of the electrical connection of the present invention.
Wherein: rx-a track resistance I; ry-a track resistance II; r1-a resistance I; r2-a resistance II; rc1-a potentiometer I; rc2-a potentiometer II; mA1-milliammeter I; mA2Milliammeter II.
Detailed Description
The invention is further described below with reference to the figures and examples.
As shown in fig. 1.
A single-track type fertilizer applicator system comprises a single straight-line metal track and a fertilizer applicator, wherein the fertilizer applicator is arranged on the track and moves along the track; a metal electrode is led out from the bottom of the fertilizer applicator and is electrically contacted with the track; the fertilizer applicator divides the track into two sections at the position on the track, and a track resistance I and a track resistance II are correspondingly formed; the rail resistor I, the potentiometer I, the resistor I, the milliammeter I and the power supply are connected to form an impedance bridge circuit I; the rail resistor II, the potentiometer II, the resistor II, the milliammeter II and a power supply are connected to form an impedance bridge circuit II. The potentiometer I and the potentiometer II are both digital potentiometers; and the milliammeter I and the milliammeter II are both digital milliammeters. And the potentiometer I, the potentiometer II, the milliammeter I and the milliammeter II are respectively provided with an RS485 bus interface and are respectively connected to an industrial personal computer.
The invention discloses a precise positioning method of a single-track fertilizer applicator, which comprises the following steps:
1) determining the absolute coordinates of the two ends of the rail by means of a measuring tool: head end A (x)1,y1) And tail end B (x)2,y2) And calculating the length L of the track;
2) a fertilizer applicator is arranged on the track, and the position point of the fertilizer applicator on the track is P; installing an impedance bridge circuit I and an impedance bridge circuit II; wherein: track resistance I is RxThe track resistance II is RyThe potentiometer I is Rc1The potentiometer II is Rc2The resistance I is R1The resistance II is R2The power supply is 5V;
3) passing toolThe control machine sends out a control command to gradually increase the output resistance of the potentiometer I from 0 to R1+R2Step length is 0.1 omega, and refreshing frequency is 10 Hz; meanwhile, the current value of the milliammeter I is synchronously read through an industrial personal computer, and the refreshing frequency is 10 Hz; recording the output value R of the potentiometer I when the value of the milliammeter I is minimumc1f;
4) The reverse operation is performed to make the output resistance of the potentiometer I from R1+R2Continuously decreasing until 0; simultaneously, synchronously reading the current value of the milliammeter I through an industrial personal computer; recording the output value R of the potentiometer I when the value of the milliammeter I is minimumc1b;
5) Calculated as Rx=(Rc1f+Rc1b)/2;
6) The industrial personal computer sends out a control instruction to gradually increase the output resistance value of the potentiometer II from 0 to R1+R2Step length is 0.1 omega, and refreshing frequency is 10 Hz; meanwhile, the current value of the milliammeter II is synchronously read through an industrial personal computer, and the refreshing frequency is 10 Hz; recording the output value R of the potentiometer II when the value of the milliammeter II is minimumc2f;
7) The reverse operation is performed, so that the output resistance value of the potentiometer II is from R1+R2Continuously decreasing until 0; meanwhile, the current value of the milliammeter II is synchronously read through an industrial personal computer; recording the output value R of the potentiometer II when the value of the milliammeter II is minimumc2b;
8) Calculated as Ry=(Rc2f+Rc2b)/2;
9) Calculating the distance from the point P to the point A: PA | ═ Rx/(Rx+Ry)×L;
10) Converting P to coordinates:
specifically, the coordinates of point A, B are: a (x)1=10.00,y1=10.00)、B(x2=96.60,y260.00). The coordinate of the AB point can be acquired by raising the RTK-GPS antenna, and the coordinate does not change after being acquired; the track length L is calculated to be 100.00 m.
Let R1=R2R is 100 Ωc1f=25.6Ω,Rc1b24.8 Ω, and further Rx=(Rc1f+Rc1b)/2=25.2Ω。
The same can be obtained: rc2f=45.0Ω,Rc2b45.2 Ω, and further Ry=(Rc2f+Rc2b)/2=45.1Ω。
Then there are: PA | ═ Rx/(Rx+Ry)×L=25.2/(25.2+45.1)×100=35.85m。
The P point index is solved from the mathematical relationship as:
the parts not involved in the present invention are the same as or can be implemented using the prior art.