CN101833334B - Tractor automatic navigation control system and method thereof - Google Patents

Tractor automatic navigation control system and method thereof Download PDF

Info

Publication number
CN101833334B
CN101833334B CN2010101499343A CN201010149934A CN101833334B CN 101833334 B CN101833334 B CN 101833334B CN 2010101499343 A CN2010101499343 A CN 2010101499343A CN 201010149934 A CN201010149934 A CN 201010149934A CN 101833334 B CN101833334 B CN 101833334B
Authority
CN
China
Prior art keywords
steering
tractor
navigation
control
value
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN2010101499343A
Other languages
Chinese (zh)
Other versions
CN101833334A (en
Inventor
孟志军
付卫强
徐飞军
赵春江
陈立平
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Research Center for Information Technology in Agriculture
Original Assignee
Beijing Research Center for Information Technology in Agriculture
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Research Center for Information Technology in Agriculture filed Critical Beijing Research Center for Information Technology in Agriculture
Priority to CN2010101499343A priority Critical patent/CN101833334B/en
Publication of CN101833334A publication Critical patent/CN101833334A/en
Application granted granted Critical
Publication of CN101833334B publication Critical patent/CN101833334B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Steering Control In Accordance With Driving Conditions (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

The invention provides a tractor automatic navigation control system. The system comprises a navigation control device, a steering control unit and an electro-hydraulic proportion steering executing device, wherein the navigation control device receives GPS positioning data in real time, calculates a lateral deviation between a current tractor position and an operation navigation target, calculates a target steering angle of a steering wheel in a current control period according to the lateral deviation and a tractor running speed value measured in real time, converts the target steering angle into a steering control command and then sends the steering control command to the steering control unit; the steering control unit judges whether a steering angle measured value of the steering wheel of the tractor is less than a preset limit value; if the steering angle measured value is less than the preset limit value, the steering control unit compares the target steering angle with the measured value, calculates a PWM duty cycle according to a steering angle difference value and outputs a control signal for driving the electro-hydraulic proportion steering executing device; and the electro-hydraulic proportion steering executing device responds to the PWM control signal and controls the flowing direction and the flowing speed of oil of a tractor steering system by the opening of a valve core of an electro-hydraulic proportion direction valve to make a piston of a steering hydraulic cylinder extend out or retract to deflect the steering wheel to the target steering angle.

Description

Tractor automatic navigation control system and method thereof
Technical field
The present invention relates to the control technology field, particularly a kind of automatic navigation control system and method thereof that is applicable to the fluid-link steering tractor.
Background technology
In tractor farm work process,, easily influence throughput rate because of backsetting, balk or walking distance more because operation unit maneuverability is poor.In order to reduce recast between adjacent operation ridge and to leak the generation of making phenomenon, the method that prior art adopts the scriber line more or sprays foam is carried out the foundation of mark as driver's operation navigation in the field.Along with carrying out of domestic precision agriculture technical research in recent years, the researchist has developed agricultural machinery navigation indication mechanism, adopts GPS, PC104 computing machine and navigation indication optical wand to provide the navigation indication for the agricultural machinery farm work.Yet all there is certain defective in above-mentioned two kinds of navigation indicating means that are used for agricultural machinery working.
Infeasible substantially or the navigation indicating effect is very poor under the situation that the method that line of traditional employing scriber and foam spray is lower in farmland operation environment visibility, farmland surface does not have obvious reference substance and surface relief is bigger, do not reach the purpose of navigation and raising operation quality.
Existing navigation indication mechanism adopts the RS232/RS485 bus more, causes numerous and diverse, the poor reliability of system wiring, and the versatility of each module of system is not strong, poor compatibility.Simultaneously, this class navigation indication mechanism is subjected to the manual operation factor affecting bigger, and the operation navigation accuracy is poor, can not satisfy the application demand of the higher farmland operation of accuracy requirement as links such as sowings.In addition, the operation control of existing navigation indication mechanism still needs human pilot to finish, and is actually a kind of less important work navigational system, and human pilot labour intensity is still bigger.
Summary of the invention
The technical matters that will solve of the present invention is above-mentioned at least one defective that overcomes prior art, realizes the self-navigation control of fluid-link steering tractor.
For solving the problems of the technologies described above, technical scheme of the present invention discloses a kind of tractor automatic navigation control system on the one hand, comprising:
Navigation Control Unit, receive in real time the GPS locator data and calculate the tractor current location and the operation navigation target between lateral deviation, calculate the target rotation angle of deflecting roller in the current control cycle and be converted into according to described lateral deviation and the tractor travel speed value measured in real time and send to steering control device after turning to steering order, and, when the steering order error message that receives steering control device, send the detection false command or stop automatic steering order to it;
Steering control device, whether the outer corner measurement value of judging the tractor steering wheel is less than preset limit value, if, then described target rotation angle value and measured value are compared, calculate the pwm control signal of PWM dutycycle and output driving electric-hydraulic proportion steering gear according to the corner difference; Otherwise, send the steering order error message to described Navigation Control Unit;
The electric-hydraulic proportion steering actuator, respond described pwm control signal and control the fluid flow direction and the flow velocity of tractor steering system, the hydraulic steering cylinder piston is stretched out or regain deflecting roller is deflected into described target steering angle by the spool aperture of electrohydraulic proportional directional valve; Perhaps, response is described stops automatic steering order and makes electromagnetic switch valve outage.
Wherein, realize the transmission of information and instruction between described Navigation Control Unit and the described steering control device by the CAN bus.
Wherein, described Navigation Control Unit obtains the latitude and longitude coordinates value of tractor current location by RTK-GPS; By the current travel speed value of ground velocity radargrammetry tractor.
Wherein, described steering control device is by the corner value of steering wheel angle sensor measurement tractor when steering front wheel.
Another aspect of the present invention also discloses a kind of tractor automatic navigation control method, may further comprise the steps:
S101: Navigation Control Unit receive the GPS locator data in real time and calculate the tractor current location and the operation navigation target between lateral deviation, according to described lateral deviation and the tractor travel speed value measured in real time, calculate the target rotation angle of deflecting roller in the current control cycle and be converted into according to pid control algorithm and send to steering control device after turning to steering order;
S102: whether steering control device judges the outer corner measurement value of tractor steering wheel less than preset limit value, if then read the level signal of pressure switch transmission and judge the current automatic steering state that whether is in, if then enter next step;
S103: steering control device compares described target rotation angle value and measured value, calculates the PWM dutycycle according to the corner difference according to pid control algorithm, and output drives the pwm control signal of electric-hydraulic proportion steering gear;
S104: the electric-hydraulic proportion steering actuator responds described pwm control signal and controls the fluid flow direction and the flow velocity of tractor steering system by the spool aperture of electrohydraulic proportional directional valve, the hydraulic steering cylinder piston is stretched out or regains deflecting roller is deflected into the expectation steering angle.
Further, in the step 102, if steering control device judges the outer corner measurement value of tractor steering wheel and be not less than described preset limit value, then the navigation control device sends the steering order error message, and Navigation Control Unit receives to return after the described error message and stops the self-navigation instruction.
Further, in the step 102, if the level signal that pressure switch sends shows the current manual steering state that is in, steering control device navigation control device sends and stops direction information, and Navigation Control Unit receives to return after the described information and stops the self-navigation instruction.
Wherein, hydraulic steering gear that makes electrohydraulic proportional directional valve or tractor by pressure-gradient control valve and the switching that turns to the oil cylinder oil circuit to be connected to realize between tractor self-steering and the manual steering.
Compared with prior art, the advantage of technical solution of the present invention is:
1,, made up a kind of tractor automatic navigation system of mechanical-electrical-hydraulic integration based on the hydro-steering tractor; Realize the tractor Navigation Control Unit and the steering controller of software and hardware integration from system construction and method for designing, and used the fieldbus method realization Navigation Control Unit of suitable farm working machinery and the real-time Communication for Power between the steering controller.
2, utilization electro-hydraulic proportional control technology, propose a kind of on hydro-steering tractor steering system-based and connect the method for electric-hydraulic proportion steering control system, design realizes electric-hydraulic proportion steering hydraulic mechanism and device, makes the Digital Control of tractor steering become possibility.
3, propose and realize, and support artificial steering operation shielding to turn to control automatically and based on the Navigation Control Unit and the steering controller synchronous operation function of steering pressure detection based on the tractor self-steering PID control method of real-time detection tractor steering wheel corner as feedback quantity.
4, propose and realize Navigation Control Unit method for designing based on software, design is based on the navigation PID control method of lateral deviation and realize that tractor is according to the default accurate operation in path.Simultaneously, Navigation Control Unit is supported tractor automatic navigation system core unit status self check and status monitoring function, and can carry out manual, the steady switching of operation room automatically of tractor steering according to system state.
Description of drawings
Fig. 1 is the structural drawing of an embodiment of the automatic navigation control system that is applicable to the hydro-steering tractor of the present invention;
Fig. 2 is the structural drawing of the automatic hydraulic knuckle section of tractor automatic navigation control system of the present invention;
Fig. 3 is the process flow diagram that the steering control device of tractor automatic navigation control system of the present invention is carried out steering order;
Fig. 4 is the process flow diagram that the Navigation Control Unit of tractor automatic navigation control system of the present invention is carried out Navigation Control.
1, data radio station antenna 2, RTK-GPS antenna 3, vehicle-mounted control computing machine 4, terminal box 5, steering controller 6, steering gear 7, pressure switch 8, pressure-gradient control valve 9, to turn to be oil supply system 10, turn to oil cylinder 11, accumulator 12, rotary angle transmitter 13, electronic pressure transmitter 14, electromagnetic switch valve 15, electrohydraulic proportional directional valve 16, valve block assembly 17, ground velocity radar 18, RTK-GPS receiver 19, data radio station
Embodiment
Below in conjunction with drawings and Examples, system and method for the present invention is described in further detail.Following examples are used to illustrate purpose of the present invention, but are not used for limiting scope of the present invention.
Be illustrated in figure 1 as the structural drawing of an embodiment of the automatic navigation control system that is applicable to the hydro-steering tractor of the present invention, it is made of Navigation Control Unit, steering control device and three parts of electric-hydraulic proportion steering actuator.
Navigation Control Unit mainly comprises: vehicle-mounted control computing machine 3, RTK-GPS receiver 18, RTK-GPS receiver antenna 2, data radio station 19, data radio station antenna 1, ground velocity radar 17.Store tractor navigation operation base map and operation in the vehicle-mounted control computing machine 3 navigation control program is arranged, navigation control program can generate the operation leading line that covers the entire job plot to reaching working width automatically according to the operator of operation plot on the operation base map and setting, also planning in other softwares or the operation leading line vector data of creating can be imported in the software as the operation leading line.Offset distance (abbreviation lateral deviation) between the locator data of the RTK-GPS that navigation control program calculating receives in real time and the operation leading line (operation navigation target) of storage or generation, ground velocity radar 17 is measured the real time running velocity amplitude that obtains tractor, with the lateral deviation that calculates in the current control cycle input quantity as navigation control program, calculate the steering angle of tractor steering wheel in real time according to pid control algorithm, with it as the controlled target in the current control cycle, and by the communications protocol that customizes, controlled target is converted to steering order sends to steering controller, finish the Navigation Control process of a control cycle.
Steering control device mainly comprises: based on the steering controller 5 of microprocessor, (its in operation turn to PID control program), tractor steering wheel rotary angle transmitter 12 and and vehicle-mounted control computing machine 3, electrohydraulic proportional directional valve 15 etc. partly constitute.Steering controller 5 receive that vehicle-mounted control computing machine 3 sends turn to steering order after, operation turns to the corner PID control program in the control program, compare with the target rotation angle of deflecting roller with by rotary angle transmitter 12 real-time detected front-wheel actual rotational angles, and according to pid control algorithm, output can directly drive the pwm control signal of electro-hydraulic proportional valve 15, the flow and the direction of control electrohydraulic proportional directional valve 15, and then the driving hydraulic steering mechanism rotates according to predetermined direction.
The electric-hydraulic proportion steering actuator mainly comprises: tractor steering device oil supply system 9, electrohydraulic proportional directional valve 15, electromagnetic switch valve 14, pressure-gradient control valve 8, pressure switch 7, Closed Hydraulic steering gear 6 and turn to oil cylinder 10.Wherein, Hydraulic Elements such as electrohydraulic proportional directional valve 15, electromagnetic switch valve 14, pressure switch 7 connect by the valve piece, and in parallel with the oil circuit of tractor hydraulic steering gear 6 by fluid pressure line.Described electric-hydraulic proportion steering actuator responds described pwm control signal, control the fluid flow direction and the flow velocity of tractor steering system by the spool aperture of electrohydraulic proportional directional valve 15, the hydraulic steering cylinder piston is stretched out or regain deflecting roller being deflected into described target steering angle, thereby realize the tractor self-steering function.In addition, by pressure-gradient control valve 8 and electromagnetic switch valve 14 described electrohydraulic proportional directional valve 15 or hydraulic steering gear 6 are connected with the oil circuit that turns to oil cylinder 10 realize turn to automatically and manual steering between freely switch, and guarantee the right of priority of any moment manual steering function.Simultaneously, when the tractor self-steering control function lost efficacy, support artificial steering wheel rotation to realize pilot steering.
Figure 2 shows that by above-mentioned truck-mounted computer 3, steering controller 5, pressure-gradient control valve 8, electrohydraulic proportional directional valve 15, electromagnetic switch valve 14, hydraulic steering gear 6, turn to oil cylinder 10, steering angle sensor 12, turn to the structural drawing of the automatic hydraulic knuckle section that is the native system that constitutes of oil supply system 9 and pressure switch 7.The present invention is on the steering of hydro-steering tractor and meet the electrohydraulic proportional directional valve system, when the hydraulic circuit by pressure-gradient control valve 8 control steering is entered when turning to oil cylinder 10 by electrohydraulic proportional directional valve 15, just can realize tractor steering system and deflecting roller are expected the Digital Control of corner by steering controller 5.
Particularly, as shown in Figure 2, the pressure sensitive mouth LS of pressure-gradient control valve 8 and the control mouth of tractor steering device 6 are connected, the CF mouth is connected with pressure switch 7 with the steering gear oil-in, and the EF mouth is connected with the oil-in of electrohydraulic proportional directional valve 15.When system pressure foundation and when steering gear 6 is not worked, the CF mouth of pressure-gradient control valve 8 is in closed state, this moment, the pressure of LS mouth was zero, the oil-feed of spool right-hand member, action of hydraulic force is at the spool right-hand member, overcome the precompression of valve core spring, spool is moved to the left, this moment, the P mouth was communicated with the EF mouth, the pressure oil that tractor steering device oil supply system 9 pumps flows to electrohydraulic proportional directional valve 15, make electrohydraulic proportional directional valve 15 be communicated with the oil circuit that turns to oil cylinder 10, this moment, the tractor self-steering function was effective, can be by electromagnetic switch valve 14 being powered up and the Digital Control of electrohydraulic proportional directional valve 15 being realized real-time control to the rotation direction and the angle of deflecting roller.When steering gear 6 work, when just being in manual operation state, the pressure sensitive mouth LS of pressure-gradient control valve 8 makes the P mouth be communicated with the CF mouth under the effect of pressure oil, at this moment, steering gear 6 is communicated with the oil circuit that turns to oil cylinder 10, the pressure oil that steering oil pump 9 pumps enters by pressure-gradient control valve 8 and steering gear 6 and turns to oil cylinder 10, makes tractor steering.
Figure 3 shows that steering controller 5 carries out the process flow diagram that turns to steering order of truck-mounted computers 3, as shown in FIG., at first to CAN bus, each state parameter relevant of steering controller 5 with turn to and control pid parameter and carry out initialization with turning to control; Then the state that turns to the steering angle sensor 12 in the closed-loop control system is detected, read its current measured value, judge whether this value surpasses the ultimate value of default (this ultimate value is taken turns from in-line position to the left-hand rotation dead point according to tractor steering and the maximum deflection angle at right-hand rotation dead point is decided), if the value of overstepping the extreme limit, then send the steering order error message to the CAN bus, after Navigation Control Unit is accepted and is resolved to this error message, stop immediately sending and turn to control messages, and, remind the user to detect the state of rotary angle transmitter 12 by the error message of human-computer interaction interface angles of display sensor value; If the detected value (less than this ultimate value) in normal range that steering angle sensor 12 is current, be that message sends on the CAN bus with this detected value according to the ISO11783 protocol conversion then, Navigation Control Unit should value show by man-machine interface after receiving this message; Simultaneously, steering controller 5 receives the control messages that turns to that Navigation Control Unit mails to bus in real time, and read the status information of the pressure switch 7 that indicates human pilot manual steering operation, if being in, the current system of pressure switch 7 signs turns to state of a control automatically, steering controller 5 powers up to electromagnetic switch valve 14 and makes it be in closed condition, and the electric-hydraulic proportion steering actuator begins build-up pressure; Simultaneously, steering controller 5 calls and turns to the PID control program, the PID control program is in the corner value of current detection relatively with after turning to expectation corner value in the control messages, the corner difference is carried out the linear adjustment of PID, calculate the PWM dutycycle, the spool aperture of control electrohydraulic proportional directional valve 15 is come control system fluid flow direction and flow velocity, the piston of hydraulic steering cylinder 10 is stretched out or get the control deflecting roller back to deflect into desired locations and realize tractor self-steering, thereby finish the control action of one-period; When steering controller 5 receive that Navigation Control Unit sends stop to turn to message the time, 14 outages of control electromagnetic switch valve make its conducting, electrohydraulic proportional directional valve 15 outages are controlled in the off-load of electric-hydraulic proportion automatic steering system simultaneously, stop to turn to automatically; If when steering controller 5 is in automatic steering state, need artificial steering wheel rotation, then the pressure oil circuit is switched to steering gear 6 by pressure-gradient control valve 8, the oil circuit of electrohydraulic proportional directional valve 15 is cut off, and pressure oil liquid supplies to the steering gear oil circuit, realizes manual steering; Meanwhile, pressure switch 7 produces low level, steering controller 5 gives electromagnetic switch valve 14 outages after receiving the level signal of pressure switch 7, make electromagnetic switch valve be in conducting state, and 15 outages of control electrohydraulic proportional directional valve, transmission simultaneously stops to turn to control messages to Navigation Control Unit automatically.
Figure 4 shows that the process flow diagram of Navigation Control Unit execution Navigation Control, as shown in FIG., after Navigation Control Unit starts, at first carry out initialization procedure, mainly finish initialization CAN bus and set up the CAN communication and connect, set up work such as correlation behavior parameter such as RTK-GPS communication connection, initialization Navigation Control Unit control cycle, pid parameter; After initialization procedure is finished, Navigation Control Unit begins to detect the key sensor (comprising rotary angle transmitter 12 and RTK-GPS18) of whole automatic navigation control system and the duty of steering controller 5, if arbitrary parts can't operate as normal, Navigation Control Unit all will write down its state parameter, and the mode of relevant information with literal and audible alarm is reflected in the human-computer interaction interface of vehicle-mounted control computing machine 3 according to the classification of different parts and abnomal condition, obtain handling and operate as normal up to relevant abnomal condition, otherwise Navigation Control Unit is not carried out the self-navigation operation; If System self-test passes through, the user can interactive operation begin the tractor automatic navigation operation, at first by picking up on the Navigation Control Unit software operation base map an effective navigation target or the modes such as mode by definition operation direction generate an operation navigation target, Navigation Control Unit moves the self-navigation process according to the control cycle and the corresponding pid parameter of initializing set then: read the latitude and longitude coordinates value of GPS current location and be converted to planimetric coordinates, current location and the distance between the navigation target, i.e. transversal discrepancy that calculating is represented with planimetric coordinates; Start lateral deviation PID control program, calculate the corner controlled quentity controlled variable of tractor steering wheel in the current control cycle, and the corner controlled quentity controlled variable is converted to turns to control messages, mail to steering controller 5, carry out the control procedure that turns to shown in Fig. 3 flow process by steering controller 5, thereby finish the Navigation Control process one time, write down related datas such as the interior GPS longitude of this control cycle, latitude, UTC time, course, corner, controlled quentity controlled variable simultaneously.Navigation Control Unit is after System self-test and state are normal, can start the status monitoring process of a steering controller 5 simultaneously, be used for monitoring in real time the state of manual steering sensor (pressure switch 7) and the duty of rotary angle transmitter 12, when the signal condition that has that monitors pressure switch 7 at any time, just the manual direction of operating dish of driver the time, Navigation Control Unit stops the self-navigation process at once, stop to turn to control messages to the steering controller transmission, the outage of steering controller control electromagnetic switch valve, electromagnetic switch valve is in conducting state, automatic steering system is in unloading condition, the outage of the electrohydraulic proportional directional valve of steering controller control simultaneously, the hydrostatic control automatic steering system quits work, and tractor is in the manual steering mode of operation.When the steering controller observation process monitor corner value that rotary angle transmitter measures unusual after, stop equally sending and turn to control messages to steering controller, make tractor hydraulic control automatic steering system quit work, be in the manual steering mode of operation.
The present invention is with tractor operation Navigation Control, turn to control to be combined into a complete system automatically, realize that tractor is according to the accurate operation of setting of operation route, and shielding turns to control function automatically under the situation of artificial steering operation intervention, and the assurance system can safety work.Hydro-steering tractor automatic navigation of the present invention system can guarantee that tractor precisely stablizes operation according to preset path, effectively reduce overlapping and omission between the operation ridge of farmland in the complex line operation process, significantly improve operation quality and efficient, and can alleviate the labour intensity of operation human pilot.The tractor automatic navigation system relies on the GPS of energy all weather operations as main location navigation sensor, therefore also can effectively prolong the activity duration of tractor operation unit.
Above embodiment only is used to illustrate the present invention; and be not limitation of the present invention; the those of ordinary skill in relevant technologies field; under the situation that does not break away from the spirit and scope of the present invention; can also make various variations and modification; therefore all technical schemes that are equal to also belong to category of the present invention, and scope of patent protection of the present invention should be defined by the claims.

Claims (5)

1. a tractor automatic navigation control system is characterized in that, comprising:
Navigation Control Unit, receive in real time the GPS locator data and calculate the tractor current location and the operation navigation target between lateral deviation, calculate the target rotation angle of deflecting roller in the current control cycle and be converted into according to described lateral deviation and the tractor travel speed value measured in real time and send to steering control device after turning to steering order, and, when the steering order error message that receives steering control device, send the detection false command or stop automatic steering order to it;
Steering control device, whether the outer corner measurement value of judging the tractor steering wheel is less than preset limit value, if, then described target rotation angle value and measured value are compared, calculate the PWM dutycycle according to the corner difference, and drive the pwm control signal of electric-hydraulic proportion steering actuator according to described dutycycle output; Otherwise, send the steering order error message to described Navigation Control Unit;
The electric-hydraulic proportion steering actuator, respond described pwm control signal, control the fluid flow direction and the flow velocity of tractor steering system by the spool aperture of electrohydraulic proportional directional valve, the hydraulic steering cylinder piston is stretched out or regain deflecting roller is deflected into described target steering angle; Perhaps, response is described stops automatic steering order and makes electromagnetic switch valve outage.
2. tractor automatic navigation control system as claimed in claim 1 is characterized in that, realizes the transmission of information and instruction between described Navigation Control Unit and the described steering control device by the CAN bus.
3. tractor automatic navigation control system as claimed in claim 1 is characterized in that, described Navigation Control Unit comprises:
RTK-GPS is used to obtain the latitude and longitude coordinates value of tractor current location,
The ground velocity radar is used to measure the current travel speed value of tractor.
4. tractor automatic navigation control system as claimed in claim 1 is characterized in that described steering control device comprises the steering wheel angle sensor, is used to measure the corner value of tractor when steering front wheel.
5. the arbitrary described tractor automatic navigation control system of utilization such as claim 1~4 carries out the method for self-navigation control, it is characterized in that, may further comprise the steps:
S101: Navigation Control Unit receive the GPS locator data in real time and calculate the tractor current location and the operation navigation target between lateral deviation, calculate the target rotation angle of deflecting roller in the current control cycle according to pid control algorithm and be converted into according to described lateral deviation and the tractor travel speed value measured in real time and send to steering control device after turning to steering order;
S102: steering control device judges that whether the outer corner measurement value of tractor steering wheel is less than preset limit value, if, then read the level signal of pressure switch transmission and judge the current automatic steering state that whether is in, otherwise, the navigation control device sends the steering order error message, and Navigation Control Unit receives to return after the described error message and stops the self-navigation instruction;
If the level signal that pressure switch sends shows the current automatic steering state that is in, then enter next step, otherwise steering control device navigation control device sends and to stop direction information, Navigation Control Unit receive described stop to return behind the direction information stop the self-navigation instruction;
S103: steering control device compares described target rotation angle value and measured value, calculates the PWM dutycycle according to the corner difference according to pid control algorithm, and output drives the pwm control signal of electric-hydraulic proportion steering gear;
S104: the electric-hydraulic proportion steering actuator responds described pwm control signal and controls the fluid flow direction and the flow velocity of tractor steering system by the spool aperture of electrohydraulic proportional directional valve, the hydraulic steering cylinder piston is stretched out or regains deflecting roller is deflected into the expectation steering angle.
CN2010101499343A 2010-02-09 2010-04-19 Tractor automatic navigation control system and method thereof Active CN101833334B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2010101499343A CN101833334B (en) 2010-02-09 2010-04-19 Tractor automatic navigation control system and method thereof

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN201010110685 2010-02-09
CN201010110685.7 2010-02-09
CN2010101499343A CN101833334B (en) 2010-02-09 2010-04-19 Tractor automatic navigation control system and method thereof

Publications (2)

Publication Number Publication Date
CN101833334A CN101833334A (en) 2010-09-15
CN101833334B true CN101833334B (en) 2011-09-21

Family

ID=42717428

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2010101499343A Active CN101833334B (en) 2010-02-09 2010-04-19 Tractor automatic navigation control system and method thereof

Country Status (1)

Country Link
CN (1) CN101833334B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI584093B (en) * 2015-06-18 2017-05-21 Sharp Kk A self-propelled electronic machine and a walking method of the self-propelled electronic machine

Families Citing this family (45)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102094855B (en) * 2010-12-28 2013-07-24 徐州重型机械有限公司 Wheel type engineering machinery hydraulic control system and wheeled crane applying same
CN102323824B (en) * 2011-07-06 2013-10-16 李华 Satellite navigated self-walking control system of agricultural machinery and control method thereof
CN102393742B (en) * 2011-08-31 2014-05-28 中国农业大学 Wheel-type intelligent transport vehicle applied to protected agriculture
CN102368158B (en) * 2011-09-15 2013-04-10 西北农林科技大学 Navigation positioning method of orchard machine
US9778659B2 (en) * 2012-09-10 2017-10-03 Trimble Inc. Agricultural autopilot steering compensation
CN103895698B (en) * 2012-12-27 2015-12-23 中国科学院沈阳自动化研究所 Fluid pressure type agricultural machinery automatic steering control device and control method
CN103914066B (en) * 2012-12-28 2016-12-28 中国科学院沈阳自动化研究所 Agricultural machinery self-navigation controller and control method thereof
CN103247213B (en) * 2013-03-13 2015-04-15 北京农业智能装备技术研究中心 Tractor automatic navigation experiment table
CN103196441A (en) * 2013-03-19 2013-07-10 江苏大学 Spraying machine integrated navigation method and system of
CN103404379B (en) * 2013-07-30 2015-07-15 西北农林科技大学 Self-propelled intelligent flower thinning machine for orchard
CN103425131B (en) * 2013-08-15 2015-12-23 江苏大学 Based on the farm tractor navigation control method of nonsmooth control and disturbance observation
KR102107556B1 (en) * 2014-02-06 2020-05-07 얀마 가부시키가이샤 Parallel travel work system
JP5667731B1 (en) * 2014-03-06 2015-02-12 ジオサーフ株式会社 Field guidance system, field guidance method, software, and storage medium storing software
CN103914071B (en) * 2014-04-02 2017-08-29 中国农业大学 A kind of vision guided navigation path identifying system for grain combine
CN104192203B (en) * 2014-08-04 2017-04-26 北京农业信息技术研究中心 Automatic steering method and device
CN104678999B (en) * 2014-12-15 2023-04-28 刘丙炎 Intelligent tractor
CN104731105A (en) * 2015-01-21 2015-06-24 广州中海达定位技术有限公司 Navigation device and method for enabling agricultural machine to enter preset path based on Smart Heading
CN104777841A (en) * 2015-05-06 2015-07-15 聊城大学 Tractor automatic navigation lower computer control system and method
CN105523083B (en) * 2015-12-23 2017-10-27 广州中海达卫星导航技术股份有限公司 The automatic calibrating method and system of a kind of agricultural machinery automated driving system
CN106585533A (en) * 2016-11-30 2017-04-26 广西壮族自治区都安瑶族自治县科学技术情报研究所 Distance control system of agricultural tractor
CN106647748A (en) * 2016-11-30 2017-05-10 山东省农业机械科学研究院 Maize harvesting machine mechanical contact navigation control system and navigation method thereof
CN106502252B (en) * 2016-12-05 2024-02-02 山东双力现代农业装备有限公司 Control method of multi-sensor fusion tractor navigation control system
CN106647770A (en) * 2017-01-22 2017-05-10 无锡卡尔曼导航技术有限公司 Field turning path planning and control method used for farm machinery driverless driving
CN107087257A (en) * 2017-04-11 2017-08-22 武汉光谷西铂科技有限公司 A kind of travel direction control method based on RTK
CN107329424B (en) * 2017-06-29 2020-10-09 华南农业大学 Automatic and manual mode switching device of agricultural machine, control method of automatic and manual mode switching device and agricultural machine
CN107662639A (en) * 2017-08-24 2018-02-06 芜湖中意液压科技股份有限责任公司 Tractor hydraulic steering
CN107918388A (en) * 2017-11-08 2018-04-17 深圳市招科智控科技有限公司 Harbour container carries unmanned vehicle method for controlling trajectory and device
CN107651007A (en) * 2017-11-09 2018-02-02 山东农业大学 The electromechanical liquid control system and method for a kind of mulberry field fluid-link steering mini-tiller
CN107972732A (en) * 2017-12-04 2018-05-01 安徽农业大学 A kind of unmanned rice transplanter automatic steering control system and its control method
JP7089965B2 (en) * 2018-07-11 2022-06-23 株式会社クボタ Work vehicle
CN109082977A (en) * 2018-09-27 2018-12-25 湖南中大机械制造有限责任公司 A kind of autosteerer for unmanned road roller
CN109656257B (en) * 2019-02-22 2024-01-05 山东交通学院 Unmanned vehicle control system and method for closed park
CN110745176A (en) * 2019-10-28 2020-02-04 徐工集团工程机械股份有限公司科技分公司 Safety type handle steering control system and control method for loader
US11429114B2 (en) * 2020-02-14 2022-08-30 Deere & Company Implement control of vehicle and implement combination
CN111208832A (en) * 2020-02-25 2020-05-29 深圳冰河导航科技有限公司 Implementation method for optimizing control effect of automatic pilot through speed coefficient
CN111674221B (en) * 2020-06-23 2023-05-12 山东交通学院 Walking control method of tractor traction type solar panel cleaning machine
CN112214014A (en) * 2020-09-04 2021-01-12 东北石油大学 Automatic driving control method and system for agricultural machinery
CN111943091B (en) * 2020-09-18 2023-12-22 安徽合力股份有限公司 Control method for hydraulic steering of forklift and hydraulic steering system
CN112526986B (en) * 2020-10-28 2022-11-22 苏州极目机器人科技有限公司 Ridge-following operation method and device
CN112298347A (en) * 2020-11-09 2021-02-02 江苏悦达集团有限公司 Automatic steering system
CN112298348A (en) * 2020-11-09 2021-02-02 江苏悦达集团有限公司 Automatic steering system and control method thereof
CN113589815A (en) * 2021-08-02 2021-11-02 华中农业大学 Straw rotary burying and returning navigation system based on variable-gain single neuron PID
CN114485680A (en) * 2021-08-10 2022-05-13 华中农业大学 Design and test method of straw rotary burying returning navigation system
CN114051781B (en) * 2021-12-07 2023-04-07 清博(昆山)智能科技有限公司 Intelligent navigation system for cooperative operation agricultural mechanical equipment
JP2024062709A (en) * 2022-10-25 2024-05-10 株式会社小松製作所 Work machine and method for controlling a work machine

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1825061A (en) * 2006-03-27 2006-08-30 北京瑞图万方科技有限公司 Navigation steering signal indicating method and apparatus
CN101221447A (en) * 2008-01-18 2008-07-16 中国农业大学 Mechanical automatic steering control method
CN101592957A (en) * 2009-06-23 2009-12-02 北京市农林科学院 A kind of auxiliary linear tracking control system for operation of distributed agricultural machine

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7065440B2 (en) * 2004-01-22 2006-06-20 Trimble Navigation, Ltd Method and apparatus for steering movable object by using control algorithm that takes into account the difference between the nominal and optimum positions of navigation antenna
US8060299B2 (en) * 2007-02-28 2011-11-15 Caterpillar Inc. Machine with automated steering system
CN100504694C (en) * 2007-07-04 2009-06-24 华南农业大学 Navigation control method for agricultural machinery
JP2009245002A (en) * 2008-03-28 2009-10-22 Kubota Corp Travel controller for working vehicle

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1825061A (en) * 2006-03-27 2006-08-30 北京瑞图万方科技有限公司 Navigation steering signal indicating method and apparatus
CN101221447A (en) * 2008-01-18 2008-07-16 中国农业大学 Mechanical automatic steering control method
CN101592957A (en) * 2009-06-23 2009-12-02 北京市农林科学院 A kind of auxiliary linear tracking control system for operation of distributed agricultural machine

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
马军等.汽车驾驶员自适应模糊PID控制模型.《自动控制与检测》.2007,第2007卷(第02期),全文. *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI584093B (en) * 2015-06-18 2017-05-21 Sharp Kk A self-propelled electronic machine and a walking method of the self-propelled electronic machine

Also Published As

Publication number Publication date
CN101833334A (en) 2010-09-15

Similar Documents

Publication Publication Date Title
CN101833334B (en) Tractor automatic navigation control system and method thereof
CN101774398B (en) Manual priority tractor self-steering method and device
CN201592732U (en) Automatically steering device of tractor preferring manual operation
CN108797669A (en) A kind of autonomous 3D excavations construction robot
CN100557150C (en) Electromechanical integrated excavator and control method
CN102535852B (en) Operating and controlling system and method of mechanical arm, and engineering machinery
CN110168466A (en) Intelligent mowing system
CN110488598A (en) Air-ground amphibious unmanned vehicle control
CN103148057B (en) A kind of method, apparatus and system that multi-joint hydraulic press mechanical arm is controlled
CN101592957B (en) Auxiliary linear tracking control system for operation of distributed agricultural machine
CN112942461B (en) Land leveler and dust fall control method of land leveler
CN105137997A (en) Automatic driving system and method of water conservancy construction vibration roller
CN105629973B (en) A kind of method and device of the agricultural machinery straight-line travelling based on RTK technology
CN106737693B (en) Transplanting robot control system and control method based on GPS and inertial navigation
CN206696705U (en) The vehicle-mounted navigation controller of agricultural machinery based on fuzzy control
CN103472837A (en) Fast sprint controller of two-wheel micro-mouse based on double processors
CN107522114A (en) Automate front handling mobile crane
CN105022399A (en) Operation mechanism-improved ground following agricultural machinery control system
CN104192203A (en) Automatic steering method and device
CN114527727B (en) Self-propelled boom sprayer and unmanned control system and method thereof
CN112411663B (en) Control method and control device for excavator and excavator
CN2900632Y (en) Electromechanical integrated digging machine
US12004504B2 (en) Systems and methods for controlling a nozzle assembly of an agricultural applicator
EP3916161B1 (en) Work machine
CN103472838A (en) Fast sprint controller of four-wheel micro-mouse based on double processors

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant