Systems and methods for determining inertial measurement unit mounting misalignment on work vehicle

By calibrating IMU sensors through displacement and data collection, the method addresses misalignment issues, enhancing the precision and efficiency of work vehicle operations.

US20260366268A1Pending Publication Date: 2026-11-19DEERE & CO
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
US19/208740
Authority / Receiving Office
US · United States
Patent Type
Applications(United States)
Current Assignee / Owner
Filing Date
2025-05-15
Publication Date
2026-11-19

AI Technical Summary

Technical Problem

Existing work vehicles face inaccuracies in positional information due to misalignment of inertial measurement unit (IMU) sensors, leading to inefficiencies and reduced precision in performing work functions, particularly in high-precision applications.

Method used

A method for calibrating the orientation of IMU sensors relative to the vehicle body frame by displacing the body during specific orientations and collecting accelerometer data to determine misalignment, using calibration parameters to adjust sensor measurements.

Benefits of technology

Improves the accuracy of IMU sensor alignments, enabling precise positioning and enhanced performance of work functions by compensating for mounting errors, particularly in vehicles with limited swing motion.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure US20260366268A1-D00000_ABST
    Figure US20260366268A1-D00000_ABST
Patent Text Reader

Abstract

Systems and methods are provided for calibrating a misalignment between a sensor frame of an inertial measurement unit (IMU) sensor and a body frame of body, for example a body of an input-link of the four-bar mechanism, or a chassis frame of a chassis of a work vehicle to which the IMU sensor is mounted. A calibration matrix, such as a rotation matrix, can be identified that aligns the IMU frame of the IMU sensor to the body frame of the corresponding body. The IMU sensor can be excited by being displaced when at both raised and lowered orientations to collect associated angular velocity measurements from the IMU sensor. Such measurements, as well as an identification of an intermediate frame between the IMU frame and the body frame, can be used in connection with determining a misalignment of the IMU frame relative to body frame along a plurality of axes.
Need to check novelty before this filing date? Find Prior Art

Description

FIELD OF THE DISCLOSURE

[0001] The present disclosure generally relates to controlling the positioning of at least portions of work vehicles for performance of a work function, and, more specifically, to determining, and compensating for, mounting errors of sensors used in connection with the positioning of at least portions of a work vehicle by leveraging calibrated sensor accelerometer data.BACKGROUND

[0002] A variety of different types of work vehicles can be equipped with implements, including, for example, tools, for performing a work function. For example, a work vehicle, such as backhoe loader, can be equipped with an implement such as a backhoe bucket, for excavating and material handling functions, as well as a front loader tool, such as, for example, a loader bucket. Similarly, with respect to dozers, an implement, such as, for example, a blade, can be used for material handling, as well as for work functions involving grading a surface(s).

[0003] With respect to such types of work vehicles, a position of the implement, or other portions of the work vehicle, may be controlled in at least an attempt to accurately, and efficiently, perform the associated work function. For example, positional information can be utilized to determine the extent, if any, one or more actuators of the work vehicle are to be actuated, or cease being actuated, so as to attain proper positioning of the implement. Thus, the accuracy of such positional information can impact the quality, and efficiency, of the result(s) attained by the performance of the work function by the work machine. The accuracy of such positional information can particularly impact work functions that require relatively high degrees of precision, including, for example, at least certain high precision grade control applications.SUMMARY

[0004] The present disclosure may comprise one or more of the following features and combinations thereof.

[0005] In one embodiment of the present disclosure, a method is provided for calibrating a measured orientation of a sensor frame of a sensor mounted to a body of a work vehicle relative to an orientation of a body frame of the body. The method can include displacing, during a first displacement, the body about an axis of a swing body of the work vehicle while the body is maintained in a first orientation, and displacing, during a second displacement, the body about the axis of the swing body while the body is maintained in a second orientation, the second orientation being different than the first orientation. The method can further include determining a second calibration parameter corresponding to an estimated misalignment between a second axis of the sensor frame and a second axis of the body frame a third calibration parameter corresponding to an estimated misalignment between a third axis of the sensor frame and a third axis of the body frame. Additionally, the method can include determining, using at least the second and third calibration parameters, a first calibration parameter corresponding to a misalignment between the first axis of the sensor frame and the first axis of the body frame, and calibrating, using the first, second, and third calibration parameters, the measured orientation of the sensor based on the orientation of the body.

[0006] In another embodiment of the present disclosure, a method is provided for calibrating an orientation of a sensor frame of a sensor coupled to a chassis of a work vehicle relative to a chassis frame of the chassis. The method can include collecting, while the work vehicle is at a first position: (1) a first accelerometer data from the sensor corresponding to a first gravity measurement at the sensor frame, and (2) a first reference accelerometer data from a reference sensor corresponding to a first reference gravity measurement at a reference sensor frame of a reference sensor, the reference sensor positioned on a body of the work vehicle. The method can also include tilting at least a portion of the work vehicle from the first position to a second position and collecting, while the work vehicle is at a second position: (1) a second accelerometer data from the sensor corresponding to a second gravity measurement at the sensor frame, and (2) a second reference accelerometer data from the reference sensor corresponding to a second reference gravity measurement at the reference sensor frame. Additionally, the method can include transforming (1) the first reference accelerometer data to the chassis frame to derive a first transformed accelerometer data, and (2) the second reference accelerometer data to the chassis frame to derive a second transformed accelerometer data, and determining, using at least the first and second accelerometer data and the first and second transformed accelerometer data, a calibration parameter representative of a misalignment between the sensor frame and the chassis frame. Further, the calibration parameter can be used to adjust a measurement from the sensor to identify an orientation of the chassis.

[0007] These and other features of the present disclosure will become more apparent from the following description of the illustrative embodiments.BRIEF DESCRIPTION OF THE DRAWINGS

[0008] The disclosure contained herein is illustrated by way of example and not by way of limitation in the accompanying figures. For simplicity and clarity of illustration, elements illustrated in the figures are not necessarily drawn to scale. For example, the dimensions of some elements may be exaggerated relative to other elements for clarity. Further, where considered appropriate, reference labels have been repeated among the figures to indicate corresponding or analogous elements.

[0009] FIG. 1 illustrates an exemplary work vehicle in the form of a backhoe loader.

[0010] FIG. 2 illustrates a simplified block diagram of an exemplary system for determining, and compensating for, mounting errors of sensors used in connection with the positioning of at least portions of a work vehicle.

[0011] FIG. 3 illustrates a simplified flow diagram of an exemplary method for calibrating an alignment of an IMU sensor relative to a body to which an inertial measurement unit (IMU) sensor is mounted.

[0012] FIGS. 4A and 4B illustrate examples of a boom of the illustrated exemplary work vehicle being at opposing left and right positions, respectively, while in a first, raised position.

[0013] FIGS. 5A and 5B illustrate examples of the boom of the illustrated exemplary work vehicle being at opposing left and right positions, respectively, while in a second, lowered position.

[0014] FIGS. 6 and 7 illustrate graphical representations of a misalignment between a frame of an IMU sensor and a frame of an associated body to which the IMU sensor is mounted.

[0015] FIG. 8 illustrates a simplified flow diagram of an exemplary method for calibrating an alignment of a chassis IMU sensor relative to a chassis of a work vehicle to which the chassis IMU sensor is mounted.

[0016] FIG. 9A illustrates the exemplary work vehicle, and associated chassis, at a lowered position while the boom is in the raised position and the outriggers are at stowage positions.

[0017] FIG. 9B illustrates the exemplary work vehicle, and associated chassis, at a tilted position by an activation of the outriggers while the boom is in the raised position.

[0018] FIG. 10 illustrates a graphical representation of an exemplary relationship between a pitch angle variation for a body and a condition number.

[0019] Corresponding reference numerals are used to indicate corresponding parts throughout the several views.DETAILED DESCRIPTION

[0020] While the concepts of the present disclosure are susceptible to various modifications and alternative forms, specific embodiments thereof have been shown by way of example in the drawings and will be described herein in detail. It should be understood, however, that there is no intent to limit the concepts of the present disclosure to the particular forms disclosed, but on the contrary, the intention is to cover all modifications, equivalents, and alternatives consistent with the present disclosure and the appended claims.

[0021] References in the specification to “one embodiment,”“an embodiment,”“an illustrative embodiment,” etc., indicate that the embodiment described may include a particular feature, structure, or characteristic, but every embodiment may or may not necessarily include that particular feature, structure, or characteristic. Moreover, such phrases are not necessarily referring to the same embodiment. Further, when a particular feature, structure, or characteristic is described in connection with an embodiment, it is submitted that it is within the knowledge of one skilled in the art to effect such feature, structure, or characteristic in connection with other embodiments whether or not explicitly described. Additionally, it should be appreciated that items included in a list in the form of “at least one A, B, and C” can mean (A); (B); (C); (A and B); (A and C); (B and C); or (A, B, and C). Similarly, items listed in the form of “at least one of A, B, or C” can mean (A); (B); (C); (A and B); (A and C); (B and C); or (A, B, and C).

[0022] In the drawings, some structural or method features may be shown in specific arrangements or orderings. However, it should be appreciated that such specific arrangements and orderings may not be required. Rather, in some embodiments, such features may be arranged in a different manner or order than shown in the illustrative figures. Additionally, the inclusion of a structural or method feature in a particular figure is not meant to imply that such feature is required in all embodiments and, in some embodiments, may not be included or may be combined with other features.

[0023] Embodiments of the subject disclosure generally relate to use of information from an inertial measurement unit (IMU) sensor (e.g., gyroscope and / or accelerometer measurements) to calibrate an orientation of the IMU sensor relative to a body, including an input-link of the four-bar mechanism, to which the IMU sensor is mounted. For example, according to certain embodiments, the body can be a portion or component of, including attached to, a work vehicle, such as, for example, an arm, boom, or implement, among other components of the work vehicle. A calibration matrix, such as, for example, a rotation matrix, can be identified that aligns the IMU sensor, and, more specifically, a frame of the IMU sensor, also referred to as an IMU frame, with a frame of the corresponding body, referred to herein as a body frame. According to such embodiments, the IMU sensors can be excited by at least both a first displacement (e.g., swinging or rotational displacement) of the body when the body is at a first orientation (e.g., raised position), and a second displacement (e.g., swinging or rotational displacement) of the body when the body is at a second orientation (e.g., lowered position). Further, as the displacement of the body occurs, other portions of the work vehicle, including, for example, an operator cab, can generally remain static, and, moreover, not be part of the displacement. Thus, for example, embodiments of the subject application can have particular applicability to work vehicles having limited ranges of motion, including, with respect to being generally limited to movement of a portion or component, such as, for example, an arm, boom, or implement, while other portions of the work vehicle, including, for example, an operator cab, remain static.

[0024] The information, including signals, provided by the IMU sensor (e.g., gyroscope signals) collected during the first and second displacements can then be used to estimate, or, alternatively, precisely determine, the misalignment angles that define the calibration matrices for the IMU sensor. For example, the information (e.g., data) collected during at least the first and second displacements of the body can be processed, such as, for example, by a calibration algorithm or model, to calibrate a position of the IMU frame relative to the body frame. With the IMU frame calibrated, a reference acceleration vector can be projected onto a chassis of the vehicle, and a TRIAD method can be used to determine the calibration, or rotation, matrix between the reference acceleration and an acceleration measured by an IMU sensor of a chassis of the vehicle.

[0025] The approaches provided herein for determining and compensating for IMU sensor misalignment are particularly beneficial with respect to certain work vehicles that have limited ranges of swing motion, including with respect to exciting the IMU sensors during calibration related processes. Additionally, the approaches discussed herein provide an alternative solution for calibration of IMU sensors mounted to a work vehicle chassis, also referred to herein as a chassis IMU sensor(s), that does not involve exciting the chassis IMU sensor. Moreover, such an approach provides an alternative solution for determining a mounting error for chassis IMU sensors used with chasses that are not rotatable. As discussed below, such an approach can include leveraging calibrating IMU accelerator information, including data, to determine, including estimate, mounting errors relating to chassis IMU sensors.

[0026] FIG. 1 illustrates an exemplary work vehicle 100 in the form of a backhoe loader. While FIG. 1 illustrates a particular type of work vehicle, embodiments of the subject disclosure are applicable to a variety of work vehicles, including, but not limited to, for agricultural, construction, forestry, and landscaping vehicles, among others. For example, in addition to backhoe loaders, embodiments of the subject application can be used with excavators, skid steer loaders, compact track loaders, graders, crawlers, and dozers, among others. Additionally, the work vehicle 100 can be a manually operated work vehicle 100, or, alternatively, an autonomous or semi-autonomous work vehicle.

[0027] The work vehicle 100 can include a rear-mounted backhoe 102 at a rear end of the work vehicle 100, and a front-mounted loader 104 at an opposing front end of the work vehicle 100. The backhoe 102 can include an implement 106, which in the illustrated example is a bucket, and a linkage 108 that can, in this example, include a boom 110 and an arm 112. A first end of the boom 110 is pivotally connected to a swing frame assembly 114 at a first pivot 116, the first pivot 116 having a single degree of freedom in the pitch direction with respect to the swing frame assembly 114. A second end of the boom 110 is pivotally connected to a first end of the arm 112 at a second pivot 117, the second pivot 117 having a single degree of freedom in the pitch direction with respect to the arm 112. A second end of the arm 112 is pivotally connected to the implement 106 by a third pivot 119, the third pivot 119 having a single degree of freedom in the pitch direction with respect to the implement 106.

[0028] The work vehicle 100 can also include outrigging 118 for raising at least a portion of, and stabilizing, the work vehicle 100 during a work function. The outrigging 118 can include a pair of outriggers 120 that are pivotally attached to opposite sides of a chassis 122 of the work vehicle 100. The outriggers 120 are movable between a stowage position (FIG. 5A) for stowage of the outriggers 120 during periods of non-use and a vehicle stabilizing deployed position (FIGS. 1 and 5B). Each outrigger 120 can be configured to minimize the lateral clearance needed for the deployment of the outriggers 120, and to promote lateral stability of the work vehicle 100.

[0029] In the illustrated example, the outrigging 118 is attached to the chassis 122 at a rear portion of a tractor portion 124 of the work vehicle 100, and are configured for use in conjunction with a rear-mounted backhoe 20. In this configuration, to prepare for a work function of the backhoe 102 (e.g., digging, material handling), an operator of the work vehicle 100, or the work vehicle 100, can deploy the outriggers 120 to their deployed position to lift or otherwise support the rear portion of the tractor portion 124. Thus, in at least certain situations, such deployment of the outriggers 118 may raise at least the rear engagement bodies 126 (e.g., rear wheels) off the adjacent ground surface while the front engagement bodies 125 (e.g., front wheels) may remain engaged with the ground surface. With the outriggers 118 deployed, the work vehicle 100 can be ready for use of the backhoe 20 in connection with performance of a work function (e.g., digging, material handling). When performance of the work function is completed, or is otherwise to at least temporarily stop or be suspended, the outriggers 120 can be retracted to their stowage position next to the chassis 122. With such retraction of the outriggers 120, to the extent the rear engagement bodies 126 were elevated, the return of the outriggers 120 to the stowage position can result in the rear engagement bodies 126 being lowered down into contact with the adjacent ground surface.

[0030] FIG. 2 illustrates a simplified block diagram of an exemplary system 200 for determining, and compensating for, mounting errors of sensors used in connection with the identifying the positioning of at least portions of a work vehicle 100. As illustrated, the detection system 200 can include a controller(s) 202 having one or more processors 204 and one or more memory devices 206. The processors 204 can be configured to follow instructions, including control instructions contained with, or are part of, one or more of the memory devices 206, including, for example, a non-transitory machine-readable medium.

[0031] The processors 204 can be embodied as any type of processor or other compute circuit capable of performing various tasks. In some embodiments, each processor 204 can be embodied as a single or multi-core processor, a microcontroller, or other processing or controlling circuit. Additionally, in some embodiments, each processor 204 can be embodied as, include, or be coupled to an FPGA, an application specific integrated circuit (ASIC), reconfigurable hardware or hardware circuitry, or other specialized hardware to facilitate performance of the functions described herein. In some embodiments still, each processor 204 can be embodied as a high-power processor, an accelerator co-processor, an FPGA, or a storage controller.

[0032] Each memory device 206 can be embodied as any type of volatile (e.g., dynamic random-access memory (DRAM), etc.) or non-volatile memory capable of storing data therein. Volatile memory can be embodied as a storage medium that requires power to maintain the state of data stored by the medium. Non-limiting examples of volatile memory can include various types of random-access memory (RAM), such as dynamic random-access memory (DRAM) or static random-access memory (SRAM). In some embodiments, each memory device 206 can be embodied as a block addressable memory, such as those based on NAND or NOR technologies. Each memory device 206 can also include future generation nonvolatile devices or other byte addressable write-in-place nonvolatile memory devices. Additionally, in some embodiments, each memory device 206 can be embodied, or otherwise include, a memory device that uses chalcogenide glass, multi-threshold level NAND flash memory, NOR flash memory, single or multi-level Phase Change Memory (PCM), a resistive memory, nanowire memory, ferroelectric transistor random access memory (FeTRAM), anti-ferroelectric memory, magnetoresistive random access memory (MRAM) memory that incorporates memristor technology, resistive memory including the metal oxide base, the oxygen vacancy base and the conductive bridge Random Access Memory (CB-RAM), or spin transfer torque (STT)-MRAM, a spintronic magnetic junction memory based device, a magnetic tunneling junction (MTJ) based device, a DW (Domain Wall) and SOT (Spin Orbit Transfer) based device, a thyristor based memory device, or a combination of any of the above, or other memory. Each memory device 206 can refer to the device itself or to a packaged memory product. In some embodiments still, 3D crosspoint memory can comprise a transistor-less stackable cross point architecture in which memory cells sit at the intersection of word lines and bit lines and are individually addressable and in which bit storage is based on a change in bulk resistance. In some embodiments yet still, all or a portion of each memory device 206 can be integrated into the processor(s) 204. Regardless, each memory device 206 can store various software and data used during operation such as task request data, kernel map data, telemetry data, applications, programs, libraries, and drivers. Thus, the memory devices 206 can include information, including, but not limited to, algorithms and look-up tables, among other information, that can used by the processor 204, including with respect to features corresponding to calibrating one or more sensors relative to at least an associate chassis 122 of the work vehicle 100, as discussed below.

[0033] The system 200 can further include an actuator system 208 having a plurality of actuators to displace one or more bodies of the work vehicle 100. The number, type, position, and / or direction(s) of displacement of the bodies, as well as the types of actuators for the different bodies, can vary for different types of work vehicles 100 and / or associated implements. For example, according to certain embodiments, the actuators of the actuator system 208 can include one or more pneumatic, hydraulic electric, and / or mechanical actuators, such as, for example, cylinders, motors, engines, and / or solenoids, among others, that can be used in connection with linear and / or rotary movement.

[0034] For example, with respect to the work vehicle 100 illustrated in FIG. 1, the work vehicle 100 can have a plurality of bodies, such as, for example, the boom 110, the arm 112, and / or the implement 106, among others. According to such an embodiment, the actuator system 208 can include a swing actuator 216 that, when actuated, can facilitate rotational displacement of the linkage 108, and, moreover, the boom 110, about a vertical axis (as generally referenced by “z-axis” in FIG. 1) of a swing frame of the swing frame assembly 114. The actuator system 208 can also include at least a boom actuator 210 that can facilitate displacement of the boom 110 about the first pivot 116, an arm actuator 212 that that can facilitate displacement of the arm 112 about the second pivot 117, and an implement actuator 214 that can facilitate displacement of the implement 106 about the third pivot 119.

[0035] The actuator system 208 can further include an outrigger actuator 218 that is configured to be selectively actuated in connection with the deployment or stowage of the outriggers 120. For example, according to certain embodiments, each outrigger 120 can have a foldable stabilizer arm 128 and a foot 130. The foldable stabilizer arm 128 can be displaceable in response to an actuation of the outrigger actuator 218 in a manner that can move the foot 130 between the stowage and deployed positions. Similar to at least some of the actuators 210, 212, 214, 216 of the actuator system 208, according to certain embodiments, the outrigger actuator 218 can, for example, be a linear actuator in the form of a hydraulic cylinder, among other types of actuators.

[0036] Each of the actuators 210, 212, 214, 216, 218 of the actuator system 208 can be selectively actuated independent of, or, alternatively, in connection with, the activation of at least some, if not all, of the other actuator 210, 212, 214, 216, 218. Additionally, actuation at least some, if not all, of the actuators 210, 212, 214, 216, 218 can be in response to a signal generated by the controller 202, including the processor 204, based on a command manually inputted by an operator via use of an input device 220 or automatically generated by the controller 202. One or more input devices 220 can be located at the work vehicle 100, such as, for example, within the operator cab of the tractor portion 124. Alternatively, or additionally, the input device 220 be separate from, including, for example, remote from, the work vehicle 100. Examples of input devices 220 include, for example, one or more keyboards, keypads, touch screens, mouse, buttons, joysticks, switches, or mobile personal computing devices, such as, for example, mobile phones, smart phones, or tablets, as well as combinations thereof, among other types of input devices 220. Such input devices 220 can be configured to receive information, commands, or instructions inputted by an operator of the work vehicle 100, including with respect to commands that facilitate activation of one or more actuators 210, 212, 214, 216, 218 of the actuator system 208. Similarly, the work vehicle 100 can include one or more output devices 222, including, for example, one or more displays or touchscreens, among other types of output devices. Further the input device 220 and the output device 222 can either, or both, be local to, or remote from, the agricultural vehicle 100, and may, or may not, be part of the same device (e.g., a touch screen).

[0037] The system 200 can further include a sensor system 224 having one or more IMU sensors 228, 230, 232 that are configured to measure movement in multiple axes and that are mounted to one or more bodies of the work vehicle 100, as seen in FIG. 1. According to certain embodiments, the IMU sensors 228, 230, 232 can provide at least both accelerometer and gyroscope features and / or information. For example, as seen in FIGS. 1 and 2, the sensor system 224 can include a boom IMU sensor 228 that is mounted to the boom 110, an arm IMU sensor 230 that is mounted to the arm 112, an implement IMU sensor 232 that is mounted to the implement 106, and a chassis IMU sensor 234 that is mounted to the chassis 122, among other IMU sensors. Additionally, according to certain embodiments, the sensor system 224 can include a rotary sensor 226, such as, for example, a rotary encoder, that is mounted to the swing frame assembly 114 that can sense information, including rotary speed and displacement, of the boom 110 about the swing frame assembly 114, and, more specifically, about the z-axis of the swing frame assembly 114, as illustrated, for example, in FIG. 1.

[0038] Each component, or body, of the work vehicle 100 to which an IMU sensor 228, 230, 232 is mounted can be defined by an associated body frame that can provide a three-dimensional coordinate system for that body. Accordingly, terms such as “body” and “body frame” can be used generically herein. Thus, for example, referencing FIG. 6, with respect to a “body” in the form of the boom 110, the associated “Body Frame” (as identified in FIG. 6) corresponding to the boom frame can be represented by a three-dimensional coordinate system (x-y-z), as illustrated by the frame shown in solid line format in FIG. 6. In this example, the y-axis of the identified body frame (e.g., boom frame) for the boom 110 is extending in a direction out from the page of the reader. Another body frame can be provided for the swing frame assembly 114, which, for purposes of clarity, is referred to in FIG. 6 as the “Swing Frame” rather than as another “body frame”. In this example, similar to the illustrated “body frame” for the boom 110 (e.g., “body”), the y-axis of the “swing frame” also extends in a direction out from the page of the reader. As also seen in FIG. 6, a frame, also referred to as an “IMU frame”, of the EIU sensor mounted to the body, which, in this example, is the IMU sensor 228 that is mounted to the boom 110, has an IMU frame that is also defined in three-dimensions.

[0039] Information provided by the IMU sensors 228, 230, 232 can be used, for example, via sensor fusion, to provide information that can be used to determine joint angles between different bodies of the work vehicle 100. Such joint angles, and the associated bodies, can include, for example, a boom joint angle at the first pivot 116 between the first end of the boom 110 and the swing frame assembly 114, an arm joint angle at the second pivot 117 between the second end of the boom 110 and the first end of the arm 112, and an implement joint angle at the third pivot 119 between the second end of the arm 112 and the implement.

[0040] Reliable, accurate determinations, including estimations, of such joint angles are at least partially dependent on the accuracy of the mounting, and, moreover, alignment, of the IMU sensors 228, 230, 232 relative to the associated body 106, 110, 112 to which the particular IMU sensor 228, 230, 232 is mounted. However, often in real-world applications, an IMU sensor 228, 230, 232 is mounted to the associated body 106, 110, 112 in a manner in which the IMU frame of the IMU sensor 228, 230, 232 is misaligned with the body frame of the associated body 106, 110, 112. FIG. 6 illustrates an example of such misalignment between the axes (x, y, z) of the IMU frame for the IMU sensor 228 that is mounted to the exemplary body (e.g., boom 110) and the associated body frame (e.g., boom frame).

[0041] Such mounting errors, and, moreover a misalignment between an IMU sensor 228, 230, 232 and the associated body 106, 110, 112, can at least contribute to inaccurate joint angle determinations. Reliance on such inaccurate joint angle determinations can prevent the implement 106, among other portions of the work vehicle 100, from being operated, including positioned, in a manner that can facilitate the ability of the work vehicle 100 to perform a work function with a desired degree of precision and accuracy. However, as discussed below, embodiments of the subject disclosure provide systems and methods for attaining determinations, including estimates, of such mounting errors, as well as compensating for such determined mounting errors in order to accurately determine, including estimate, joint angles.

[0042] FIG. 3 illustrates a simplified flow diagram of an exemplary method 300 for calibrating an alignment of an IMU sensor 228, 230, 232 relative to a body 106, 110, 112 to which the IMU sensor 228, 230, 232 is mounted. The method 300 is described below in the context of being carried out by the illustrated exemplary system 200. However, it should be appreciated that method 300 can likewise be carried out by any of the other described implementations, as well as variations thereof. Further, the method 300 corresponds to, or is otherwise associated with, performance of the blocks described below in the illustrative sequence of FIG. 3. It should be appreciated, however, that the method 300 can be performed in one or more sequences different from the illustrative sequence. Additionally, one or more of the blocks mentioned below may not be performed, and the method 300 can include steps or processes other than those discussed below.

[0043] At block 302, the controller 202 can generate one or more signals to facilitate the work vehicle 100 being brought to, and maintained in, a generally static state. According to certain embodiments, the controller 202 can generate such signals automatically, or, alternatively, in response to one or more commands provided by the operator using the input device 220. According to certain embodiments, prior to attaining the static state, the controller 202, either automatically or in response to one or more commands inputted by the operator by use of the input device 220, can place at least a portion of the work vehicle 100, such as, for example, at least one or more bodies having one or more IMU sensors 228, 230, 232 that are to be calibrated via the method 300, in a first, predetermined orientation. For example, with respect to embodiments in which the work vehicle 100 is a backhoe loader, block 302 can include, prior to the work vehicle 100 being placed in the static state, placing the backhoe 102, including, for example, the linkage 108 and implement 106 in a first, predetermined orientation, at which the linkage 108 is in a raised and retracted position (e.g., boom 110 raised and arm 112 retracted), and the implement 106 is inwardly positioned relative to the tractor portion 124 (e.g., the implement 106 being fully curled). Additionally, prior to the work vehicle 100 being placed in the static state, the backhoe can also be rotated such that the backhoe is both in the first position and at a first side, such as, for example, a right side, of the work vehicle 100.

[0044] At block 304, the controller can determine whether the work vehicle 100 is at the static state and moreover, that the work machine 100, as well as components thereof, including for example, the backhoe 102 and front-mounted loader 104, are generally not moving. The controller 202 can be determine whether the work vehicle 100 is in the static state in a variety of different manners, including, for example, based on information provided by one or more IMU sensors 228, 230, 232 of the sensor system 224, among other sensors and information. If the controller 202 determines at block 304 that the work vehicle 100 is not in the static state, the controller 202 can wait, such as, for example, for a predetermined time period, before again attempting to determine whether, based on updated information, the work vehicle is in the static state.

[0045] At block 306, the controller 202 can be used to remove IMU bias, which may be related to inherent errors in the IMU sensor(s) 228, 230, 232, can that result from imperfections in the manufacturing and assembly of the IMU sensor(s) 228, 230, 232. These biases can affect both accelerometers and gyroscopes by introducing systematic errors that can alter the accuracy of the IMU sensor 228, 230, 232 readings. With respect to IMU sensors 228, 230, 232 that include accelerometers, such bias can be in the form of offset errors that can distort the measurements of acceleration. With respect to IMU sensors 228, 230, 232 that also include in gyroscopes, such bias can manifest as drift that can causing angular errors to accumulate over time. Addressing these biases at block 306 can assist in attaining precise positioning and orientation measurements that are based at least on information provided by the IMU sensor(s) 228, 230, 232, and / or with respect to calibrating the alignment of IMU sensor(s) 228, 230, 232 of the bodies of the work vehicle 100.

[0046] With the work vehicle 100 in the static state, and the bias removed from the IMU sensors 228, 230, 232, at block 308 a signal can be generated by the controller 202 to displace one or more bodies of the work vehicle 100 in a manner that can excite one or more of the IMU sensors 228, 230, 232. The signal generated by the controller 202 can be in response to a command inputted by the operator via use of the input device 220, or automatically generated by the controller 202. Further, the portion, or one or more bodies, of the work vehicle 100 that is / are to be displaced can be at least partially dependent on the particular IMU sensor(s) 228, 230, 232 that is / are to be excited.

[0047] For example, according to embodiments in which the work vehicle 100 is a backhoe loader, the bodies that are to be displaced, and the IMU sensors 228, 230, 232 that are to be excited, at block 308 can include at least a portion of the linkage 108, including either or both the boom 110 and the arm 112, and the implement 106. Thus, for example, the displacement at block 308 can, according to certain embodiments, involve, displacing at least a portion of the linkage 108 (e.g., boom 110 and arm 112) and the implement 106 while the backhoe 102 is at the first orientation (e.g., boom 110 raised, arm 112 retracted, implement 106 fully curled), as discussed above with respect to FIG. 4A. Moreover, such displacement while the backhoe 102 is at the first orientation can involve the controller 202 generating a signal to operate the swing actuator 216 to rotate (e.g., swing) the linkage 108 and the implement 106 about a z-axis of the swing frame assembly 114 (as generally indicate by rotation “r” in FIGS. 6 and 7 about the “z“axis” from a first side (e.g., right side) of the work vehicle 100 (FIG. 4A) to a second side (e.g., left side;

[0048] FIG. 4B) of the work vehicle 100, and vice versa, one or more times. The number of times the backhoe 102 is swung between opposing sides of the work vehicle 100, the angular displacement of such rotatable displacement, and the speed of displacement can vary. For example, according to certain embodiments, such angular displacement may have a velocity sufficient to excite the IMU sensors 228, 230, 232 while not overexciting the IMU sensors 228, 230, 232 in a manner that could otherwise render the collected information unusable or unreliable. Additionally, the degree of rotation, or extent to which the backhoe 102 is displaced to either side of the work vehicle 100, can be limited, such, as for example, based on the physical constraints or limitations of the work vehicle 100, among other considerations.

[0049] At block 310, the controller 202 can determine whether the displacement that occurred, or occurring, at block 308 satisfied, or is satisfying, one or more first predetermined thresholds. Such thresholds can be at least partially based on at least attempting to collect reliable and accurate data from the excitation of the IMU sensors 228, 230, 232. Thus, for example, such first predetermined thresholds can be based on attaining sufficient, but not excessive, excitation of the IMU sensors 228, 230, 232.

[0050] For example, according to certain embodiments, the first predetermined threshold(s) at block 310 can correspond to a velocity, including, for example, an angular velocity, of the body(ies) and / or the IMU sensors 228, 230, 232. Further, for example, the first predetermined threshold can be a value, or range of values, such as, for example, a minimum and / or maximum angular velocity. Additionally, or alternatively, the first predetermined threshold can be at least partially defined relative to one or more other features or measurements including, with respect to features of the IMU sensors 228, 230, 232. For example, according to certain embodiments, the first predetermined threshold can be a minimum angular velocity that can be at least partially defined relative to an actual, or anticipated, noise of the IMU sensor(s) 228, 230, 232. For instance, according to certain embodiments, the first predetermined threshold can be a minimum angular velocity that is around at least 50 or 100 times higher than the magnitude of the noise of the IMU sensor(s) 228, 230, 232.

[0051] If the controller 202 determines at block 310 the first predetermined threshold(s) was not satisfied, the method 300 can return to block 308, wherein the bodies (e.g., boom 110, arm 112, and / or implement 106) again undergo a repeat of the first displacement while in the first orientation before that subsequent displacement is evaluated at block 310 with respect to the first predetermined threshold(s).

[0052] If the controller 202 determines at block 310 that the first predetermined threshold(s) is / was satisfied, then, to the extent not already collected, at block 312 information, including data, can be collected that was generated by the excited IMU sensor(s) 228, 230, 232 from the first displacement of the body(ies). For example, the controller 202 can generate one or more signals to facilitate information outputted by the IMU sensor(s) 228, 230, 232 being collected and stored by the memory device 206 at block 312.

[0053] The method 300 can then proceed to block 314, wherein one or more, if not all, of the bodies (e.g., boom 110, arm 112, and / or implement 106), and the associated IMU sensor(s) 228, 230, 232, can again be displaced to a second orientated that is at least partially different than the first orientation from block 308. For example, according to certain embodiments in which the body(ies) relate(s) to a backhoe 102 of a backhoe loader, and at least relative to the first orientation, the second orientation can have the linkage 108 and implement at a lowered orientation, as illustrated by FIG. 4B. Thus, as shown by the example provided by FIG. 4B, when at the lowered orientation, unlike the first orientation, the boom 110 can be at a lowered position, while the arm 112 remains retracted and the implement 106 remains at the curled position.

[0054] According to certain embodiments, placement of the body(ies) in the second orientation can be facilitated by the controller 202 generating one or more signals automatically or in response to a command inputted by the operator via use of the input device 220. Additionally, at block 314, the controller 202 can generate, automatically or in response to a command inputted by the operator via use of the input device 220, a signal to facilitate the second displacement of the body(ies) while the body(ies) are at the second orientation. According to certain embodiments, the second displacement can be generally similar to the first displacement but involve at least one or more of the bodies being at a different orientation, including, for example, with respect to an elevation or vertical position, among other orientations. Thus, for example, similar to the first displacement, the second displacement can, according to certain embodiments, involve the controller 202 generating one or more signals to activate the swing actuator 216 such that the linkage 108 and the implement 106 are rotated about the z-axis of the swing frame assembly 114 from a first side (e.g., right side) of the work vehicle 100 (FIG. 4A) to a second side (e.g., left side; FIG. 4B) of the work vehicle 100, and vice versa, one or more times.

[0055] At block 316, the controller 202 can determine whether the second displacement at the second orientation of the body(ies) satisfied one or more second predetermined thresholds. Such a determination at block 316 can be similar to the determination discussed above with respect to block 310 and the first displacement. Further, the one or more second predetermined thresholds evaluated at block 316, including the value(s) or range of values for the second predetermined threshold(s) with respect to the second displacement may, or may not, be the same type of first predetermined threshold(s) evaluated at block 310 with respect to the first displacement. For example, according to certain embodiments, the first and second predetermined thresholds can each be an angular velocity that may, or may not, involve a similar minimum angular velocity threshold or range of thresholds.

[0056] If the controller 202 determines at block 316 that the second predetermined threshold is satisfied, then, similar to block 312, to the extent not already collected, the data acquired from the excited IMU sensor(s) 228, 230, 232 during the second displacement of the body(ies) at the second orientation can be collected at block 318, including recording by the memory device 206.

[0057] At block 320, the controller 202 can determine whether the data collected at either, or both, block 312 and block 318 satisfies one or more predetermined verification thresholds. Moreover, at block 320, the controller 202 can determined whether the data collected from the excited IMU sensor(s) 228, 230, 232 from the first displacement of the body(ies) at the first orientation and / or the data collected from the second displacement of the body(ies) at the second orientation satisfies one or more predetermined verification thresholds. Such verification of the quality of data collected from the IMU sensor(s) 228, 230, 232 at blocks 312 and 318 can be performed in a variety of manners, including, for example, comparing at least a portion of the collected data with one or more predetermined values, or ranges of values, that may be anticipated to correspond to quality data. Additionally, or alternatively, such a verification analysis can involve a relative comparison of data collected at block 312 in connection with the first displacement at the first orientation to data collected at block 318 in connection with the second displacement at the second orientation.

[0058] According to certain embodiments, the verification of the quality of the collected data at block 320 can include verifying the correct boom joint order position. Such a verification can include, for example, analyzing data corresponding to the gyroscope portion of the IMU sensor(s) 228, 230, 232. Moreover, such a verification can include a comparison of the relative magnitude of an angular velocity vector over the x-axis obtained during the first displacement to the relative magnitude of an angular velocity vector over the x-axis obtained during second displacement, as represented, for example, by:<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯x,1<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics><semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯x,1<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>+<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯y,1<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>+<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯z,1<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>><semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯x,2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics><semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯x,2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>+<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯y,2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>+<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯z,2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>(1)wherein ω1 is an accumulated measured angular velocity reading from an IMU sensor 228, 230, 232 along the x, y, and z axes (e.g., ωx,1, {circumflex over (ω)}y,1, {circumflex over (ω)}z,1, respectively) during the first displacement at the first orientation, and {circumflex over (ω)}2 is an accumulated measured angular velocity reading from an IMU sensor 228, 230, 232 along the x, y, and z axes (e.g., ωx,1, {circumflex over (ω)}y,1, {circumflex over (ω)}z,1, respectively) during the second displacement at the second orientation.Additionally, or alternatively, the evaluation at block 320 can include determining whether the differences between the first and second orientations satisfied a predetermined threshold. For example, according to certain embodiments, the evaluation can involve verifying, from the information collected at block 312 and block 318, that the boom joint angle, such as, for example, a difference in the angle between the boom 110 and the swing frame assembly 114 at the first orientation and at the second orientation, satisfies, if not exceeds, a predetermined amount, including a predetermined range of angles. According to certain embodiments, such a verification can be evaluated using the following:acos⁢(ω¯1⁢·ω¯2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯1<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>⁢<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>ω¯2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>)>Δ⁢θminPitchThr(2)wherein ΔθminPitchThr is a threshold variation for the difference between the boom joint angle at the first and second orientations, acos is an abbreviation for arccosine, and ω1 and ω2 are, again, accumulated measured angular velocity readings from an IMU sensor 228, 230, 232 along the x, y, and z axes during the first displacement at the first orientation and during the second displacement at the second orientation, respectively.If the controller 202 determines at block 320 that the collected data does not satisfy the predetermined verification threshold(s), or is otherwise unreliable or not considered quality data, then the method 300 can proceed with block 322, wherein the method 300 can be aborted or otherwise concluded. In such situations, the method 300 may be restarted or repeated in another, subsequent attempt attain quality data.If however the controller 202 determines at block 320 that quality data has been obtained, then the method 300 can proceed with the controller 202 utilizing at least the data collected at blocks 312 and 318 to calibrate the orientation, including location or position, of the IMU sensor(s) 228, 230, 232 relative to the associated body(ies) 106, 110, 112, and, moreover, the IMU frame of the IMU sensor 228, 230, 232 relative to a body frame for the associated body 106, 110, 112 to which the IMU sensor 228, 230, 232 is mounted. According to certain embodiments, such calibration can include, at block 324, the controller 202 determining calibration parameters for one or more IMU sensors 228, 230, 232, or IMU frame, relative to the associated body, or body frame.

[0062] In the illustrated example, determining calibration parameters at block 324 can include identifying a rotation matrix that can be used to describe the orientation, including misalignment, of the IMU frame relative to the corresponding body frame. For example, according to the exemplary embodiment discussed herein, the rotation matrix can be identified as a ZYX rotation matrix, or having a ZYX rotation order. By using the rotation matrix to describe orientation, including misalignment, of the IMU frame relative to the corresponding body frame, the misalignment in at least one direction, or along one degree of freedom, can be decoupled from the orientation, including misalignment, in other directions or along other degrees of freedom.

[0063] According to certain embodiments, the three-dimensional rotation matrices can be expressed as:Rχ(ϕ)=[1000c⁢ϕ-s⁢ϕ0s⁢ϕc⁢ϕ](3⁢a)Ry(θ)=[c⁢θ0s⁢θ010-s⁢θ0c⁢θ](3⁢b)Rz(ψ)=[c⁢ψ-s⁢ψ0s⁢ψc⁢ψ0001](3⁢c)wherein Rx(φ) is the rotation matrix corresponding to the roll rotation along the x-axis, Ry(θ) is the rotation matrix corresponding to the pitch rotation along the y-axis, Rz(ψ) is the rotation matrix corresponding to the yaw rotation along the z-axis, φ is a roll rotation from the positive x-axis, θ is pitch rotation along the y-axis, ψ is yaw rotation along z-axis, c is an abbreviation for cosine, and s is an abbreviation for sine.Using at least information similar to that shown in Equations (3a), (3b), (3c)), an inverse of a transformation matrix can be obtained by transposing a rotation matrix(Rimu ref )so as to provide:Rimu ref =[Rimu ref ]T=[Rz(ψ)⁢ Ry(θ)⁢Rx(ϕ)]T=Rx(-ϕ)⁢Ry(-θ)⁢Rz(-ψ)=[c⁢θ⁢ c⁢ψc⁢θ⁢ s⁢ψ-s⁢θc⁢ψ⁢s⁢ϕ⁢s⁢θ-c⁢ϕ⁢s⁢ψc⁢ϕ⁢c⁢ψ+s⁢ϕ⁢ s⁢θ⁢s⁢ψc⁢θ⁢s⁢ϕc⁢θ⁢ c⁢ψ⁢s⁢θ+s⁢ϕ⁢s⁢ψc⁢ϕ⁢s⁢θ⁢s⁢ψ-c⁢ψ⁢s⁢ϕc⁢θ⁢c⁢ϕ ](4)whereinRimu ref =Rz(ψ)⁢Ry(θ)⁢Rx(ϕ),withRref imu representing a rotation matrix corresponding to a misalignment of an IMU frame (e.g., “imu”) relative to a selected reference frame (“ref”),Rimu ref represents a rotation matrix corresponding to the misalignment of the selected reference frame (“ref”) relative to the IMU frame, and Rz(ψ), Ry(θ), and Rx(φ) again correspond to the rotation matrices for the yaw rotation along the z-axis, pitch rotation along the y-axis, and roll rotation along the x-axis, respectively, as discussed above with respect to Equations (3a), (3b), and (3c).In sensor fusion applications for vehicles, including equipment, such as or similar to that shown in FIG. 1, the IMU sensors 228, 230, 232 mounted on bodies 106, 110, 112 of the vehicle 100 are roughly aligned to the nominal body frames of those bodies 106, 110, 112 to which the IMU sensor(s) 228, 230, 232 is / are mounted. Accordingly, the misalignment, if any, between an IMU sensor 228, 230, 232, or the associated IMU frame, and the corresponding nominal body frame of the body 106, 110, 112 to which the IMU sensor 228, 230, 232 is mounted can be described by relatively small angles. For example, if angles of such misalignment in two directions are represented as small angles δα and δβ, the following approximations can be utilized:sin(δα)≈δα  (5a)cos(δα)≈1  (5b)sin(δα)sin(δβ)≈0  (5c)By applying such approximations (Equations (5a, 5b, 5c)) into Equation (4), a transformation matrix that transforms a vector from the nominal body frame of a body 106, 110, 112 of the vehicle 100, among other equipment, to an IMU frame of an IMU sensor 228, 230, 232 that is mounted to that body 106, 110, 112 can be approximated by the following skew symmetric matrix:Rbody⁢_⁢imubody≈[1-δ⁢ψδ⁢θδ⁢ψ1-δ⁢ϕ-δ⁢θδ⁢ϕ1](6)whereinRbody⁢_⁢imubodyis the rotation matrix corresponding to the misalignment of the body frame (“body”) of the body 106, 110, 112 relative to the IMU frame (“body_imu”) of the particular IMU sensor 228, 230, 232 that is mounted to that body 106, 110, 112, δφ is a difference in roll rotation along the x-axis, δθ is a difference in pitch rotation along the y-axis, and δθψ is a difference in yaw rotation along the z-axis. Further, the corresponding inverse matrix for the symmetric matrix of Equation (6) can be expressed as:Rbody⁢_⁢imubody=[Rbody⁢_⁢imubody]T=[1δ⁢ψ-δ⁢θ-δ⁢ψ1δ⁢ϕδ⁢θ-δ⁢ϕ1](7)whereinRbody⁢_⁢imubodyis the rotation matrix corresponding to the misalignment of the IMU frame of the IMU sensor 228, 230, 232 that is mounted to that body 106, 110, 112 relative to the body frame (“body”) of the body 106, 110, 112 to which the particular IMU sensor 228, 230, 232 is mounted.FIGS. 6 and 7 illustrate examples of the orientations along three axes (x, y, z) of at least the swing frame of the swing frame assembly 114, an IMU frame of an IMU sensor 228, 230, 232, and the body frame of an associated body 106, 110, 112 of the work vehicle 100 to which the IMU sensor 228, 230, 232 is attached. Thus while the below example is discussed with respect to a body frame for an unspecified body, approaches similar to that discussed herein can be utilized with respect to the determining the orientation, or associated misalignment, of the IMU frame of the IMU sensor 230 that is coupled to the arm 112, the IMU frame of the IMU sensor 228 that is coupled to the boom 110, or the IMU frame of the IMU sensor 232 that is coupled to the implement 106, among other IMU sensors and associated bodies. Similarly, while the examples discussed herein relate to components of a backhoe loader, such approaches can be used with other types of bodies for other types of vehicles. Further, in the below approach, assumptions can include that work vehicle tolerances are negligible, the swing frame rotates over a true work vehicle vertical axis (z-axis of the chassis frame), IMU sensor biases, and specifically gyroscope biases, have been already compensated, and for the first body position, all the work vehicle joint angles are known. Knowledge of such work vehicle joint angles, such as, for example, angles between the swing frame assembly 114 and the boom 110, the boom 110 and the arm 112, and the arm 112 and the implement 106 can be obtained in a variety of manners, including, for example, via an external laser measurement system that can obtain true nominal angles between bodies when the work vehicle 100, and, moreover, the bodies of the linkage 108, is / are at a known position(s).In the examples shown in FIGS. 6 and 7, the y-axis for both the body frame and the swing frame are illustrated as extending in a direction toward and away from the page being read by the reader, and, moreover, is perpendicular to the surface of the page. Further, the illustrated swing frame assembly 114 is coupled to the base of the boom 110 and provides a rotation (as generally indicated by “ri” in FIG. 7) about the z-axis of the swing frame. Additionally, as seen in FIGS. 6 and 7, the body frame is rotated only over the y-axis of the swing frame, and not over the z-axis or x-axis.According to certain embodiments, a transformation matrix convention can be determined, including identified, that can describe the orientation, or misalignment, of the IMU frame with respect to the corresponding body frame of the body 106, 110, 112 to which the IMU sensor 228, 230, 232 is mounted. Moreover, the transformation matrix convention can, for example, be established to isolate an orientation, or misalignment, of the IMU frame of the IMU sensor 228, 230, 232 with respect to the associated the body frame along one of the three axes, such as, for example, one of the y-axis (e.g., pitch mounting error), x-axis (e.g., roll mounting error), and z-axis (e.g., yaw mounting error). For example, referencing the axes shown in FIGS. 6 and 7, the transformation matrix convention can be, for example, an y-axis-z-axis-x-axis rotation matrix (“YZX” rotation matrix). According to such a matrix convention, orientation, or misalignment, of the IMU frame with respect to the associated body frame can be expressed as:Rbody⁢_⁢imubody=Ry(δθ)⁢Rz(δψ)⁢Rx(δφ)(8)whereinRbody⁢_⁢imubodyis the rotation matrix corresponding to the orientation, or misalignment, of the body frame of a body 106, 110, 112 relative to the IMU frame of the IMU sensor 228, 230, 232 (“body_imu”) that is coupled to the body 106, 110, 112; Ry(δθ) is the rotation matrix corresponding to the misalignment between the body frame and the IMU frame along the y-axis; Rz(δψ) is the rotation matrix corresponding to the misalignment between the body frame and the IMU frame along the z-axis; and Rx(δφ) is the rotation matrix corresponding to the misalignment between the body frame and the IMU frame along the x-axis.The process can also include defining an intermediate frame. As seen in FIG. 7, the intermediate frame can be positioned between the IMU frame and the body frame, and only incorporate the misalignment of the IMU frame along the y-axis (e.g., pitch). Moreover, while there may be three degrees of freedom between the IMU frame and the body frame (e.g., rotation over each of the x, y, and z axes), there are two degrees of freedom between the IMU frame and the intermediate frame (e.g., rotation over the x-axis (roll) and z-axis (yaw)). According to such an embodiment, the intermediate frame can represent a frame in which misalignment between the IMU frame and the body frame has been corrected over the x-axis and the z-axis, but not over the y-axis. Therefore, with such an approach, the orientation of the body frame with respect to the swing frame can be described as:Rbodyswing=Ry(θbody)(9)whereinRbodyswingis the rotation matrix corresponding to the orientation of the swing frame (“swing”) with respect the body frame (“body”), and Ry(θbody) is the rotation matrix corresponding to the pitch rotation of the body frame over the y-axis of the swing frame, with θbody being the pitch angle of the body frame (as generally identified by “θbody” in FIG. 7). Further, the misalignment, with respect to pitch, between the IMU frame and the body frame is, in FIG. 7, generally represented by “δθ”.As the intermediate frame lies between the body frame and the IMU frame, the orientation of the body frame relative to the intermediate frame can be described by a rotation over the y-axis of the body frame, as indicated by:Rinterbody=Ry(δθ)(10)whereinRinterbodyis the rotation matrix corresponding to the orientation, or misalignment, of the body frame relative to the intermediate frame, and Ry(δθ) is the rotation matrix corresponding to the misalignment between the IMU frame and the body frame as the body frame is rotated over the y-axis of the swing frame. Further, the rotation matrix(Rbody⁢_⁢imuinter)that relates the intermediate frame (“inter”) with respect to the IMU frame (“body_imu”) is:Rbody⁢_⁢imuinter=Rz(δψ)⁢Rx(δφ)(11)wherein Rz(δψ) is the rotation matrix corresponding to the misalignment between the body frame and the IMU frame along the z-axis and Rx(δφ) is the rotation matrix corresponding to the misalignment between the body frame and the IMU frame along the x-axis.Thus, in view of at least Equation (8), Equation (10) and Equation (11), the rotation matrix corresponding to the orientation, or misalignment, of the body frame relative to the IMU frame that is coupled to the associate body can be expressed as:Rbody⁢_⁢imubody=Rinterbody⁢Rbody⁢_⁢imuinter(12)Additionally, the angular velocity or motion of the body can be mapped from the perspective of the swing frame to the intermediate frame. For example, such swing motion from the swing frame to the intermediate frame can be expressed as:ωinter=Rswinginter⁢ωswing=
Ry(-θ)⁢ωswing=[c⁢θ0-s⁢θ010s⁢θ0c⁢θ][00ωswing]=[-ωswing⁢s⁢θ0ωswing⁢c⁢θ](13⁢a)where:Rswinginter=[Rbodyswing⁢Rinterbody]T(13⁢b)θ=θbody+δθ(13⁢c)wherein ωinter is the angular velocity of the intermediate frame,Rswinginteris the rotation matrix corresponding to the misalignment between the intermediate frame and the swing frame, ωswing is angular velocity of the swing frame, Ry(−θ) is the rotation matrix over the y-axis (which is shown as having a negative magnitude), θbody is, again, the pitch angle of the body frame, δθ is the misalignment, with respect to pitch, between the IMU frame and the body frame, “c” is an abbreviation for cosine, and “s” is an abbreviation for sine.Additionally, the same motion being mapped by the swing frame to the intermediate frame, as represented by Equation (13a), can also be mapped from the perspective of the IMU frame to the intermediate frame (Equation (14)). However, unlike the mapping referenced by Equation (13a), such mapping of the IMU frame to the intermediate frame can utilize measured data of the angular velocity (“ωgyro”) collected from the IMU sensor 228, 230, 232 at block 312 corresponding to the swing motion of the body at block 308 when the linkage 108 was at the first orientation. Additionally, such mapping of the IMU frame to the intermediate frame can also utilize, for movement of the linkage 108 at the second orientation (block 314), the angular velocity (“ωgyro”) collected from the IMU sensor 228, 230, 232 at block 318. Accordingly, the angular velocity of the intermediate frame can also be expressed as:ωinter=Rbody⁢_⁢imuinter⁢ωgyro=
Rz(δψ)⁢Rx(δφ)⁢ωgyro=[c⁢δψ-c⁢δϕ⁢s⁢δψs⁢δϕ⁢s⁢δψs⁢δψc⁢δϕ⁢c⁢δψ-c⁢δψ⁢s⁢δϕ0s⁢δϕc⁢δϕ][ωxωyωz](14)whereinRbody⁢_⁢imuinteris the rotation matrix corresponding to the misalignment between the intermediate frame (“inter”) and the IMU frame (“body_imu”), and “ωx”, and “ωy”, and “ωz” are angular velocities along the x, y, and z axes, respectively, as collected by the IMU sensor 228, 230, 232 that is mounted to the body at blocks 312 and 318.By equating Equations (13a) and (14), and, moreover, the mapping of the swing frame to the intermediate frame and the IMU frame to the intermediate frame, as well as in view of small angle approximation (Equations (5a), (5b), (5c)), the angular velocity of the intermediate frame can be expressed as:ωinter=[-ωswing⁢s⁢θ0ωswing⁢c⁢θ]≈[1-δψ0δψ1-δϕ0δϕ1][ωxωyωz](15⁢a)As seen, the second row in Equation (15a) can be expressed as:0=δψωx+ωy−δφωz  (15b)With the measurements from the IMU sensor 228, 230, 232 being obtained at different boom joint angles associated with the differences between the first and second orientations, it is possible to form the following system of equations:[ω_y,1ω_y,2]=[-ω_x,1ω_z,1-ω_x,2ω_z,2][δψδϕ](16)wherein w denotes the measured accumulated angular velocities, ωy,1, ωx,1, ωz,1 correspond to accumulated measured angular velocities, as determined using information collected from the IMU sensors 228, 230, 232 at block 312 along the y, x, and z axes, respectively, during the first displacement of the linkage 108 while the linkage 108 is at the first orientation (block 308), and ωy,2, ωx,2, ωz,2 correspond to accumulated measured angular velocities, as determined using information collected from the IMU sensors 228, 230, 232 at block 318 along the y, x, and z axes, respectively, during the second displacement of the linkage 108 while the linkage 108 is at the second orientation (block 314). Using such measured angular velocities, the 2×2 system of Equation (16) can be used to determine values for two mounting or misalignment errors between the IMU frame and the body frame. Moreover, using Equation (16) mounting errors can be identified with respect to yaw misalignment (δψ) (e.g., rotation misalignment between the body frame and the IMU frame along the z-axis) and roll misalignment (δφ) (e.g., rotation misalignment between the body frame and the IMU frame along the x-axis).With mounting errors being identified with respect to two axes (e.g., δψ and δφ) the mounting error between the body frame and the IMU frame along the third axis, and, moreover, pitch misalignment (δθ) (e.g., rotation misalignment between the body frame and the IMU frame along the y-axis), can be determined. Thus, the first and third rows of Equation (15a), respectively, can be expressed as:−ωswingsθ=ωx−δψωy  (17a)ωswingcθ=δφωy+ωz  (17b)In such a situation, using Equations (17a) and (17b), the true pitch angle (θ) of the IMU frame can be calculated as:θ=a⁢tan⁡(s⁢θc⁢θ)=a⁢tan⁡(-ωx+δψωyδϕωy+ωz)(18)As the measured angular velocities Ox, WY, and oz were collected at block 312 for the first displacement at the first orientation (block 308) and collected at block 318 for the second displacement at the second orientation (block 314), and the yaw misalignment (δψ) and roll misalignment (δφ) can be determined (e.g., Equation (16)), the controller 202 can determine the true pitch angle (θ) of the IMU frame.With the true pitch angle (θ) of the IMU frame having been determined (e.g., Equation (18)), and the body pitch angle (θbody) being known, the mounting error with respect to pitch misalignment (δθ) (e.g., rotation misalignment between the body frame and the IMU frame along the y-axis) can therefore be determined as follows:δθ=θ−θbody  (19)Alternatively, rather than utilizing small angle approximation (Equations (5a), (5b), (5c)), Equations (13a) and (14) can instead be equated by:[-ωswing⁢s⁢θ0ωswing⁢c⁢θ]=[c⁢δψ-c⁢δϕ⁢s⁢δψs⁢δϕ⁢s⁢δψs⁢δψc⁢δϕ⁢c⁢δψ-c⁢δψ⁢s⁢δϕ0s⁢δϕc⁢δϕ][ωxωyωz](20⁢a)In such an example, the second row of Equation (20a) can be expressed as:ωy=-s⁢δψc⁢δψ⁢c⁢δϕ⁢ωx+s⁢δϕc⁢δϕ⁢ωz(20⁢b)Using the system of equations, Equation (20a) can be stated as:[ω_y,1ω_y,2]=[-ω_x,1ω_z,1-ω_x,2ω_z,2][t⁢δψ⁡(c⁢δψ)-1t⁢δϕ](21)wherein “t” is an abbreviation for tangent or tan, and the identified accumulated measured angular velocities are known, as discussed above with respect to at least Equation 16. Using such measured angular velocities and an arc tangent (arctan) function, the 2×2 system of Equation (21) can be used to determine values for two mounting or misalignment errors between the IMU frame and the body frame. Moreover, using Equation (16) mounting errors can be identified with respect to yaw misalignment (δψ) (e.g., rotation misalignment between the body frame and the IMU frame along the z-axis) and roll misalignment (δφ) (e.g., rotation misalignment between the body frame and the IMU frame along the x-axis).Similarly, in the absence of using small angle approximation, the identified mounting errors with respect to two axes (e.g., δψ and δφ) identified using Equation (21), as well as angular velocities measured at blocks 314 and 318, can be used to determine the mounting error between the body frame and the IMU frame along the third axes, and, moreover, the pitch misalignment (δθ). However, unlike Equations (17a) and (17b), if small angle approximation is not utilized, then the first and third of Equation (15a), respectively, can be expressed as:−ωswingsθ=cδψωx−Cδφsδψωy+sδφsδψωz  (22b)ωswingcθ=sδφωy+cδφωz  (22c)Using Equations (22b) and (22c), the true pitch angle (“θ”) of the IMU frame can be identified as:θ=a⁢tan⁡(-c⁢δψωx+c⁢δϕ⁢s⁢δψωy-s⁢δϕ⁢s⁢δψωzs⁢δϕωy+c⁢δϕωz)(23)wherein “atan” is an abbreviation for arc tangent (arctan), the yaw misalignment (δψ) and roll misalignment (δφ) have been determined (e.g., Equation 21), the angular velocities ωx, ωy, and ωz were collected at block 312 for the first displacement at the first orientation (block 308) and collected at block 318 for the second displacement at the second orientation (block 314).Having determined the true pitch angle (“θ”) of the IMU frame, the mounting error with respect to pitch misalignment (δθ) (e.g., rotation misalignment between the body frame and the IMU frame along the y-axis) can therefore be determined, and the difference between the true pitch angle (“θ”) and the known body pitch angle (θbody), as identified above by Equation (19).The yaw misalignment (δψ), roll misalignment (δφ), and the pitch misalignment (δθ) determined at block 324 can therefore be, or provide, parameters, also referred to as calibration parameters, that can be used to calibrate, or compensate for, the misalignment between the IMU frame with the associated body frame in three-dimensions. Thus, in instances in which the IMU frame of an IMU sensor 228, 230, 232 and the body frame are misaligned, the calibration parameters determined by the method 300 be used to calibration information provided by the IMU sensor 228, 230, 232 to improve accuracy or representation of the orientation, including position, of the associated body frame, and thus the corresponding body.According to certain embodiments, before being stored and / or implemented, the reliability of the determined calibration parameters (e.g., (δψ), (δφ), and (δθ)) can be verified by the controller 202 at block 326. For example, according to certain embodiments, at block 326 the controller 202 can perform a reliability check for the determined calibration parameters, including with respect to the robustness of the determined calibration parameters, such as, for example, with respect to measurement noise. For example, with respect to certain embodiments, a condition number of a coefficient matrix can be used to measure the sensitivity of the solution, in this situation the calibration parameters, to noise in the data. According to certain embodiments, a condition number that is determined to be at, or around 1, can be deemed to indicate the determined calibration parameters are reliable.In such embodiments, verification of the condition number of the matrix formed from information, including measurements, obtained from an IMU sensor 228, 230, 232 can be expressed as:cond⁡([-ω_x,1ω_z,1-ω_x,2ω_z,2])>cmaxThr(24)wherein cmaxThr is a value representing a predetermined maximum threshold condition number that is to be exceeded by the determined condition number (“cond”), ωx,1 and ωz,1 correspond to accumulated measured angular velocities, as determined using information collected from the IMU sensors 228, 230, 232 at block 312 along the x and z axes, respectively, during first displacement of the linkage 108 while the linkage 108 is at the first orientation (block 308), and ωx,2 and ωz,2 correspond to accumulated measured angular velocities, as determined using information collected from the IMU sensors 228, 230, 232 at block 318 along the x and z axes, respectively, during second displacement of the linkage 108 while the linkage 108 is at the second orientation (block 314).A condition number can also be utilized in determining the extent of the differences between the first orientation used in connection with the first displacement at block 308, and the second orientation used for the second displacement at block 314 satisfy a predetermined criteria. For example, according to certain embodiments, the first orientation can correspond to the linkage 108 being in a raised position, the second orientation can correspond to the linkage 108 having been rotated, or lowered, about the y-axis of the swing frame assembly 114 by about 90 degrees. However, with at least certain embodiments, the linkage 108 may be unable to be rotated 90 degrees, such as, for example, precluded from such rotation by contact with the ground or the other physical limitations or constraints of the linkage 108. Thus, in such situations, a relationship between a condition number and a pitch variation can be determined, as illustrated by the exemplary graphical representation shown in FIG. 10. Moreover, FIG. 10 illustrates a predetermined exemplary relationship in a variation of an angular position of a boom 110 about a swing frame assembly 114 along the y-axis of the swing frame (see FIG. 6) between the first and second orientation (e.g., between the raised orientation shown in at least FIG. 4A and the lowered orientation shown in at least FIG. 5A). In this example, to obtain a condition number of about 2 (as generally indicated in FIG. 10 by “Y 1.96261”), which may, according to certain embodiments, relate at least in part to collecting valid data at blocks 310 and 316, the pitch angle variation of the boom 110 along the y-axis, and, moreover, the difference between in the pitch angle of the boom 110 at the first and second orientations, is to be between 54 degrees and 126 degrees.If the controller 202 determines at block 326 that the derived calibration parameters are reliable, then at block 322, the calibration parameters can be disregarded, and the method 300 can be aborted and / or reattempted. However, if the controller 202 determines at block 326 that the derived calibration parameters are reliable, then at block 328 the calibration parameters can be stored, such as, for example, by the memory device 206.The stored calibration parameters can then be selectively implemented by the controller 202 at block 330. For example, according to certain embodiments, during a first calibration of the agricultural vehicle, and moreover, of the IMU sensors 228, 230, 232, the derived calibration parameters can be implemented such that future measurements obtained from IMU sensors 228, 230, 232 relating to at least to orientation, including positional, information can be properly calibrated with respect to an associated misalignment between the IMU frame of the IMU sensor 228, 230, 232 and the corresponding body frame, as previously discussed. Additionally, in certain instances, such calibration information may be subsequently reapplied, including, for example, in connection with equipment maintenance, including, but not limited to, subsequent replacement of an IMU sensor 228, 230, 232 or associated body, among other adjustments or changes to the work vehicle 100.FIG. 8 illustrates a simplified flow diagram of an exemplary method 800 for calibrating an alignment of a chassis IMU sensor 234, and, moreover, the IMU frame of the chassis IMU sensor 234 relative to the chassis 122 of a work vehicle 100 to which the chassis IMU sensor 234 is mounted. The method 800 is described below in the context of being carried out by the illustrated exemplary system 200. However, it should be appreciated that method 800 can likewise be carried out by any of the other described implementations, as well as variations thereof. Further, the method 800 corresponds to, or is otherwise associated with, performance of the blocks described below in the illustrative sequence of FIG. 8. It should be appreciated, however, that the method 800 can be performed in one or more sequences different from the illustrative sequence. Additionally, one or more of the blocks mentioned below may not be performed, and the method 800 can include steps or processes other than those discussed below.At block 802, the controller 202 can generate one or more signals to facilitate the work vehicle 100 being at a first position. The signal(s) generated at block 802 can be in response to a command provided by the operator of the work vehicle 100 via use of the input device 220 or generate automatically by the controller 202. For example, according to certain embodiments in which the work vehicle is a backhoe 102, as seen by FIG. 9A, the first position can correspond to a position at which each of the engagement bodies 125, 126 of the work vehicle 100 are against the adjacent ground surface, and the linkage 108 is in a raised position that can be similar to the first orientation discussed above with respect to the method 300 of FIG. 3. Moreover, according to certain embodiments, the first position can correspond at least to the outrigging 118 not engaging the ground surface, and, thus not be used to elevate or tilt any portion of the work vehicle 100. Further, the first position can also correspond to the work vehicle 100 being generally static, and, moreover, not moving with respect to the adjacent ground surface.With the work vehicle 100 in the first position, at block 804, the controller 202 can collected a first set of information from the chassis IMU sensor 234 and at least one reference IMU sensor, such as, for example, an IMU sensor 228, 230, 232 associated with the linkage 108 or a body of the linkage 108. For instance, in the examples discussed herein the method 800 can include collecting reference information, including data, from a reference IMU sensor, which in the illustrated example is the boom IMU sensor 228. Alternatively, or additionally, in addition to collecting information from the chassis IMU sensor 234, the method 800 can collect information from other, or additional, reference IMU sensors, such as, for example, the arm IMU sensor 230 the implement IMU sensor 232, and / or another IMU sensor related, or not related, to the linkage 108, particularly with respect to work vehicles other than backhoes 102. Further, while a variety of different types of data can be collected at block 804, according to the illustrated embodiment, the information collected from the chassis IMU sensor 234 and the reference IMU sensor can be accelerometer data.As seen by at least FIG. 9A, the first set of information collected at block 804 can include a first accelerometer data corresponding to a gravity measurement (as generally represented by “a1” in FIG. 9A) from the chassis IMU sensor 234, and a first reference accelerometer data from the reference IMU sensor, in this example, the boom IMU sensor 228, corresponding to a reference gravity measurement (as generally represented by “b1” in FIG. 9A) at a IMU frame associated with the boom IMU sensor 228 (as generally represented by “Body IMU Frame” in FIGS. 9A and 9B), and not at a reference frame associated with the chassis 122 (as generally represented in FIGS. 9A and 9B by “Chassis IMU frame”).With the first set of information collected at block 806, at block 806 the controller 202 can generate one or more signals to displace at least a portion of the work vehicle 100 to a second position, the second position being different than the first position associated with bock 802. The signal(s) generated at block 806 can be in response to a command inputted by the operator via the input device 220 or generated automatically by the controller 202. For example, according to certain embodiments in which the work vehicle is a backhoe 102, as seen by FIG. 9B, the second position can correspond to a position at least some of the engagement bodies 126 of the work vehicle 100 are raised above the adjacent ground surface while other engagement bodies 125 remain positioned against the adjacent ground surface. Thus, the second position at block 806 can correspond the outrigging 118 engaging the ground surface to elevate a portion of the work vehicle 100 such that, compared to the first position, the work vehicle is in a tilted orientation or at an increased or larger tilt. For example, with respect to certain embodiments, the outrigging 118 can be engaged with the ground surface so that, compared to the first position, a tilt of work vehicle is 5 degrees to 20 degrees, and, more specifically, 15 degrees greater than the tilt, if any, of the work vehicle 100 when the work vehicle is at the first position. Thus, in at least certain embodiments, the first position at block 802 can be associated with the chassis 122 being at a relatively flat position or orientation, and the chassis 122 being at a raised or tilted position or orientation at block 806.Further, aside from being tilted with the work vehicle 100, the orientation of the linkage 108 when the work vehicle 100 is at the second position may, or may not, generally be the same as the first position from block 802. For example, in the embodiment illustrated in FIG. 9B, the orientation of the linkage 108 may generally be the same as that shown in FIG. 9A, particularly with respect to the boom 110 being raised and the implement 106 not being a fully curled position, as seen in FIGS. 9A and 9B. Additionally, similar to the first position, when at the second position at block 806, the work vehicle 100 may be generally static, including generally not moving with respect to the adjacent ground surface.At block 808, the controller 202 can again collect a second set of information from the same IMU sensors used for collecting the first set of information, namely from the chassis IMU sensor 234 and the reference IMU sensor. As seen by at least FIG. 9B, the second set of information collected at block 808 can include second accelerometer data corresponding to a gravity measurement (as generally represented by “a2” in FIG. 9B) from the chassis IMU sensor 234, and a second reference accelerometer data from the reference IMU sensor, which, again, in this example, the boom IMU sensor 228, corresponding to a reference gravity measurement (as generally represented by “b2” in FIG. 9B). As with the accelerometer data collected at block 804 regarding the acceleration measured by the boom IMU sensor 228 (b1), the accelerometer data collected at block 808 regarding the acceleration measured by the boom IMU sensor 228 (b2) is also at the frame associated with the boom IMU sensor 228, and not at the reference frame associated with the chassis 122, also referred to herein as the chassis reference frame.As also illustrated by at least a comparison of FIGS. 9A and 9B, the angular orientation of the IMU frame of the reference IMU sensor (e.g., the boom IMU sensor 228) and the chassis IMU frame for the chassis IMU sensor is different for the first and second positions of the work vehicle 100. As a consequence, the accelerometer data for the IMU sensors 228, 234 for the second set of information from block 808 is not parallel to the accelerometer data for the IMU sensors 228, 234 for the first set of information from at block 804.At block 810, the information, including accelerometer data, collected at blocks 804 and 808 can be analyzed by the controller 202 in connection with determining whether the collected data satisfies one or more predetermined verification thresholds. Such verification thresholds can be utilized to assess the quality or reliability of the data collected at blocks 804 and 808. According to certain embodiments, such verification can include, for example, analyzing data corresponding to the accelerometer portion of the chassis IMU sensor 234 and, in this example, the boom IMU sensor 228. According to certain embodiments, such a verification can include a comparison involving the minimum chassis 122 tilt variation during the data collection processes from either or both block 804 and block 808, as expressed, for example, by:a⁢cos⁡(a_1·a_2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>a_1<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>⁢<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[LeftBracketingBar]"< / annotation>< / semantics>a_2<semantics definitionURL="">❘<annotation encoding="Mathematica">"\[RightBracketingBar]"< / annotation>< / semantics>)>ΔθminTiltThr(25)wherein “acos” is an abbreviation for arccosine, ā1 and ā2 are accumulated accelerometer readings at the first position and at the second position, respectively, and ΔθminPitchThr is a predetermined verification threshold corresponding to a minimum pitch or tilt threshold for the chassis 122.If the controller 202 determines at block 810 that the collected information does not satisfy the one or more predetermined verification thresholds, then the controller 202 can, at block 812 abort the calibration process. The operator, or, alternatively, the controller 202, can then determine whether, or not, to reattempt to the calibration process, and, moreover, whether to restart the method 300.If, however, the controller 202 determines at block 810 that the collected information does satisfy the one or more predetermined verification thresholds, then the controller 202 can at block 814 use at least the information collected at blocks 804 and 808 to determine calibration parameters for calibration of the chassis IMU sensor 234.In the illustrated embodiment, before such calibration can occur, the accelerometer data (b1, b2) collected at block 804 and 808 from the boom IMU sensor 228 regarding the acceleration measured by the boom IMU sensor 228 can be projected to the chassis reference frame of the chassis 122. For example, using the information collected for each of block 804 and block 808, and the TRIAD method, the boom IMU acceleration can be projected onto the chassis reference frame, as indicated by:rk=Rz(ψswing)⁢Ry(θboom)︸Rboomchassis⁢Rboom⁢_⁢imuboom⁢bk(26)with k=1, 2wherein: Rz(ψswing) is the rotation matrix over the z-axis of the swing frame, which can be determined using information from the swing sensor 226; Ry(θboom) is a rotation matrix over the y-axis of the swing frame and can be known, for example, using information provided by an via an external laser measurement system, as previously discussed;Rboom⁢_⁢imuboomis, from above Equation (12), a rotation matrix corresponding to the orientation, or misalignment, of the body frame (wherein the frame of the boom 110) relative to the IMU frame of the boom IMU sensor 228 that is coupled to the boom 110.The accelerometer, or gravity, measurements from the chassis IMU sensor 234 from blocks 804 and 808, as denoted in FIGS. 9A and 9B as a1 and a2, respectively, and their associated reference accelerations from the boom IMU sensors, as transformed to being at the chassis reference frame, as denoted above by r1 and r2, the TRIAD method can be utilized to calibrate any misalignment between the IMU frame of the chassis IMU sensor 234 and the chassis body frame. For example, as the accelerometer measurements from the chassis IMU sensor 234 from blocks 804 and 808, and, moreover, from the first and second positions of the work vehicle, as not parallel, a triad of orthogonal vectors can be created in which:u1=r1r1(27⁢a)u2=u1×r2u1×r2(27⁢b)u3=u1×u2(27⁢c)v1=a1a1(27⁢d)v2=v1×a2v1×a2(27⁢e)v3=v1×v2(27⁢f)The calibration matrixRimubodycan then be used to transfer any vector in the chassis IMU frame to the chassis reference frame. Thus, in such an instance:Rbody⁢_⁢imubody[v1⁢v2⁢v3]=[u1⁢u2⁢u3](28)When transposed, the expression from Equation (28) can therefore provide the following calibration matrix for calibrating the chassis IMU frame relative to the chassis reference frame:Rbody⁢_⁢imubody=[u1⁢u2⁢u3][v1⁢v2⁢v3]T(29)Further, to obtain the misalignment angles between the chassis IMU sensor 234 and the chassis reference frame, and, moreover, the calibration parameters to account for the misalignment between the chassis IMU sensor 234 and the chassis reference frame, it can be assumed that the calibration matrix for chassis IMU sensor 234 adopts the following general form:Rbody⁢_⁢imubody=Rz(δψ)⁢Ry(δθ)⁢Rx(δϕ)(30)In deriving at block 814 the calibration matrix, and thus the corresponding calibration parameters, for calibrating the chassis IMU frame relative to the chassis reference frame, certain associated assumptions can include the boom IMU sensor 228 and the swing sensor 226 has already been calibrated, biases for the accelerometer portion of the either or both the boom IMU sensor 228 and the chassis IMU sensor 234 are negligible and biases of the associated gyroscope portion are have already been compensated, and the internal axes of the IMU sensors 228, 234 are aligned.The calibration parameters derived at block 814 can subsequently be stored at block 816, including at the memory device 206, for subsequent implementation at block 818. Such implementation can include, for example, at least initial calibration for operation of the work vehicle 100. Additionally, such implementation can occur in connection with maintenance and repair of the work vehicle 100, including, for example, following subsequent replacement of the IMU chassis sensor 234 with another IMU chassis sensor.In view of the foregoing, embodiments of the subject disclosure provide benefits at least with respect to calibration of work vehicles 100 that may have limited ranges of motion, including, for example, with respect to swing frame assembly 114 and boom 110 swing or joint motion, respectively. Embodiments of the subject application further can be implemented in an iterative fashion that can allow for deriving estimates for calibration matrices, or parameters, with relatively high accuracy despite the potential magnitude of the misalignment angles between the frames of IMU sensors and the associated body frame or chassis frame of the bodies or chassis, respectively, to which those IMU sensors are mounted. Additionally, as seen above, the maneuvering, and, moreover, the tilting of the chassis between the above-discussed first and second positions in connection with determining calibration parameters can eliminate more complex maneuvering of chassis in order to calibrate chassis IMU sensor 234. Similarly, use of orientations and displacements similar to those discussed above with respect to calibration of body sensors, including with respect to the above-discussed first and second orientations and associated first and second displacement, can improve the ease in terms of the maneuvering of the work vehicle 100 to obtain calibration parameters. The accuracy attainable in positioning determinations due, at least in part, to the calibration parameters discussed herein can facilitate the work vehicle 100 being able to satisfy relatively high accuracy requirements necessary for at least certain types of work operations, including, for example, precision construction applications such as grade guidance and grade control.While the disclosure has been illustrated and described in detail in the foregoing drawings and description, the same is to be considered as exemplary and not restrictive in character, it being understood that only illustrative embodiments thereof have been shown and described and that all changes and modifications that come within the spirit of the disclosure are desired to be protected.

Claims

1. A method for calibrating a measured orientation of a sensor frame of a sensor mounted to a body of a work vehicle relative to an orientation of a body frame of the body, the method comprising:rotatably displacing, during a first displacement, the body about an axis of a swing body of the work vehicle while the body is maintained in a first orientation;rotatably displacing, during a second displacement, the body about the axis of the swing body while the body is maintained in a second orientation, the second orientation being different than the first orientation;determining a second calibration parameter corresponding to an estimated misalignment between a second axis of the sensor frame and a second axis of the body frame;determining a third calibration parameter corresponding to an estimated misalignment between a third axis of the sensor frame and a third axis of the body frame;determining, using at least the second and third calibration parameters, a first calibration parameter corresponding to a misalignment between a first axis of the sensor frame and a first axis of the body frame; andcalibrating, using the first, second, and third calibration parameters, the measured orientation of the sensor based on the orientation of the body.

2. The method of claim 1, further comprising:confirming the body is at the first orientation and in a first static state prior to the first displacement; andconfirming the body is at the second orientation and in a second static state prior to the second displacement.

3. The method of claim 1, further comprising:collecting a first plurality of gyroscope data obtained by the sensor during the first displacement; andcollecting a second plurality of gyroscope data obtained by the sensor during the second displacement.

4. The method of claim 3, further comprising validating the first and second plurality of gyroscope data.

5. The method of claim 4, wherein validating the first and second plurality of gyroscope data comprises comparing the first plurality of gyroscope data relative to the second plurality of gyroscope data.

6. The method of claim 4, wherein the first plurality of gyroscope data comprises a first angular velocity and the second plurality of gyroscope data comprises a second angular velocity, and wherein validating the first and second plurality of gyroscope data comprises determining each of the first angular velocity and the second angular velocity satisfy a minimum angular velocity threshold.

7. The method of claim 6, further comprising outputting a signal, after validating the first angular velocity satisfies the minimum angular velocity threshold, to facilitate a displacing of the body to the second orientation.

8. The method of claim 1, further comprising defining an intermediate frame for which a misalignment between the second axis of the body frame and the second axis of the sensor frame, and a misalignment between the third axis of the body frame and the third axis of the sensor frame are corrected; andmapping, using information measured by the sensor from each of the first and second displacements, a motion of the sensor frame to the intermediate frame.

9. The method of claim 1, wherein the body at one of the first orientation and the second orientation is at least at a raised position, and at the other of the first orientation and the second orientation is at least at a lowered position, and wherein the first displacement and the second displacement are at least swinging displacements.

10. The method of claim 9, wherein the body is at one of a retracted position or an extended position at both the first orientation and the second orientation.

11. The method of claim 1, further comprising, prior to calibrating, verifying each of the first, second, and third calibration parameters using a condition number of a coefficient matrix of a simultaneous system of equations corresponding to a measurement noise.

12. The method of claim 1, further comprising, prior to calibrating, verifying, using a condition number and a pitch variation, a difference between the first orientation and the second orientation satisfy a predetermined criteria.

13. The method of claim 1, wherein the sensor is an inertial measurement unit.

14. A method for calibrating an orientation of a sensor frame of a sensor coupled to a chassis of a work vehicle relative to a chassis frame of the chassis, the method comprising:collecting, while the work vehicle is at a first position: (1) a first accelerometer data from the sensor corresponding to a first gravity measurement at the sensor frame, and (2) a first reference accelerometer data from a reference sensor corresponding to a first reference gravity measurement at a reference sensor frame of the reference sensor, the reference sensor positioned on a body of the work vehicle;tilting at least a portion of the work vehicle from the first position to a second position;collecting, while the work vehicle is at a second position: (1) a second accelerometer data from the sensor corresponding to a second gravity measurement at the sensor frame, and (2) a second reference accelerometer data from the reference sensor corresponding to a second reference gravity measurement at the reference sensor frame;transforming (1) the first reference accelerometer data to the chassis frame to derive a first transformed accelerometer data, and (2) the second reference accelerometer data to the chassis frame to derive a second transformed accelerometer data;determining, using at least the first and second accelerometer data and the first and second transformed accelerometer data, a calibration parameter representative of a misalignment between the sensor frame and the chassis frame; andadjusting, using the calibration parameter, a measurement from the sensor to identify an orientation of the chassis.

15. The method of claim 14, wherein the first accelerometer data is not parallel to the second accelerometer data.

16. The method of claim 15, wherein determining the misalignment between the sensor frame and the chassis frame comprises applying a Triad method to the first and second accelerometer data and the first and second transformed accelerometer data.

17. The method of claim 14, further comprising verifying the first and second accelerometer data using a predetermined minimum tilt threshold for the chassis.

18. The method of claim 14, wherein transforming the first and second accelerometer reference data further comprises:determining a reference calibration parameter for a misalignment of the reference sensor frame relative to a body frame of the body; andprojecting, using at least the reference calibration parameter, the first and second reference gravity measurements to the chassis frame.

19. The method of claim 14, wherein the sensor is an inertial measurement unit.

20. The method of claim 14, wherein the body is rotatable relative to at least the chassis.