This paper proposes the new aided inertial navigation system. This system has two states, the one is attitude state and another is position and velocity state. For compensating IMU sensor errors, each two state use different filter, the attitude state use EKF and the position state use UPF. This method makes estimating position faster and more accurate.