CN108334083A - A kind of automated driving system based on farm implements position - Google Patents

A kind of automated driving system based on farm implements position Download PDF

Info

Publication number
CN108334083A
CN108334083A CN201810053392.6A CN201810053392A CN108334083A CN 108334083 A CN108334083 A CN 108334083A CN 201810053392 A CN201810053392 A CN 201810053392A CN 108334083 A CN108334083 A CN 108334083A
Authority
CN
China
Prior art keywords
farm implements
agricultural machinery
control
control module
automated driving
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.)
Pending
Application number
CN201810053392.6A
Other languages
Chinese (zh)
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.)
Heilongjiang Huida Technology Development Co., Ltd.
Original Assignee
Shanghai Wantin Information Technology Center
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 Shanghai Wantin Information Technology Center filed Critical Shanghai Wantin Information Technology Center
Priority to CN201810053392.6A priority Critical patent/CN108334083A/en
Publication of CN108334083A publication Critical patent/CN108334083A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

Include RTK global position systems, control system and interactive system on agricultural machinery the invention discloses a kind of automated driving system based on farm implements position;The RTK global position systems include difference base station, radio station and GPS receiver;The control system includes control module, solenoid valve and the angular transducer on front-wheel;Interactive system, including navigation terminal;Navigation terminal is connected to control module.The automated driving system reasonable design based on farm implements position of the present invention, it is simple and compact for structure;Utilize two antennas, the exact position of an antenna measurement agricultural machinery, the exact position of an antenna measurement farm implements;The data of two antennas are merged with the output information of gyroscope, obtain accurate farm implements position and posture;Using the control algolithm after amendment, the position for farm implements and posture are calculated as control instruction, and control agricultural machinery turns to.

Description

A kind of automated driving system based on farm implements position
Technical field
The present invention relates to a kind of automated driving system, specifically a kind of automated driving system based on farm implements position.
Background technology
Existing agricultural machinery automated driving system, generally by navigation system, Machinery Control System, man-machine interactive system three parts It constitutes, navigation system is positioned using RTK high-precisions BD/GPS, and combined high precision gyroscope is combined navigation;Mechanical course For system according to the information of navigation system, corresponding course changing control is done in control machinery part;Man-machine interactive system is then that agricultural machinery operates Member provides an interactive interface, and system is made to work according to the requirement of operator.It, usually all can be advance when agricultural machinery automatic Pilot The track of a traveling is defined, control system controls agricultural machinery traveling on the track so that the lateral error of agricultural machinery and score XTEt and heading angle deviation Ψ t are 0.Existing agricultural machinery automated driving system is taken the air line as the main purpose with controlling agricultural machinery, needle This to trifilar suspension hardwired mode reaches preferable effect it is estimated that the central point of farm implements is controlled.But It is the farm implements for towed, in ground injustice and clinoform, it occur frequently that there are deviations between farm implements and agricultural machinery Situation so that agricultural machinery is walked on track, but farm implements are but not on line, and actual operation effectiveness is poor.Therefore, this hair It is bright that a kind of automated driving system based on farm implements position is provided.
Invention content
The purpose of the present invention is to provide a kind of automated driving systems based on farm implements position, to solve above-mentioned background technology The problem of middle proposition.
To achieve the above object, the present invention provides the following technical solutions:
A kind of automated driving system based on farm implements position includes RTK global position systems, control system on agricultural machinery And interactive system;
The RTK global position systems include difference base station, radio station and GPS receiver;Difference base station and GPS receiver pass through electricity Platform communicates to connect;The GPS receiver is connect with two antennas, and an antenna is set on agricultural machinery, for measuring the accurate of agricultural machinery Position, another antenna are equipped at the center of farm implements, the exact position for measuring farm implements;RTK global position systems, being used for will High-precision agricultural machinery is exported with farm implements location information to control system;
The control system includes control module, solenoid valve and the angular transducer on front-wheel;GPS receiver, electromagnetism Valve and angular transducer are connected to control module;Built-in gyroscope in the control module;
Angular transducer, the corner for detecting front-wheel, and corner information is transferred to control module;
Solenoid valve, for controlling front-wheel steer;
Control module, the corner information of location information and front-wheel for receiving farm implements and agricultural machinery determine farm implements, agricultural machinery Position information is merged with the output information of gyroscope, obtains accurate farm implements position and posture;Simultaneously by gyroscope with lead Boat terminal is combined navigation, calculates corresponding control signal, sends a signal to the control of solenoid valve and angular transducer Backfeed loop, control agricultural machinery turn to;
Interactive system, including navigation terminal;Navigation terminal is connected to control module.
As a further solution of the present invention:The navigation terminal is equipped with 4G modules, by 4G modules and remote platform into Row interaction, carries out the interaction of job information.
As a further solution of the present invention:The navigation terminal is equipped with operation interface, by current system working condition It is shown to operator, the input of operator is converted to controllable instruction, is sent to control system.
Compared with prior art, the beneficial effects of the invention are as follows:
The automated driving system reasonable design based on farm implements position of the present invention, it is simple and compact for structure;Using two antennas, one The exact position of antenna measurement agricultural machinery, the exact position of an antenna measurement farm implements;By the data of two antennas and gyroscope Output information is merged, and accurate farm implements position and posture are obtained;Using the control algolithm after amendment, for the position of farm implements It sets and posture, is calculated as control instruction, control agricultural machinery turns to.
Description of the drawings
Fig. 1 is the assembling structure front view of agricultural machinery, farm implements and automated driving system.
Fig. 2 is the assembling structure right view of agricultural machinery, farm implements and automated driving system.
Fig. 3 is the assembling structure schematic diagram in slope agricultural machinery, farm implements and automated driving system when driving.
Fig. 4 is the structural schematic diagram of the automated driving system based on farm implements position.
Fig. 5 is the schematic diagram of the automated driving system based on farm implements position.
Wherein:1- agricultural machinery;2- control modules;3- difference base stations;The radio station 4-;5-GPS receivers;6- navigation terminals;7- electricity Magnet valve;8- front-wheels;9- angular transducers;10- farm implements;11- antennas;12- target travel path lines;13- fresh target driving traces Line.
Specific implementation mode
The technical solution of this patent is described in more detail With reference to embodiment.
- 5 are please referred to Fig.1, a kind of automated driving system based on farm implements position includes the RTK satellites on agricultural machinery 1 Positioning system, control system and interactive system;
The RTK global position systems include difference base station 3, radio station 4 and GPS receiver 5;Difference base station 3 and GPS receiver 5 It is communicated to connect by radio station 4;The GPS receiver 5 is connect with two antennas 11, supports the positioning of two antennas 11, a day Line 11 is set on agricultural machinery 1, the exact position for measuring agricultural machinery, another antenna 11 is equipped at the center of farm implements 10, for surveying Measure the exact position of farm implements;RTK global position systems give control system for exporting high-precision agricultural machinery and farm implements location information System;
The control system includes control module 2, solenoid valve 7 and the angular transducer 9 on front-wheel 8;GPS receiver 5, Solenoid valve 7 and angular transducer 9 are connected to control module 2;Built-in gyroscope in the control module 2;
Angular transducer 9, the corner for detecting front-wheel 8, and corner information is transferred to control module 2;
Solenoid valve 7, for controlling front-wheel steer;
Control module 2, the corner information of location information and front-wheel 8 for receiving farm implements and agricultural machinery, by farm implements, agricultural machinery Location information is merged with the output information of gyroscope by Kalman filtering algorithm, and accurate farm implements position and appearance are obtained State;Pass through 2 goal-selling driving trace line of control module;Navigation is combined by gyroscope and navigation terminal 6 simultaneously, is calculated Go out corresponding control signal, send a signal to the control backfeed loop of solenoid valve 7 and angular transducer 9, control agricultural machinery turns to;
Antenna on agricultural machinery 1 is walked along target travel path line 12, and control module 2 is measured by farm implements location information on farm implements Antenna and target travel path line between lateral error XTEi, control module 2 measured by agricultural machinery location information on agricultural machinery Antenna and target travel path line between lateral error XTEt, the difference of the lateral error between agricultural machinery and farm implements is calculated Value:ΔXTE=XTEi-XTEt;2 control targe driving trace line 12 of control module is horizontal to the direction opposite with farm implements offset direction To mobile Δ XTE, fresh target traveling path line 13 is obtained, and control module 2 controls agricultural machinery and turns to tracking target travel track Line 13 makes farm implements walk in target travel path line;
Interactive system, including navigation terminal 6;Navigation terminal 6 is connected to control module 2;Navigation terminal 6 has 4G modules, can be with It is interacted with remote platform, carries out the interaction of job information;Navigation terminal 6 provides operation interface, and current system is worked Situation is shown to operator, and the input of operator is converted to controllable instruction, is sent to control system.
Mainly improved part is the present invention:1)Using two antennas, the exact position of an antenna measurement agricultural machinery, one The exact position of a antenna measurement farm implements;The data of two antennas are merged with the output information of gyroscope, are obtained accurate Farm implements position and posture;2)Control algolithm after amendment, the position for farm implements and posture, are calculated as control instruction, control Agricultural machinery processed turns to.
The better embodiment of this patent is explained in detail above, but this patent is not limited to above-mentioned embodiment party Formula, one skilled in the relevant art within the scope of knowledge, can also be under the premise of not departing from this patent objective Various changes can be made.

Claims (3)

1. a kind of automated driving system based on farm implements position, which is characterized in that including being mounted on agricultural machinery(1)On RTK satellites Positioning system, control system and interactive system;
The RTK global position systems include difference base station(3), radio station(4)And GPS receiver(5);Difference base station(3)And GPS Receiver(5)Pass through radio station(4)Communication connection;The GPS receiver(5)It is connect with two antennas, an antenna is set to agricultural machinery (1)On, the exact position for measuring agricultural machinery, another antenna is equipped at the center of farm implements, the accurate position for measuring farm implements It sets;RTK global position systems, for exporting high-precision agricultural machinery and farm implements location information to control system;
The control system includes control module(2), solenoid valve(7)With mounted on front-wheel(8)On angular transducer(9);GPS Receiver(5), solenoid valve(7)And angular transducer(9)It is connected to control module(2);The control module(2)In built-in top Spiral shell instrument;
Angular transducer(9), for detecting front-wheel(8)Corner, and corner information is transferred to control module(2);
Solenoid valve(7), for controlling front-wheel steer;
Control module(2), the location information for receiving farm implements and agricultural machinery and front-wheel(8)Corner information, by farm implements, agriculture The location information of machine is merged with the output information of gyroscope, obtains accurate farm implements position and posture;Pass through gyro simultaneously Instrument and navigation terminal(6)It is combined navigation, corresponding control signal is calculated, sends a signal to solenoid valve(7)And angle Sensor(9)Control backfeed loop, control agricultural machinery turn to;
Interactive system, including navigation terminal(6);Navigation terminal(6)It is connected to control module(2).
2. the automated driving system according to claim 1 based on farm implements position, which is characterized in that the navigation terminal (6)Equipped with 4G modules, is interacted with remote platform by 4G modules, carry out the interaction of job information.
3. the automated driving system according to claim 1 based on farm implements position, which is characterized in that the navigation terminal (6)Equipped with operation interface, current system working condition is shown to operator, the input of operator is converted to controllable finger It enables, is sent to control system.
CN201810053392.6A 2018-01-19 2018-01-19 A kind of automated driving system based on farm implements position Pending CN108334083A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810053392.6A CN108334083A (en) 2018-01-19 2018-01-19 A kind of automated driving system based on farm implements position

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810053392.6A CN108334083A (en) 2018-01-19 2018-01-19 A kind of automated driving system based on farm implements position

Publications (1)

Publication Number Publication Date
CN108334083A true CN108334083A (en) 2018-07-27

Family

ID=62925301

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810053392.6A Pending CN108334083A (en) 2018-01-19 2018-01-19 A kind of automated driving system based on farm implements position

Country Status (1)

Country Link
CN (1) CN108334083A (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108958260A (en) * 2018-07-30 2018-12-07 黑龙江惠达科技发展有限公司 A kind of agricultural machinery automated driving system based on farm implements position
CN109540535A (en) * 2018-12-11 2019-03-29 安徽江淮汽车集团股份有限公司 A kind of APS test macro
CN111058447A (en) * 2019-12-27 2020-04-24 福建建中建设科技有限责任公司 Automatic position finding method and system for pile press
CN111412886A (en) * 2020-03-12 2020-07-14 深圳冰河导航科技有限公司 Detection method and detection system
CN112114342A (en) * 2019-06-19 2020-12-22 丰疆智能科技研究院(常州)有限公司 Monitoring system and monitoring method for agricultural machinery
CN112213116A (en) * 2020-09-30 2021-01-12 江苏艾威机械制造有限公司 Agricultural machine test bed and control method thereof

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011136886A1 (en) * 2010-04-28 2011-11-03 Navcom Technology, Inc. System and method for determining the heading angle of a vehicle
CN204650278U (en) * 2015-06-02 2015-09-16 浙江联辉智能科技有限公司 Big Dipper agricultural machinery self-navigation Ride Control System
CN105509740A (en) * 2015-12-31 2016-04-20 广州中海达卫星导航技术股份有限公司 Measuring method and module for attitude of agriculture machinery vehicle
CN105629973A (en) * 2015-12-18 2016-06-01 广州中海达卫星导航技术股份有限公司 RTK technology-based agricultural machinery straight driving method and RTK technology-based agricultural machinery straight driving device
CN205561808U (en) * 2016-04-22 2016-09-07 徐州斯塬农科网络科技有限公司 Agricultural machinery tilling depth monitor terminal of big dipper location
CN105987696A (en) * 2016-04-20 2016-10-05 上海雷易工业自动化有限公司 Low-cost vehicle automatic driving design realization method
CN106627753A (en) * 2016-12-21 2017-05-10 上海华测导航技术股份有限公司 Agricultural machinery automatic driving tillage control system guided by Beidou navigation system and control method
CN206162195U (en) * 2016-08-31 2017-05-10 北京耘华科技有限公司 Agricultural machinery autopilot's controller and agricultural machinery
CN206421229U (en) * 2017-01-22 2017-08-18 无锡卡尔曼导航技术有限公司 A kind of agricultural machinery automatic Pilot control device based on the Big Dipper
CN107209015A (en) * 2015-12-07 2017-09-26 北京合众思壮科技股份有限公司 The system and method navigated for land vehicle

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011136886A1 (en) * 2010-04-28 2011-11-03 Navcom Technology, Inc. System and method for determining the heading angle of a vehicle
CN204650278U (en) * 2015-06-02 2015-09-16 浙江联辉智能科技有限公司 Big Dipper agricultural machinery self-navigation Ride Control System
CN107209015A (en) * 2015-12-07 2017-09-26 北京合众思壮科技股份有限公司 The system and method navigated for land vehicle
CN105629973A (en) * 2015-12-18 2016-06-01 广州中海达卫星导航技术股份有限公司 RTK technology-based agricultural machinery straight driving method and RTK technology-based agricultural machinery straight driving device
CN105509740A (en) * 2015-12-31 2016-04-20 广州中海达卫星导航技术股份有限公司 Measuring method and module for attitude of agriculture machinery vehicle
CN105987696A (en) * 2016-04-20 2016-10-05 上海雷易工业自动化有限公司 Low-cost vehicle automatic driving design realization method
CN205561808U (en) * 2016-04-22 2016-09-07 徐州斯塬农科网络科技有限公司 Agricultural machinery tilling depth monitor terminal of big dipper location
CN206162195U (en) * 2016-08-31 2017-05-10 北京耘华科技有限公司 Agricultural machinery autopilot's controller and agricultural machinery
CN106627753A (en) * 2016-12-21 2017-05-10 上海华测导航技术股份有限公司 Agricultural machinery automatic driving tillage control system guided by Beidou navigation system and control method
CN206421229U (en) * 2017-01-22 2017-08-18 无锡卡尔曼导航技术有限公司 A kind of agricultural machinery automatic Pilot control device based on the Big Dipper

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
韩慧仙: "《工程车辆液压传动与控制新技术》", 31 July 2017, 北京理工大学出版社 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108958260A (en) * 2018-07-30 2018-12-07 黑龙江惠达科技发展有限公司 A kind of agricultural machinery automated driving system based on farm implements position
CN109540535A (en) * 2018-12-11 2019-03-29 安徽江淮汽车集团股份有限公司 A kind of APS test macro
CN112114342A (en) * 2019-06-19 2020-12-22 丰疆智能科技研究院(常州)有限公司 Monitoring system and monitoring method for agricultural machinery
CN111058447A (en) * 2019-12-27 2020-04-24 福建建中建设科技有限责任公司 Automatic position finding method and system for pile press
CN111412886A (en) * 2020-03-12 2020-07-14 深圳冰河导航科技有限公司 Detection method and detection system
CN111412886B (en) * 2020-03-12 2022-05-27 深圳冰河导航科技有限公司 Detection method and detection system
CN112213116A (en) * 2020-09-30 2021-01-12 江苏艾威机械制造有限公司 Agricultural machine test bed and control method thereof

Similar Documents

Publication Publication Date Title
CN108334083A (en) A kind of automated driving system based on farm implements position
CN107315345B (en) Agricultural machinery automatic navigation control method based on double-antenna GNSS and preview tracking model
USRE48509E1 (en) Raster-based contour swathing for guidance and variable-rate chemical application
CN105700533B (en) Automatic driving of agricultural machinery control system and method based on Beidou navigation
JP2019061695A (en) Guide control system
US9002566B2 (en) Visual, GNSS and gyro autosteering control
US8401704B2 (en) GNSS control system and method for irrigation and related applications
CN108958260A (en) A kind of agricultural machinery automated driving system based on farm implements position
US20110231061A1 (en) Gnss integrated multi-sensor control system and method
US20070198185A1 (en) GNSS control system and method
CN105987696A (en) Low-cost vehicle automatic driving design realization method
CN105799776A (en) Automatic drive cultivation control system and method for agricultural machine based on Beidou navigation
JP2018502296A (en) 3D map generation by robot tool
CN106627753A (en) Agricultural machinery automatic driving tillage control system guided by Beidou navigation system and control method
CN110262525B (en) Self-navigation control loop and method for farm machinery
CN106647756A (en) Beidou farm machinery automatic navigation driving control system
WO2018034990A1 (en) Wireless charging alignment systems
CN202084642U (en) Directional tracking system control device for antenna of pilotless aircraft
CN105301621A (en) Vehicle positioning device and intelligent driving exam system
JP6879896B2 (en) Satellite positioning system for work platforms
CN110502005B (en) Automatic driving method and system
Takai et al. Autonomous navigation system of crawler-type robot tractor
CN111093145A (en) Positioning system and positioning method of mowing robot
US20210188355A1 (en) Transverse steering method and transverse steering device for moving a vehicle into a target position, and vehicle for this purpose
CN205427178U (en) A positioning system for accurate navigation of unmanned aerial vehicle

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20181116

Address after: 150000 room 1209, 1210, Northeast Asia building, 170 GUI Xin Street, Nangang District, Harbin, Heilongjiang.

Applicant after: Heilongjiang Huida Technology Development Co., Ltd.

Address before: 201913 room 1922, No. 152 Pan Yuan Road, Changxin Town, Chongming District, Shanghai (Shanghai Taihe Economic Development Zone)

Applicant before: Shanghai wantin Information Technology Center

RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20180727