Error correction device

Abstract

An error correction device 34 for correcting an error in a measured value from a sensor device equipped with a GNSS sensor and a gyro sensor and provided to a work vehicle, said error correction device being equipped with: a first acquisition unit 341 for acquiring the speed vector of the work vehicle in a local coordinate system by measuring using the GNSS sensor and the angular velocity thereof in a sensor coordinate system which has three axes and has the sensor device as a reference by measuring using the gyro sensor; a second acquisition unit 343 for acquiring the steering amount of the work vehicle; a set position determination unit 344 for determining, on the basis of the acquired steering amount, a set position which is set in a different position in the sensor coordinate system than is the sensor device; and a speed vector correction unit 347 for correcting the speed vector of the work vehicle measured by the GNSS sensor by calculating the speed vector of the work vehicle at the determined set position on the basis of the speed vector of the work vehicle at the measured position and the acquired angular velocity.

Description

[Technical field]

[0001] An embodiment of the present invention relates to correcting measurements by a sensor device provided on a work vehicle. [Background technology]

[0002] Conventionally, automatic steering control has been performed to make a work vehicle such as a tractor or rice transplanter follow a specified travel route for the purpose of improving the efficiency of agricultural work. According to this automatic steering control, the steering of the work vehicle is controlled so as to position the work vehicle on the travel route based on the distance between a target position on the travel route and the position of the work vehicle.

[0003] Also, as a technology related to automatic steering of a work vehicle, an automatic steering system is known which includes a satellite positioning module that outputs position information based on satellite information from a satellite, a forward reference position calculation unit that calculates a forward reference position which is the reference position for steering control of the work vehicle when traveling forward based on the position information, a reverse reference position calculation unit that calculates a reverse reference position which is the reference position for steering control of the work vehicle when traveling reverse based on the position information, a steering control unit that outputs a forward steering control signal calculated based on the deviation between the driving path and the forward reference position when traveling forward, and outputs a reverse steering control signal calculated based on the deviation between the driving path and the reverse reference position when traveling reverse, and a steering mechanism that steers the work vehicle based on the forward steering control signal and the reverse steering control signal (see, for example, Patent Document 1). [Prior art documents] [Patent documents]

[0004] [Patent Document 1] JP 2018-120364 A Summary of the Invention [Problem to be solved by the invention]

[0005] In automatic steering control of work vehicles, a velocity vector measured by a sensor device is sometimes used, but there is a problem that this velocity vector can deviate significantly from the vehicle orientation of the work vehicle depending on the driving conditions of the work vehicle, resulting in errors.

[0006] The present invention has been made to solve the above-mentioned problems, and has an object to provide a technique capable of reducing errors in velocity vectors. [Means for solving the problem]

[0007] In order to solve the above-mentioned problems, the error correction device of this embodiment is an error correction device that is provided on a work vehicle and corrects errors in measurement values ​​obtained by a sensor device equipped with a GNSS sensor and a gyro sensor, and is equipped with a first acquisition unit that acquires the velocity vector of the work vehicle in a local coordinate system measured by the GNSS sensor and the angular velocity in a sensor coordinate system having three axes based on the sensor device measured by the gyro sensor, a second acquisition unit that acquires a steering amount in the work vehicle, a set position determination unit that determines a set position that is set at a position different from the sensor device in the sensor coordinate system based on the acquired steering amount, and a velocity vector correction unit that calculates the velocity vector of the work vehicle at the determined set position based on the velocity vector of the work vehicle at the measurement position and the acquired angular velocity, and corrects the velocity vector of the work vehicle measured by the GNSS sensor. Effect of the Invention

[0008] According to the present invention, the error in the velocity vector can be reduced. [Brief description of the drawings]

[0009] [Figure 1] FIG. 1 is a schematic side view showing a configuration of an agricultural tractor according to a first embodiment. [Diagram 2] 1 is a block diagram showing an overall configuration of an automatic steering control system according to a first embodiment. [Diagram 3] FIG. 2 is a block diagram showing a hardware configuration of the error correction device. [Figure 4] FIG. 2 is a block diagram showing a functional configuration of the error correction device. [Diagram 5] 4 is a flowchart showing the operation of the error correction device. [Figure 6] FIG. 13 is a schematic front view showing relative position vectors. [Figure 7] FIG. 2 is a schematic plan view showing relative position vectors. [Figure 8] FIG. 1 is a schematic front view showing velocity vectors. [Figure 9] 13 is a flowchart showing an operation of a set position correction process. [Figure 10] FIG. 2 is a schematic plan view showing a tractor during forward course change by front wheel steering. [Figure 11] FIG. 2 is a schematic plan view showing a tractor making a forward turn with front wheel steering. [Figure 12] 10 is a flowchart showing an operation of a vehicle body direction calculation process. [Figure 13] FIG. 2 is a schematic plan view showing a tractor making a reverse turn with front wheel steering. [Figure 14] FIG. 2 is a schematic plan view showing the tractor during a forward lane change by rear wheel steering. [Figure 15] FIG. 2 is a schematic plan view showing the tractor during a forward turn with rear wheel steering. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0010] Hereinafter, an embodiment of the present invention will be described with reference to the drawings.

[0011] <First embodiment> (Work vehicle configuration) First, a work vehicle equipped with an error correction device according to this embodiment will be described. Fig. 1 is a schematic side view showing the configuration of an agricultural tractor according to this embodiment.

[0012] The vehicle to be steered by the automatic steering system according to this embodiment is a work vehicle, specifically an agricultural tractor 1 as shown in FIG. 1. The tractor 1 is a four-wheel vehicle equipped with a body 10, two front wheels 11 and two rear wheels 12, and driven by rear wheels. However, the tractor 1 may be any vehicle that can be steered, not limited to a work vehicle. The tractor 1 also includes a seat 13 for a driver to sit on, a steering column 15, a steering handle 16, a steering drive device 17, pedals 18 including an accelerator, a brake, and the like, four support frames 19a to 19d, and a roof portion 19r. A rotary tiller 41 as a working machine provided on the work vehicle is connected to the body 10 of the tractor 1 by a link mechanism.

[0013] The steering column 15 includes a steering system for steering the tractor 1 by applying a deflection angle to the front wheels 11, and also includes an input shaft 151 for inputting the steering angle by the steering wheel 16 or the steering drive device 17 to the steering system, and a steering amount based on the rotation of the input shaft 151 is applied to the front wheels 11. The steering drive device 17 is a device that is retrofitted to automatically steer the tractor 1, which is not provided with a configuration for automatic steering control and is designed for manual steering, and has the steering wheel 16 attached to the upper part and the upper end of the input shaft 151 of the steering system fitted to the lower part. Four long support frames 19a to 19d are provided upright at different positions on the front, rear, left and right sides on the vehicle body 10, and a roof portion 19r formed as a substantially flat plate as a whole is placed on these four support frames 19a to 19d.

[0014] A sensor device 30 is provided on the upper surface of the roof portion 19r, using the roof portion 19r as a mount. Since the sensor device 30 includes a GNSS sensor as described later, it is preferable to attach it to the top of the tractor 1, such as the roof portion 19r, in order to receive GNSS signals transmitted from an artificial satellite. If the tractor 1 does not have a roof portion 19r, the sensor device 30 is provided on one of the four support frames 19a to 19d that support the roof portion 19r as a mount. In addition, an automatic steering control device 21 is provided on one of the support frames 19a, 19b located in the front. The automatic steering control device 21 controls the automatic steering of the tractor 1.

[0015] (Configuration of automatic steering control system) FIG. 2 is a block diagram showing the overall configuration of the automatic steering control system according to the embodiment.

[0016] As shown in FIG. 2, the automatic steering control system provided in the tractor 1 is composed of a steering drive device 17 that drives the input shaft 151 in the steering system, a sensor device 30, an automatic steering control device 21, and a steering wheel angle control device 22 not shown in FIG. 1.

[0017] The steering drive device 17 includes a transmission shaft 171 that transmits driving force to the input shaft 151, a motor 172 that is an electric motor that drives the transmission shaft 171, and an encoder 173 that is a rotary encoder that detects the amount of rotation and the rotation position of the transmission shaft 171. Note that the motor 172 may be any type of motor as long as it is capable of outputting a torque sufficient to rotate the input shaft 151.

[0018] The automatic steering control device 21 outputs a steering amount based on a measurement value by the sensor device 30, and the steering wheel angle control device 22 feedback controls the steering drive device 17 based on the steering amount instructed by the automatic steering control device 21. Here, the steering drive device 17 controls the motor 172 to drive the transmission shaft 171 so that the rotation position detected by the encoder 173 becomes a desired rotation position.

[0019] In this way, by retrofitting the steering drive device 17, sensor device 30, automatic steering control device 21 and steering wheel angle control device 22 to the tractor 1, it is possible to realize automatic steering in the tractor 1 that is configured to be manually steered.

[0020] The sensor device 30 includes a gyro sensor 31, an acceleration sensor 32, a GNSS sensor 33, and an error correction device 34, which are housed in the same housing. This means that the gyro sensor 31, the acceleration sensor 32, and the GNSS sensor 33 are provided in approximately the same location in the tractor 1. The gyro sensor 31 detects angular velocities around three axes to measure the azimuth angle ξ, pitch angle θ, and roll angle φ of the tractor 1. The acceleration sensor 32 measures the three-axis acceleration of the tractor 1. The GNSS sensor 33 measures the vehicle position, which is the position of the tractor 1, and the velocity vector of the tractor 1. The error correction device 34 corrects errors in the measurements by the gyro sensor 31, the acceleration sensor 32, and the GNSS sensor 33.

[0021] The automatic steering control device 21 calculates a target travel direction, which is the travel direction of the tractor 1 that will align the vehicle position with the target travel route, based on the vehicle position, which is the position of the tractor 1 detected by the GNSS sensor 33, and the set target travel route, and calculates a steering amount based on the travel direction deviation, which is the deviation between this target travel direction and the travel direction of the tractor 1 based on the speed vector from the GNSS sensor 33, and outputs the steering amount to the steering wheel angle control device 22.

[0022] (Configuration of error correction device) The hardware configuration and the functional configuration of the error correction device will be described below. Figures 3 and 4 are block diagrams showing the hardware configuration and the functional configuration of the error correction device, respectively.

[0023] As shown in FIG. 3, the error correction device 34 includes, as hardware components, a central processing unit (CPU) 91, a random access memory (RAM) 92, a storage device 93, and an external interface (I / F) 94.

[0024] The CPU 91 and RAM 92 cooperate to execute various functions described later, and the storage device 93 stores various data used in the processes executed by the various functions. The external I / F 94 inputs and outputs data to and from the gyro sensor 31, the acceleration sensor 32, the GNSS sensor 33, and the automatic steering control device 21. The automatic steering control device 21 may also include a CPU, RAM, a storage device, and an external I / F, and may execute various functions described later in place of the error correction device 34.

[0025] Moreover, as shown in FIG. 4 , the error correction device 34 has, as its functions, a first acquisition unit 341, a low-pass filter 342 having a first low-pass filter 342a and a second low-pass filter 342b, a second acquisition unit 343, a setting position determination unit 344, a coordinate conversion unit 345, a vehicle position correction unit 346, a velocity vector correction unit 347, a third acquisition unit 348, and a vehicle orientation calculation unit 349.

[0026] The first acquisition unit 341 acquires measurement values ​​measured by each of the gyro sensor 31, the acceleration sensor 32, and the GNSS sensor 33. The first low-pass filter 342a attenuates high-frequency signals higher than a preset first cutoff frequency for the time-series signal of the measurement values ​​by the gyro sensor 31 acquired by the first acquisition unit 341. The second low-pass filter 342b attenuates high-frequency signals higher than a preset second cutoff frequency for the time-series signal of the measurement values ​​by the acceleration sensor 32 acquired by the first acquisition unit 341.

[0027] As described above, since the sensor device 30 includes the GNSS sensor 33, it is desirable to attach the sensor device 30 to any one of the four support frames 19a to 19d or to the roof portion 19r supported by them in order to receive the GNSS signal. In a work vehicle such as a tractor 1, the members supporting the roof, such as the four support frames 19a to 19d in this embodiment, do not have sufficient rigidity, so that high-frequency amplitude is applied to the sensor device 30, especially when the work vehicle travels on a road surface with a lot of bumps. Such high-frequency amplitude causes errors in the measurements by the gyro sensor 31 and the acceleration sensor 32, but the low-pass filter 342 can reduce such errors.

[0028] The second acquisition unit 343 acquires the steering amount output by the automatic steering control device 21. The set position determination unit 344 determines the set position based on the steering amount acquired by the second acquisition unit 343. Here, the set position is a position obtained by projecting the measurement position by the sensor device 30 onto the traveling surface of the tractor 1, i.e., the surface of the field, and is set at the center position in the width direction of the tractor 1, and the position in the front-rear direction of the tractor 1 is determined based on the steering amount.

[0029] The coordinate conversion unit 345 converts the relative position vector and the angular velocity vector in the sensor coordinate system into vectors in the local coordinate system. Here, the sensor coordinate system is a coordinate system having three mutually orthogonal axes x, y, and z with the measurement position, which is the position where the sensor device 30 is attached and the position where the measurement is performed by the sensor device 30, as the origin, and the x-axis faces forward in the straight-ahead direction of the tractor 1, the y-axis faces rightward in the width direction of the tractor 1, and the z-axis faces downward in the up-down direction of the tractor 1. The local coordinate system is a coordinate system having three axes facing north, east, and downward. The relative position vector and the angular velocity vector will be described in detail later.

[0030] The vehicle position correction unit 346 corrects the vehicle position of the tractor 1 in the local coordinate system measured by the GNSS sensor 33 at the measurement position of the sensor device 30 attached above the tractor 1, in this embodiment to the roof portion 19r, to the vehicle position of the tractor 1 at a preset position in the sensor coordinate system. The speed vector correction unit 347 corrects the speed vector of the tractor 1 in the local coordinate system measured by the GNSS sensor 33 at the measurement position of the sensor device 30 to the speed vector at the set position.

[0031] The third acquisition unit 348 acquires whether the tractor 1 is in a forward or reverse state as the traveling direction. The vehicle body orientation calculation unit 349 calculates the direction of the vehicle body 10 of the tractor 1 as an orientation based on the traveling state acquired by the third acquisition unit 348 and the speed vector corrected by the speed vector correction unit 347.

[0032] (Operation of error correction device) The operation of the error correction device will be described. Fig. 5 is a flowchart showing the operation of the error correction device. Fig. 6 and Fig. 7 are a schematic front view and a schematic plan view, respectively, showing a relative position vector. Fig. 8 is a schematic front view showing a velocity vector. Note that the operation shown in Fig. 5 is executed at every predetermined period.

[0033] As shown in FIG. 5, first, the first acquisition unit 341 acquires the vehicle position and velocity vector in the local coordinate system measured by the GNSS sensor 33 (S101), and acquires the angular velocity of the tractor 1 measured by the gyro sensor 31 and the acceleration of the tractor 1 measured by the acceleration sensor 32 (S102).

[0034] Next, the low-pass filter 342 attenuates high-frequency signals higher than a first cutoff frequency and a second cutoff frequency set in advance for each of the angular velocity and acceleration acquired by the first acquisition unit 341 (S103).

[0035] Next, a setting position determination process, which will be described later, is executed (S104).

[0036] After the execution of the setting position determination process, the coordinate conversion unit 345 converts the relative position vector L of the measurement position s, which starts from the setting position a in the sensor coordinate system, as shown in FIG. 6 and FIG. s Based on the azimuth angle, pitch angle, and roll angle of the tractor 1 measured by the gyro sensor 31, L=CL s The coordinates are converted into a relative position vector L in the local coordinate system by the following equation (S105). Here, C denotes a coordinate conversion matrix for converting the coordinates from the sensor coordinate system to the local coordinate system,

[0037]

number

[0038]

number

[0039] Prior to the coordinate transformation, an initialization process generally called alignment is performed. According to this initialization process, the initial direction (azimuth angle) and initial attitude (pitch angle and roll angle) of the tractor 1 are determined, and in the coordinate transformation by the coordinate transformation unit 345, the azimuth angle ξ, pitch angle θ, and roll angle φ updated based on the initial direction and initial attitude measured by the gyro sensor 31 are provided to the coordinate transformation matrix C.

[0040] The pitch angle θ and roll angle φ in the initial posture are expressed as follows: the gravitational acceleration measured by the acceleration sensor 32 when the tractor 1 is stationary is g, and each of the accelerations of the three axes is a x ,a y ,a z can be calculated from the following formula:

[0041]

number

[0042] Moreover, the azimuth angle ξ as the initial orientation is set based on a velocity vector measured by the GNSS sensor 33 while the tractor 1 is traveling. Note that the initial attitude and initial orientation may use values ​​set in advance.

[0043] After the coordinate conversion, the vehicle position correction unit 346 converts the position vector of the set position a, starting from the origin O of the local coordinate system, into P a , the position vector of the measurement position s is P s As,P a =P s By the formula -L, the position vector P a By calculating the above, the vehicle position measured at the measurement position s is corrected to the vehicle position at the set position a determined by the set position correction process (S106).

[0044] Next, the coordinate conversion unit 345 converts the angular velocity vector ω s Using the coordinate transformation matrix C, ω=Cω s The coordinates are transformed into an angular velocity vector ω in the local coordinate system by the following equation (S107).

[0045] After the coordinate conversion, the velocity vector correction unit 347 converts the velocity vector of the tractor 1 at the measurement position s measured by the GNSS sensor 33 into V s Let the velocity vector at the set position a be V a As, V a =V s According to the formula -ω×L, the velocity vector V a The velocity vector is corrected by calculating (S108).

[0046] After the velocity vector is corrected, the vehicle direction calculation process described later is executed (S109).

[0047] In this way, the error correction device 34 corrects the vehicle position and speed vector measured at the measurement position s to the vehicle position and speed vector at the set position a. The corrected vehicle position and speed vector allow the automatic steering control device 21 to obtain more accurate vehicle position, traveling direction and traveling speed with reduced measurement value errors caused by vibration of the sensor device 30 that occur especially when the tractor 1 travels on an uneven field. This allows accurate automatic steering of the tractor 1 by the automatic steering control device 21.

[0048] (Setting position correction process) The operation of the set position correction process will be described. Fig. 9 is a flowchart showing the operation of the set position correction process according to this embodiment. Fig. 10 and Fig. 11 are schematic plan views showing the tractor during forward course change by front wheel steering and during forward turning, respectively.

[0049] 9, first, the second acquisition unit 343 acquires the steering amount output by the automatic steering control device 21 (S201), and the set position determination unit 344 judges whether the acquired steering amount is equal to or greater than a preset threshold value (S202). Here, the threshold value is set to a steering amount that causes the tractor 1 to turn.

[0050] If the steering amount is not equal to or greater than the threshold (S202, NO), the set position determination unit 344 determines the first set position a1, which is the center of gravity or center of vehicle motion of the tractor 1, as the set position a (S203), as shown in Fig. 10. Note that the first set position a1 only needs to be positioned at least between the axle center f of the front wheels 11 and the axle center r of the rear wheels 12 in the fore-and-aft direction of the tractor 1.

[0051] On the other hand, if the steering amount is equal to or greater than the threshold (S202, YES), the set position determination unit 344 determines the second set position a2 located at the axle center r of the rear wheels 12 as the set position a (S204), as shown in Fig. 11. Note that the second set position a2 only needs to be positioned at least closer to the rear wheels 12 side than the first set position a1 in the fore-and-aft direction of the tractor 1, in other words, closer to the non-steered wheels side.

[0052] In this way, by correcting the set position based on the steering amount, especially when the tractor 1 is turning, the velocity vector V at the set position a is a The orientation of the vehicle body 10 of the tractor 1 can be more closely approximated.

[0053] (Vehicle direction calculation process) The vehicle body direction calculation process will be described below. Fig. 12 is a flow chart showing the operation of the vehicle body direction calculation process. Fig. 13 is a schematic plan view showing a tractor turning backwards with front wheel steering.

[0054] 12, first, the third acquisition unit 348 acquires whether the tractor 1 is in a forward state or a reverse state as the traveling direction (S301). Here, the third acquisition unit 348 acquires, as the traveling direction, the state of a lever for switching between forward and reverse, the switching state of a forward gear / reverse gear in a transmission that transmits the power of a prime mover, and the like.

[0055] Next, the vehicle body orientation calculation unit 349 determines whether the traveling direction acquired by the third acquisition unit 348 is reverse or not (S302).

[0056] When the traveling direction is reverse (S302, YES), the vehicle body direction calculation unit 349 calculates the speed vector V a is inverted in the x direction, i.e., the forward / reverse direction of the tractor 1 (S303), and the inverted velocity vector V a The direction of the vehicle is calculated as the vehicle heading (S304).

[0057] On the other hand, when the traveling direction is forward and not backward (S302, NO), the vehicle direction calculation unit 349 calculates the speed vector V a The direction of the vehicle is calculated as the vehicle heading (S304).

[0058] In this way, when the traveling direction of the tractor 1 is reversed, the reversed velocity vector V a By setting the direction of the vehicle as the vehicle direction, the velocity vector V aThe vehicle orientation can be calculated from this.

[0059] <Second embodiment> In this embodiment, the tractor is rear-wheel drive, and therefore the set position determined by the set position determination process in the error correction device is different from that in the first embodiment. Figures 14 and 15 are schematic plan views showing the tractor during forward course change and forward turning by rear wheel steering, respectively.

[0060] As shown in Figs. 14 and 15, a tractor 1a according to this embodiment is configured as a so-called rear-wheel drive vehicle having front wheels 11a which are non-steered wheels and rear wheels 12a which are steered wheels.

[0061] As shown in FIG. 14, the setting position when the steering amount is less than the threshold value, i.e., the first setting position, is between the axle center f of the front wheel 11a and the axle center r of the rear wheel 12a in the fore-and-aft direction of the tractor 1a, preferably the center of gravity of the vehicle or the center of vehicle motion, as in the first embodiment.

[0062] As shown in FIG. 15, the setting position when the steering amount is equal to or greater than the threshold, i.e., the second setting position a2, is the axle center f of the front wheel 11a, which is located on the non-steered wheel side of the first setting position a1 in the fore-and-aft direction of the tractor 1a.

[0063] In this way, by positioning the second set position a2 on the non-steered wheel side relative to the first set position a1, it is possible to accommodate not only front-wheel steering vehicles but also rear-wheel steering vehicles.

[0064] In the above embodiment, the vehicle position and the speed vector at the measurement position s are corrected to those at the set position a, but the set positions a for the vehicle position and the speed vector may be different. For example, the vehicle position may be always corrected to the vehicle position at the first set position a1, and only the speed vector may be corrected to the speed vector at either the first set position a1 or the second set position a2 depending on the steering amount.

[0065] The embodiments of the present invention are presented as examples and are not intended to limit the scope of the invention. These novel embodiments can be implemented in various other forms, and various omissions, substitutions, and modifications can be made without departing from the spirit of the invention. These embodiments and their modifications are included in the scope and spirit of the invention, and are included in the scope of the invention and its equivalents described in the claims. [Explanation of symbols]

[0066] 34 Error correction device 341 First acquisition part 343 Second Acquisition Department 344 Setting position determination section 347 Velocity Vector Correction Unit

Claims

1. An error correction device that corrects errors in measurement values ​​obtained by a sensor device that is provided on a work vehicle and has a GNSS sensor and a gyro sensor, a first acquisition unit that acquires a velocity vector of the work vehicle in a local coordinate system measured by the GNSS sensor and an angular velocity in a sensor coordinate system having three axes based on the sensor device measured by the gyro sensor; A second acquisition unit that acquires a steering amount of the work vehicle; a set position determination unit that determines a set position that is set at a position different from the sensor device in the sensor coordinate system based on the acquired steering amount; a velocity vector correction unit that calculates a velocity vector of the work vehicle at the determined set position based on the velocity vector of the work vehicle at the measurement position where the sensor device is provided and the acquired angular velocity, and corrects the velocity vector of the work vehicle measured by the GNSS sensor; An error correction device comprising:

2. 2. The error correction device according to claim 1, wherein the set position determination unit determines the set position to a first set position when the acquired steering amount is less than a predetermined threshold, and determines the set position to a second set position different from the first set position when the acquired steering amount is equal to or greater than the threshold.

3. The work vehicle has only the front wheels or the rear wheels steered, the first set position is located between the front wheels and the rear wheels of the work vehicle in the front-rear direction of the work vehicle, 3. The error correction device according to claim 2, wherein the second set position is located on the non-steered wheel side in the longitudinal direction with respect to the first set position.

4. 4. The error correction device according to claim 1, further comprising a vehicle orientation calculation unit that calculates a direction of the corrected velocity vector as a vehicle orientation of the work vehicle.

5. A third acquisition unit that acquires a traveling direction indicating whether the work vehicle is in a forward or reverse state, 5. The error correction device according to claim 4, wherein the vehicle body orientation calculation unit calculates, when the acquired traveling direction is reverse, a direction obtained by inverting the corrected speed vector as the vehicle body orientation of the work vehicle.

6. a coordinate conversion unit that converts a relative position vector of a measurement position at which the sensor device is provided, with the starting point being a set position that is set at a position different from the sensor device in the sensor coordinate system, into a relative position vector in the local coordinate system based on the acquired angular velocity, and that converts an angular velocity vector of the work vehicle in the sensor coordinate system based on the acquired angular velocity into an angular velocity vector in the local coordinate system based on the acquired angular velocity, The error correction device according to any one of claims 1 to 5, characterized in that the velocity vector correction unit calculates the velocity vector of the work vehicle at the determined set position based on the velocity vector of the work vehicle at the measurement position, the coordinate transformed angular velocity vector, and the coordinate transformed relative position vector.

7. The velocity vector correction unit calculates a velocity vector of the work vehicle at the measurement position as V ｓ , the velocity vector of the work vehicle at the set position is V ａ , the coordinate-transformed angular velocity vector is ω, the coordinate-transformed relative position vector is L, and V ａ = V ｓ 7. The error correction device according to claim 6, wherein the velocity vector of the work vehicle at the determined set position is calculated by the formula -ω×L.

8. The apparatus further includes a low-pass filter that attenuates a high-frequency signal higher than a preset first cutoff frequency for a time-series signal of the angular velocity measured by the gyro sensor, 8. The error correction device according to claim 6, wherein the coordinate conversion unit converts the coordinates of the relative position vector based on the angular velocity obtained by attenuating the high frequency signal.

Images