An Automated Rice Transplanter with RTKGPS and FOG

Similar documents
Path planning for autonomous lawn mower tractor

Development of an Unmanned Surface Vehicle Platform for Autonomous Navigation in Paddy Field

Analysis of Trailer Position Error in an Autonomous Robot-Trailer System With Sensor Noise

roll GPS antenna height Vehicle control point Control : sigmoid, K d =0.0225, K=0.046, L=3.83, (v=8 km/h) =0.3, K p 0.5 Lateral deviation (m)

Estimation and Control of Lateral Displacement of Electric Vehicle Using WPT Information

Automatic Guidance System Development Using Low Cost Ranging Devices

AUTOMATIC GUIDANCE OF AGRICULTURAL VEHICLES BASED ON GLOBAL POSITIONING SYSTEM

EXPERIMENTAL RESULTS OF LEX CORRECTIONS USING FARMING MACHINE

Estimation of Absolute Positioning of mobile robot using U-SAT

A Simple Method to Improve Autonomous GPS Positioning for Tractors

OPTIC EYE IN SKY UNMANNED AIRCRAFT FOR IDENTIFY BLEMISH AND CONSERVING CROPS IN CULTIVATED AGRICULTURAL LANDS

AUTOMATIC STEERING SYSTEM FOR ROTARY SNOW REMOVERS. Hirofumi HIRASHITA, Takeshi ARAI, Tadashi YOSHIDA

Sensor system of a small biped entertainment robot

Positioning Australia for its farming future

Simple Path Planning Algorithm for Two-Wheeled Differentially Driven (2WDD) Soccer Robots

POSITIONING AN AUTONOMOUS OFF-ROAD VEHICLE BY USING FUSED DGPS AND INERTIAL NAVIGATION. T. Schönberg, M. Ojala, J. Suomela, A. Torpo, A.

Marking Robot in Cooperation with Three-Dimensional Measuring Instruments

Design of a Drift Assist Control System Applied to Remote Control Car Sheng-Tse Wu, Wu-Sung Yao

Sensor Data Fusion Using Kalman Filter

INDOOR HEADING MEASUREMENT SYSTEM

Vehicle Speed Estimation Using GPS/RISS (Reduced Inertial Sensor System)

Computer Aided Earthmoving System

The Mathematics of the Stewart Platform

DC motor control using arduino

Evaluation of the Dynamic Accuracy of a GPS Receiver *

A Low-cost Positioning System for Parallel Tracking Applications of Agricultural Vehicles by Using Kalman Filter

Tracking and Formation Control of Leader-Follower Cooperative Mobile Robots Based on Trilateration Data

COVENANT UNIVERSITY NIGERIA TUTORIAL KIT OMEGA SEMESTER PROGRAMME: MECHANICAL ENGINEERING

Sloshing Damping Control in a Cylindrical Container on a Wheeled Mobile Robot Using Dual-Swing Active-Vibration Reduction

AUTONOMOUS NAVIGATION SYSTEM BASED ON GPS

State observers based on detailed multibody models applied to an automobile

Real-time Math Function of DL850 ScopeCorder

10/21/2009. d R. d L. r L d B L08. POSE ESTIMATION, MOTORS. EECS 498-6: Autonomous Robotics Laboratory. Midterm 1. Mean: 53.9/67 Stddev: 7.

ATLANS-C. mobile mapping position and orientation solution

GPS data correction using encoders and INS sensors

Introduction to Embedded and Real-Time Systems W12: An Introduction to Localization Techniques in Embedded Systems

DESIGN OF A TWO DIMENSIONAL MICROPROCESSOR BASED PARABOLIC ANTENNA CONTROLLER

A Differential Steering Control with Proportional Controller for An Autonomous Mobile Robot

Technology Talk Bulletin

DEMONSTRATION OF ROBOTIC WHEELCHAIR IN FUKUOKA ISLAND-CITY

Motion Control of a Three Active Wheeled Mobile Robot and Collision-Free Human Following Navigation in Outdoor Environment

Integration of Inertial Measurements with GNSS -NovAtel SPAN Architecture-

ACCELEROMETER BASED ATTITUDE ESTIMATING DEVICE

Module 7. Electrical Machine Drives. Version 2 EE IIT, Kharagpur 1

EFFECT OF INERTIAL TAIL ON YAW RATE OF 45 GRAM LEGGED ROBOT *

Installation and operating instructions

Weedy a sensor fusion based autonomous field robot for selective weed control

ECE 445 Spring 2017 Autonomous Trash Can. Group #85: Eshwar Cheekati, Michael Gao, Aditya Sule

ADMA. Automotive Dynamic Motion Analyzer with 1000 Hz. ADMA Applications. State of the art: ADMA GPS/Inertial System for vehicle dynamics testing

Department of Mechanical Engineering and Automation, Harbin Institute of Technology Shenzhen Graduate School, Shenzhen, , China

Autonomation of the self propelled mower Profihopper based on intelligent landmarks

Dr.Arkan A.Hussein Power Electronics Fourth Class. Operation and Analysis of the Three Phase Fully Controlled Bridge Converter

Wheeled Mobile Robot Obstacle Avoidance Using Compass and Ultrasonic

Wireless Communication Fading Modulation

An External Command Reading White line Follower Robot

User s Guide Modulator Alignment Procedure

Operating Handbook For FD PILOT SERIES AUTOPILOTS

A New Speed Measurement Sensor Using Difference Structure

J T Leinvuo, S A Wilson, R W Whatmore and A E Gee, School of Industrial and Manufacturing Science Cranfield University Cranfield, UK MK43 0AL

Vicki Niu, MacLean Freed, Ethan Takla, Ida Chow and Jeffery Wang Lincoln High School, Portland, OR gmail.com

al T TD ) ime D Faamily Products The RTD Family of products offers a full suite of highprecision GPS sensor positioning and navigation solutions for:

RTLinux Based Speed Control System of SPMSM with An Online Real Time Simulator

13.4 Chapter 13: Trigonometric Ratios and Functions. Section 13.4

Systems characteristics of automotive radars operating in the frequency band GHz for intelligent transport systems applications

2. (8pts) If θ is an acute angle, find the values of all the trigonometric functions of θ given

Control System for an All-Terrain Mobile Robot

RECOMMENDATION ITU-R S *

Cut Crop Edge Detection Using a Laser Sensor

6.1 - Introduction to Periodic Functions

Development of Automated Guidance Tracking Sensor System Based on Laser Distance Sensors

Bit Error Probability of PSK Systems in the Presence of Impulse Noise

Group Robots Forming a Mechanical Structure - Development of slide motion mechanism and estimation of energy consumption of the structural formation -

VPS-X Gyro-150 SNG DVB-S2 SD/HD SNG

Phase Center Calibration and Multipath Test Results of a Digital Beam-Steered Antenna Array

Chapter 6 Part 3. Attitude Sensors. AERO 423 Fall 2004

Controller Area Network Based Distributed Control for Autonomous Vehicles

Guidance system for agricultural tractor with four wheel steering

Autonomous Stair Climbing Algorithm for a Small Four-Tracked Robot

Reliability Estimation for RTK-GNSS/IMU/Vehicle Speed Sensors in Urban Environment

Roles of SRD Spectrum Harmonization in the development of WPT and ITS

Senior Design Project Gyroscopic Vehicle Stabilization

PLEASE READ FIRST (NEW 2011 VERSION) Main features:

ME375 Lab Project. Bradley Boane & Jeremy Bourque April 25, 2018

Coimisiún na Scrúduithe Stáit State Examinations Commission

NovAtel SPAN and Waypoint GNSS + INS Technology

User s Guide Modulator Alignment Procedure

Sensors and Sensing Motors, Encoders and Motor Control

UNIVERSITY OF VICTORIA FACULTY OF ENGINEERING. SENG 466 Software for Embedded and Mechatronic Systems. Project 1 Report. May 25, 2006.

Design of double loop-locked system for brush-less DC motor based on DSP

HALS-H1 Ground Surveillance & Targeting Helicopter

Automatic Navigation System of Facility Agricultural Machinery Based on ZigBee

Digiflight II SERIES AUTOPILOTS

Control System Design for Tricopter using Filters and PID controller

DEVELOPMENT OF THE HUMANOID ROBOT HUBO-FX-1

FLCS V2.1. AHRS, Autopilot, Gyro Stabilized Gimbals Control, Ground Control Station

Evaluation of GPS-Based Attitude Parameters Applied to Bathymetric Measurements

BW-IMU200 Serials. Low-cost Inertial Measurement Unit. Technical Manual

A PILOT STUDY ON ULTRASONIC SENSOR-BASED MEASURE- MENT OF HEAD MOVEMENT

Real Time Kinematic VALUE GUIDE (US, Canada, Australia & New Zealand) CLICK THE ARROW TO GET STARTED

Transcription:

1 An Automated Rice Transplanter with RTKGPS and FOG Yoshisada Nagasaka *, Ken Taniwaki *, Ryuji Otani *, Kazuto Shigeta * Department of Farm Mechanization and Engineering, National Agriculture Research Center, Kannondai, Tsukuba, 3058666 Japan zentei@narc.affrc.go.jp Abstract An automated rice transplanting system has been developed. This study s objective was to develop an automated operation system to make precise operation more efficient. A real-time kinematic GPS (RTKGPS) was used to locate the position and fiber optic gyro (FOG) sensors to measure the direction and the inclination of the vehicle. RTKGPS has 2-cm precision at 10-Hz data output, but the vehicle inclination influences the position data and the position data has about 70-ms delay. The influence of the vehicle inclination is corrected by measuring the inclination with FOG sensors. The RTKGPS receiver generates one pulse per second as cues for measuring the position. A timer was used to synchronize measuring the position with the inclination every 100 ms. When the vehicle was driven straight automatically, the deviation from the desired straight path was less than 10 cm. The GPS data quality indicator was obtained during the operation, and the operation was interrupted when GPS could not locate the precise position. [Keywords] Automated operation, rice transplanter, RTKGPS, FOG 1. Introduction Recently in Japan, there has been a trend to consolidate and enlarge paddy fields. However, while the number of operators is decreasing, the workload of operators is increasing. Therefore, a more efficient operating system is required. If an automated operating system were developed, one person could operate multiple machines. This study s objective was to develop an automated operation system to make precise operation more efficient. In order to realize automated operation, it is necessary to locate the position and direction of the vehicle in the program and to drive precisely. In recent research, Yukumoto et al. used an optical wave range finder and magnetic azimuth sensor 1). Noguchi et al. used image processing and a magnetic azimuth sensor 2). But these techniques require equipment on the field and location precision will be influenced by the weather. Inoue et al. used differential GPS and an FOG sensor 3). Elkaim et al. used carrier phase differential GPS 4). They obtained good results for tillage, but these lack the requisite precision for rice transplanting. Because the inter-row spacing of rice plants is about 30 cm, the vehicles must be driven accurately. However, unevenness of the ground and side slip of the wheel distort the vehicle direction. Therefore, compared with driving on solid terrain, it is difficult to drive a vehicle straight in paddy fields. Consequently, in 1996, the authors used an RTKGPS to locate the precise position 5). It has 1-cm precision at 1-Hz output, but the time delay is long,

2 and the authors could not obtain a sufficiently precise real time position. In 1997, new RTKGPS receivers were used and the vehicle control method was improved 6). The time delay was shortened, and location precision and deviation from the desired path were improved. In 1998, a new rice transplanter was modified 7) and long mat type hydroponic rice seedlings developed in the Japan National Agriculture Research Center were used 8). The long mat type has sufficient seedling capacity to transplant one field without reloading. In 1999, the authors used the latest RTKGPS receivers and corrected the drift of the FOG sensor 9). In this paper, the outline of an automated rice transplanter is reported. 2. Materials and methods 2.1 Rice transplanter The authors modified a 6-row rice transplanter, the transmission of which has HST. Fig. 1 shows the rice transplanter and Fig. 2 shows the scheme of an automated rice transplanting system. An RTKGPS was used to obtain the position of the rice transplanter. It has 3-cm precision at 10-Hz data output. The RTKGPS reference station and rover station communicated via 5-mW output wireless modems and its baud rate was 9600 bps. An FOG was used to measure the yaw angle and an inclination-measuring apparatus was used to measure the roll and pitch angle. RTKGPS data output latency was around 70 Fig. 1 Automated rice transplanter milliseconds. One pulse per second output from the RTKGPS shows the timing of the measuring position. A timer counter board was used to measure 100 milliseconds and the yaw, the roll and the pitch angle were measured at 10 Hz and synchronized with locating the position. As the vehicle inclination influences the position data, the corrected position was calculated. The main computer CPU was Intel DX4 100 MHz running under PC-DOS. The steering and the engine throttle were controlled by DC motors and the brake, the clutch, HST lever and the up-down controller of the transplanting module were controlled by electrical linear cylinders. The positions of the brake and the clutch actuator were sensed by limit switches and others were sensed by rotary encoders. The control program was developed with C.

3 data Modem RTKGPS Base Station Position sensor Main computer Modem RTKGPS Rover Station RS232C 1PPS output Counter Steering HST Clutch Brake L,R Engine throttle Attachment up-down Motor Controller A/D converter Yaw Roll Pitch Fig. 2 Automated rice transplanting system 2.2 Correction of the inclination The GPS rover station must communicate with the reference station to receive the reference data over a radio link. The rover receiver requires synchronized GPS measurement data from the reference station once per second. This study used 5-mW output wireless GPS 1PPS output 100ms timer GPS data sampling GPS data output Inclination data sampling Fig.3 Synchronization of GPS and the inclination data modems between the reference and rover stations. The rover receiver s data output delay is about 70 milliseconds and the output interval is irregular. Therefore, the measuring inclination must be synchronized with locating the vehicle position. Fig. 3 shows the flow of the data sampling. The RTKGPS receiver has an output of 1 pulse per second. In order to restore this timing fluctuation, a pulse counter board was used in the PC. When 1PPS output pulse is received by the counter board, the board starts counting every 100 ms. The yaw, the roll and the pitch angle data are A/D converted every count. When a rice transplanter travels in a paddy field, the roll and pitch angle is about 3 degrees. In this system, the GPS antenna is fixed on the rice transplanter. Assuming the antenna height is 2 m, the horizontal distance between the top of the antenna and the bottom is 10.5 cm when the roll angle is 3 degrees. As the GPS data is the position of the antenna top, the influence of the roll and pitch must be corrected. When the point measured by GPS is assumed as P 1 (x 1,y 1,h 1 ), the roll angle is θ, the pitch angle is φ, the yaw angle is ψ and the height of the GPS antenna is h. The desired straight path is given as the following equation:

4 Y=kX+C (1). The corrected position P crr is expressed as follows: h h p1 ( k' sinθ + sin φ), q1 ( k' sin φ sinθ ), h h cosθ cosφ) 2 2 1+ k' 1+ k' p crr ( 1 cosθ cos ψ ' = ( 1+ (tanψ cosφ ) )2 1 sinψ ' k cosψ ' k' = cosψ ' k sinψ ' 2.3 Correction of initial yaw angle offset It is very difficult to set the vehicle direction parallel to the traveling direction. The FOG sensor cannot sense the azimuth and it has drift. So, to sense the initial yaw angle, the deviation from the desired path calculated by the yaw angle and vehicle speed was compared with the deviation calculated by GPS data (Fig. 4). Then, the offset angle was calculated and the yaw angle was corrected. The deviation from the desired path measured by RTKGPS is assumed as d GPS and the deviation calculated by the yaw angle ψ(i) and the vehicle speed v(i) is d Gyro. v(i) is ψ offset d GPS d Gyro measured by GPS. d Gyro is estimated as the following equation (2). In this equation, n is the time after starting calculation and t s is the sampling interval. d Gyro is calculated 15 seconds after starting operation. l n Fig. 4 Correction of initial yaw angle offset d Gyro n t = s i= 0 v( i) ψ ( i) (2). Then, the distance from the starting point is l n, and the offset of the yaw angle ψ offset is calculated as the following equation (3). In this equation, it is supposed that d GPS and d Gyro are sufficiently smaller than l n. offset ( d Gyro l n ) ( d GPS l n ) ( d Gyro d GPS ) l n ψ = arctan arctan (3). 2.4 Vehicle control method Before starting operation, the computer must create a desired path along which the rice transplanter travels and an aim point. In this study, the paddy field is assumed to be rectangular. The four corners A, B, C and D in the field were measured previously. Before starting, the rice transplanter is at point P n. Fig. 5 shows the method for calculating the aim point. First, a line parallel to line AB is drawn over P n ; this is line l 1. l 1 is the desired path along which the rice transplanter travels. Line l 1 and line BC intersect at P e1. P e1 is the aim point of the operation. When the vehicle reaches P e1, the next desired line l 2 and the aim point P e2 are calculated. Line l 2 is drawn at an interval of 1.8 m to l 1. Line l 2 and line AD intersect

at P e2. D C The rice transplanter must be driven along the desired path. The steering is controlled to get back as closely as possible to the desired path. When the deviation from the target line is assumed as d and the yaw angle is ψ, the aiming steering angle δ aim is given as the following equation. K p1, K p2 and are decided by the vehicle speed. Pe2 Ps1 A Pn Ps2 Pe1 B δ aim = K p1 d+k p2 ψ (4) Fig. 5 Decision of the aim point At the headland, the rice transplanter moves forward and backward to turn so as to minimize the headland space. Fig. 6 shows Close to new desired path the control way of turning. The width of the Stop headland is 3.5 m. When the rice transplanter reaches the edge of the field, it moves backward 40 cm in a straight line. While the rice transplanter is turning and the yaw angle is less than 160 degrees, only the yaw angle Start operation 160º Turn,brake is obtained, the steering angle is maintained Stop operation at 40 degrees and one side brake is applied. When the yaw angle is greater than 160 Stop degrees, the rice transplanter is controlled to get back as closely as possible to the next Fig. 6 Control way of turning desired path. If the rice transplanter does not get sufficiently close to the new desired path after turning, the steering is controlled to get as close as possible to the desired path when it moves backward. The GPS data quality indicator is monitored while the rice transplanter travels automatically, and if the radio link between the GPS base station and the GPS rover station is disconnected, the clutch is released and the operation is interrupted. 3. Results and discussion The experiment was conducted 4 days after puddling. Fig. 7 shows the path of the GPS antenna, and in this data, the influence of the vehicle inclination was corrected. The deviation from the desired straight path was less than 10 cm at a traveling speed of 0.8 m/s during the operation. The rice transplanter went forward and backward in a 20 m 100 m square field 4 times. As the turning radius of the vehicle at the headland was around 2 m, it was easy to get back as close as possible to the new desired path after turning. In this experiment, conventional mat type rice seedlings were used and two persons supplied them to the rice transplanter every two returning operations at the edge of the field. At the headland, it took 50 seconds to turn and to get back as close as possible to the new desired path. The turning time was shortened by about 30 seconds, which is dependant on the use of HST. It took more than 100 seconds to change the moving direction in the previous model. The operating time was 22 minutes per 10a. 5

6 When the data communication between the RTKGPS base and rover station via radio link was disconnected, the clutch was released and operation was interrupted. Then, as soon as the radio link was connected, operation started again. 20m 100m Fig. 7 The path of the automated rice transplanter 4. Conclusions In this study, a new 6-row rice transplanter was developed. RTKGPS was used to locate the precise position and FOG sensors were used to measure the inclination and direction of the vehicle. As the inclination of the vehicle was corrected and the data sampling timing was synchronized, in this experiment, the deviation from the desired straight path was less than 10 cm when the rice transplanter traveled 100 m in a paddy field. This rice transplanter has HST and it is easy to change the travel direction. Therefore, compared to the previous automated rice transplanter, the turning time was shortened by about 30 seconds and operation efficiency was improved. The operating time was 22 minutes per 10a at the 20 m 100 m field. The operation could be interrupted when the GPS receiver lost the precise position by obtaining the GPS data quality indicator and precise operation could be maintained. Reference [1] Yukumoto O., Matsuo Y., Research on autonomous land vehicle for agriculture. Proceedings of International Symposium on Automation and Robotics in Bioproduction and Processing, vol.1, pp41-48, 1995 [2] Noguchi, N., Ishii, K., Terao, H., Devolopment of an Agricultural Mobile Robot using a Geomagnetic Direction Sensor and Image Sensors, J. agric. Engng Res. 67, 1-15,1997 [3] Inoue, K., Otuka, K., Sugimoto, M., Murakami, N., Estimation of place of tractor and adaptive control method of autonomous tractor using INS and GPS, Preprints of the International workshop on Robotics and Automated Machinery for Bio-Productions, 27-36,1997 [4] Elkaim, G, O'Connor, M., Bell, T., Parkinson, B., System Identification and Robust Control of Farm Vehicles using Carrier Phase Differential GPS, the ION Conference, 1997. [5] Nagasaka,Y., Taniwaki, K., Otani, R., Shigeta, K., Automated operation in paddy fields with a fiber optic gyro sensor and GPS, Preprints of the International workshop on Robotics and Automated Machinery for Bio-Productions, 21-26, 1997 [6] Nagasaka,Y., Taniwaki, K., Otani, R., Shigeta, K., Autonomous rice transplanting system with GPS and FOG, AgEng Oslo 98 International conference on agricultural engineering

7 CD-ROM,1998 [7] Nagasaka,Y., Taniwaki, K., Otani, R., Shigeta, K., Automated Rice Transplanting in Paddy Fields, ASAE paper #991045,1999 [8] Tasaka, K., Outline of Raising and Transplanting Technology for Long MatType Hydroponic Rice Seedling, AgEng Oslo 98 Proceeding CD-ROM [9] Nagasaka,Y., Taniwaki, K., Otani, R., Shigeta, K., A Study about an Automated Rice Transplanter with GPS and FOG, ASAE paper #001066, 2000