System and method for augmenting a GNSS/INS navigation system in a cargo port environment

摘要

A system and method for augmenting a GNSS/INS system by using a vision system is provided. The GNSS system generates GNSS location information and the INS system generates inertial location information. The vision system further generates vision system location information including horizon, plumb lines and distance traveled. The GNSS information, INS information and vision system are combined in a Kalman filter to produce improved location information.