Autonomous Solutions, Inc.;CNH Industrial America LLC
发明人:
Matthew D. Berkemeier,Jeffrey Lee Ferrin,John Arthur Mitsuru Petersen
申请号:
US15915326
公开号:
US10784841B2
申请日:
2018.03.08
申请国别(地区):
US
年份:
2020
代理人:
摘要:
A control system for a work vehicle includes a controller, a processor, and a memory that causes the processor to receive, via a sensor assembly, sensor signals and convert the sensor signals into a plurality of entries of a full measurement vector. The memory devices causes the processor to determine a first state vector using IMU Kalman filter, update a first subset of entries the full state vector, determine a second state vector using a spatial positioning Kalman filter, update a second subset of entries the full state vector based on the second state vector, determine a third state vector using a vehicle Kalman filter, update a third subset of entries of the plurality of entries of the full state vector based on the third state vector, and control movement of the work vehicle based on at least one of the first state vector, the second state vector, the third state vector, and the full state vector.