Projet IN 103

LE SLAM

En Matlab

Title Text

        
        if isempty(Y_known)
            X = Xet;
            P = Pet;
        else
            %Prediction de Y
            Yet = H * Xet;
            %Correction de l'état
            K = Pet * H' * inv(H * Pet * H' + Py);
            X = Xet + K*(Y_known - Yet);
            P = Pet - K*H*Pet;
        end

Bout de code

Copy of IN103 Slam

By Pierre Ory

Copy of IN103 Slam

  • 0